diff options
Diffstat (limited to 'board-js2x/slof/ht.fs')
-rw-r--r-- | board-js2x/slof/ht.fs | 291 |
1 files changed, 269 insertions, 22 deletions
diff --git a/board-js2x/slof/ht.fs b/board-js2x/slof/ht.fs index 837280b..31a8de3 100644 --- a/board-js2x/slof/ht.fs +++ b/board-js2x/slof/ht.fs @@ -1,21 +1,22 @@ -\ ============================================================================= -\ * Copyright (c) 2004, 2005 IBM Corporation -\ * All rights reserved. -\ * This program and the accompanying materials -\ * are made available under the terms of the BSD License -\ * which accompanies this distribution, and is available at -\ * http://www.opensource.org/licenses/bsd-license.php -\ * -\ * Contributors: -\ * IBM Corporation - initial implementation -\ ============================================================================= +\ ***************************************************************************** +\ * Copyright (c) 2004, 2007 IBM Corporation +\ * All rights reserved. +\ * This program and the accompanying materials +\ * are made available under the terms of the BSD License +\ * which accompanies this distribution, and is available at +\ * http://www.opensource.org/licenses/bsd-license.php +\ * +\ * Contributors: +\ * IBM Corporation - initial implementation +\ ****************************************************************************/ \ Hypertransport. \ See the PCI OF binding document. -new-device s" /ht" full-name +new-device + s" ht" 2dup device-name device-type s" u3-ht" compatible @@ -24,6 +25,36 @@ s" U3" encode-string s" model" property 3 encode-int s" #address-cells" property 2 encode-int s" #size-cells" property +s" /mpic" find-node encode-int s" interrupt-parent" property +\ XXX should have interrupt map, etc. this works for now though. +\ linux gets the PCI irqs right; only need to tell it the lpc irqs are edge. + +: decode-unit 2 hex-decode-unit 3 lshift or + 8 lshift 0 0 rot ; +: encode-unit nip nip ff00 and 8 rshift dup 7 and swap 3 rshift + over IF 2 ELSE nip 1 THEN hex-encode-unit ; + +f2000000 CONSTANT my-puid +\ Configuration space accesses. +: >config dup ffff > IF 1000000 + THEN f2000000 + ; + +\ : config-l! >config cr ." config-l! " 2dup . space . rl!-le ; +\ : config-l@ >config cr ." config-l@ " dup . rl@-le space dup . ; +\ : config-w! >config cr ." config-w! " 2dup . space . rw!-le ; +\ : config-w@ >config cr ." config-w@ " dup . rw@-le space dup . ; +\ : config-b! >config cr ." config-b! " 2dup . space . rb! ; +\ : config-b@ >config cr ." config-b@ " dup . rb@ space dup . ; + +: config-l! >config rl!-le ; +: config-l@ >config rl@-le ; +: config-w! >config rw!-le ; +: config-w@ >config rw@-le ; +: config-b! >config rb! ; +: config-b@ >config rb@ ; + +: config-dump ( addr size -- ) ['] config-l@ 4 (dump) ; + + \ 16MB of configuration space, seperate for type 0 and type 1. 00000000 encode-int f2000000 encode-int+ 00000000 encode-int+ 02000000 encode-int+ s" reg" property @@ -36,27 +67,243 @@ s" U3" encode-string s" model" property \ 1.75GB of memory space @ 80000000. 02000000 encode-int+ 00000000 encode-int+ 80000000 encode-int+ 00000000 encode-int+ 80000000 encode-int+ -00000000 encode-int+ 70000000 encode-int+ s" ranges" property +00000000 encode-int+ 4000000 encode-int+ s" ranges" property \ Host bridge, so full bus range. 0 encode-int ff encode-int+ s" bus-range" property -: enable-ht-apic-space 0 5 oco drop ; +: enable-ht-apic-space 3c0300fe f8070200 rl! ; enable-ht-apic-space -\ This works for the AMD devices; should walk PCI capabilities list -\ to be more portable. +\ spare out 0xc0000000-0xefffffff for pcie +f8070200 rl@ fffffff0 and f8070200 rl! +\ enable io memory for pcie @ c0000000-efffffff +70000003 f80903f0 rl!-le + + +\ Workaround for "takeover" boot on JS20: the top 8131 is programmed to be +\ device #1f, while it should be #01. +u3? IF f800 config-l@ 74501022 = IF 41 f8c2 config-w! THEN THEN + +\ Assign BUIDs. + +: find-ht-primary + 34 BEGIN config-b@ dup 0= ABORT" No HT capability block found!" + dup config-l@ e00000ff and 8 = IF 2 + EXIT THEN 1 + AGAIN ; + : assign-buid ( this -- next ) - 00c2 config-w@ 5 rshift over 00c2 config-w! + ; -: assign-buids + find-ht-primary dup >r config-w@ 5 rshift 1f and over r> config-b! + ; + +: assign-buids ( -- ) 1 BEGIN 0 config-l@ ffffffff <> WHILE assign-buid REPEAT drop ; -assign-buids + +assign-buids + +: ldtstop f8000840 rl@ 40000 or f8000840 rl! ; +: delay 100000 0 DO LOOP ; +: wait-for-done BEGIN f8070110 rl@ 30 and UNTIL + BEGIN 8b4 config-l@ 30 and UNTIL ; +: ldtstop1 f8000840 rl@ dup 20000 or f8000840 rl! delay + f8000840 rl! wait-for-done ; +: warm 400000 f8070300 rl! 0 f8070300 rl! ; + +: dumpht cr f8070110 rl@ 8 0.r space 8b4 config-l@ 8 0.r + space f8070122 rb@ 2 0.r space 8bd config-b@ 2 0.r ; + +: clearht f8070110 dup rl@ swap rl! + f8070120 dup rl@ swap rl! + 08b4 dup config-l@ swap config-l! + 08bc dup config-l@ swap config-l! ; + +: setwidth dup f8070110 rb! 8b7 config-b! ; +: set8 00 setwidth ; +: set16 11 setwidth ; + +: setfreq dup f8070122 rb! 8bd config-b! ; +: set200 0 setfreq ; +: set300 1 setfreq ; +: set400 2 setfreq ; +: set500 3 setfreq ; +: set600 4 setfreq ; +: set800 5 setfreq ; +: set1000 6 setfreq ; +: set1200 7 setfreq ; +: set1400 8 setfreq ; +: set1600 9 setfreq ; + +: ht>freq 2 + dup 6 > IF 2* 6 - THEN d# 100 * ; +\ XXX: looks only at the U3/U4 side for max. link speed and width. +clearht f8070111 rb@ setwidth +f8070120 rw@ 2log dup .( Switching top HT bus to ) ht>freq 0 d# .r .( MHz...) cr +setfreq u3? IF ldtstop THEN u4? IF ldtstop1 THEN + + +\ #include <pci-scan.fs> + : open true ; : close ; -\ The devices on our HT chain -INCLUDE hw/8131.fs -INCLUDE hw/8111.fs + +\ 80000000 next-pci-mem ! +\ b8000000 max-pci-mem ! +\ b8000000 next-pci-mmio ! +\ c0000000 max-pci-mmio ! +\ 10000 next-pci-io ! +\ 100000000 max-pci-io ! +\ 0 next-pci-bus ! + +\ 0 probe-pci +\ : probe-pci-host-bridge ( bus-max bus-min mmio-max mmio-base mem-max mem-base io-max io-base my-puid -- ) +s" /mpic" find-node my-puid pci-irq-init drop +1f 0 c0000000 b8000000 b8000000 80000000 100000000 10000 +my-puid probe-pci-host-bridge + + + + +: msi +\ \ on citrine (pass2) +\ f8005000 101054 config-l! 0 101058 config-l! +\ f 10105c config-w! 81 101052 config-b! + +\ \ on citrine (pass4) +\ f8005000 010854 config-l! 0 010858 config-l! +\ f 01085c config-w! 81 010852 config-b! + + \ on citrine (pass4), using old vector + f80040f0 010854 config-l! 0 010858 config-l! + ffff 01085c config-w! 81 010852 config-b! + + \ on pxb1 +\ f8000000 08a4 config-l! 0 08a8 config-l! 1 08a2 config-b! ; +\ f8000000 08a4 config-l! fd 08a8 config-l! 1 08a2 config-b! ; + +; + + + +\ This works. Needs cleaning up though; and we need to communicate the +\ MSI address range to the client program. (We keep the default range +\ at fee00000 for now). +: msi-on 7 1 DO 10000 i 800 * a0 + config-l! LOOP ; +msi-on + + + +\ \ \ +\ \ \ IRQ DEBUG CODE +\ \ \ + +: >mpic0 f8041000 + ; +: mpic0@ >mpic0 rl@ ; +: mpic0! >mpic0 rl! ; + +: >mpic f8050000 + ; +: mpic@ >mpic rl@ ; +: mpic! >mpic rl! ; + +: mpic-on dup 20 * 00880000 rot + over mpic! 1 swap 10 + mpic! ; +: mpic-all-on 7c 0 DO i mpic-on LOOP ; + +: mpic-cpu-on 0 f8060080 rl! ; +: mpic-cur cr ." pending: " 4 0 DO f80600a0 i c lshift + rl@ . LOOP ; +: mpic-eoi 0 f80600b0 rl! ; + +: one-by-one 7c 0 DO cr i . i mpic-on mpic-cur mpic-eoi LOOP ; + +CREATE pcie-cnfg-space 24 allot + +: .pci-express-capabilites-reg ( val -- ) + cr ." Cap ID :" dup ff and u. + cr ." Next Cap :" dup 8 rshift ff and u. + cr ." Type :" dup 14 rshift f and + CASE + 0 OF ." PCI Express Endpoint" ENDOF + 1 OF ." Legacy PCI Express Endpoint" ENDOF + 4 OF ." Root Port" ENDOF + 5 OF ." Switch upstream port" ENDOF + 6 OF ." Switch downstream port" ENDOF + 7 OF ." Express-to-PCI/PCI-X bridge" ENDOF + 8 OF ." PCI/PCI-X to Express bridge" ENDOF + dup OF 0 ENDOF ." Reserved" ENDCASE + drop +; + +: .pci-device-capabilites-reg ( val -- ) + cr ." MaxPS :" dup 7 and u. + drop +; + +: .pci-device-control-reg ( val -- ) + cr ." MaxPS act:" dup 5 rshift 7 and u. + cr ." MaxRS act:" dup c rshift 7 and u. + cr ." ERROR :" dup 10 rshift 3f and u. + drop +; + +: .pci-link-capabilites-reg ( val -- ) + cr ." Max linkW:" dup 4 rshift 3f and u. + drop +; + +: .pci-link-control-reg ( val -- ) + cr ." Neg linkW:" dup 4 10 + rshift 3f and u. + cr ." Train ERR:" dup a 10 + rshift 1 and u. + cr ." Train act:" dup b 10 + rshift 1 and u. + drop +; + +: .pcie-ext + 8 0 DO dup i 4 * dup >r + config-l@ r> pcie-cnfg-space + l! LOOP +\ pcie-cnfg-space 24 dump + pcie-cnfg-space l@ .pci-express-capabilites-reg + pcie-cnfg-space 4 + l@ .pci-device-capabilites-reg + pcie-cnfg-space 8 + l@ .pci-device-control-reg + pcie-cnfg-space c + l@ .pci-link-capabilites-reg + pcie-cnfg-space 10 + l@ .pci-link-control-reg +; + + +\ PCIe debug / fixup +: find-pcie-cap ( devfn -- offset | 0 ) + >r 34 BEGIN r@ + config-b@ dup ff <> over and WHILE + dup r@ + config-b@ 10 = IF r> drop EXIT THEN 1+ REPEAT r> 2drop 0 ; +: .pcie ( devfn -- ) + dup find-pcie-cap ?dup IF cr over . ." cap @ " dup . + +\ .pcie-ext + dup 8 + config-w@ 5 rshift 7 and 80 swap lshift cr ." max payload size: " .d + dup 8 + config-w@ c rshift 7 and 80 swap lshift cr ." max read req: " .d + dup 12 + config-w@ 4 rshift 3f and cr ." link width: " .d + THEN drop ; +: .pcies ( -- ) + cr cr ." PCIe:" + 10000 0 DO i 8 lshift .pcie LOOP ; + +: (set-ps) ( ps addr -- ) + 8 + >r 5 lshift r@ config-w@ ff1f and or r> config-w! ; +: set-ps ( ps -- ) + log2 7 - + 10000 0 DO i 8 lshift dup find-pcie-cap ?dup IF + + 2dup (set-ps) THEN drop LOOP drop ; + +: (set-rr) ( rr addr -- ) + 8 + >r c lshift r@ config-w@ 8fff and or r> config-w! ; +: set-rr ( rr -- ) + log2 7 - + 10000 0 DO i 8 lshift dup find-pcie-cap ?dup IF + + 2dup (set-rr) THEN drop LOOP drop ; + +bimini? IF + 100 set-ps 200 set-rr +\ .pcies +ELSE + 100 set-ps 200 set-rr +\ .pcies +THEN + +: set-ps set-ps .pcies ; +: set-rr set-rr .pcies ; + finish-device |