Added interrupt-map + swizzling for bridges.

Signed-off-by: Alexey Kardashevskiy <aik@ozlabs.ru>

1 files changed, 23 insertions, 2 deletions

diff --git a/board-qemu/slof/pci-interrupts.fs b/board-qemu/slof/pci-interrupts.fs
index 11db05f..a12d7bb 100644
--- a/board-qemu/slof/pci-interrupts.fs
+++ b/board-qemu/slof/pci-interrupts.fs
@@ -1,6 +1,27 @@
+
+: pci-gen-irq-map-one ( prop-addr prop-len slot pin -- prop-addr prop-len )
+        2dup + 4 mod                                        ( prop-addr prop-len slot pin parentpin )
+        get-node >space
+        pci-addr2dev + 1- 4 mod 1+  \ do swizzling          ( prop-addr prop-len slot pin swizzledpin )
+        >r >r >r                                            ( prop-addr prop-len R: swizzledpin pin slot )
+
+        r> B lshift encode-int+
+        0 encode-64+                \ device slot           ( prop-addr prop-len R: swizzledpin pin )
+        r> encode-int+              \ device pin            ( prop-addr prop-len R: swizzledpin )
+
+        get-parent encode-int+      \ parent phandle
+        0 encode-int+ 0 encode-64+  \ parent slot
+        r> encode-int+              \ parent swizzled pin   ( prop-addr prop-len R: )
+;
+
 : pci-gen-irq-entry ( prop-addr prop-len config-addr -- prop-addr prop-len )
-  ." SHOULD NOT GET THERE !" cr
-  drop
+        pci-addr2dev 4 mod          ( prop-addr prop-len slot )
+        -rot                        ( slot prop-addr prop-len )
+        5 1 DO
+                2 pick i            ( slot prop-addr prop-len slot pin )
+                pci-gen-irq-map-one
+        LOOP
+        rot drop
 ;
 
 : pci-set-irq-line ( config-addr -- )