Add Rapidio support for the MPC8641HPCN

[oweals/u-boot.git] / board / mpc8641hpcn / init.S

diff --git a/board/mpc8641hpcn/init.S b/board/mpc8641hpcn/init.S
index 69954a81ac2e7dc05c5c2924bb692a97b87faac3..c6ea55ea714bbfb31fe0c6aada96cf430710347a 100644 (file)
--- a/board/mpc8641hpcn/init.S
+++ b/board/mpc8641hpcn/init.S
@@ -84,6 +84,9 @@
 #define LAWAR8  ((LAWAR_TRGT_IF_DDR2 | (LAWAR_SIZE & LAWAR_SIZE_512M)) & ~LAWAR_EN)
 #endif
 
+#define LAWBAR9 ((CFG_RIO_MEM_BASE>>12) & 0xfffff)
+#define LAWAR9  (LAWAR_EN | LAWAR_TRGT_IF_RIO | (LAWAR_SIZE & LAWAR_SIZE_512M))
+
        .section .bootpg, "ax"
        .globl  law_entry
 law_entry:
@@ -164,5 +167,14 @@ law_entry:
        ori     r6,r6,LAWAR8@l
        stwu    r6, 0x20(r5)
 
+       /* LAWBAR9, LAWAR9 */
+       lis     r6,LAWBAR9@h
+       ori     r6,r6,LAWBAR9@l
+       stwu    r6, 0x20(r4)
+
+       lis     r6,LAWAR9@h
+       ori     r6,r6,LAWAR9@l
+       stwu    r6, 0x20(r5)
+
        blr