board/prodrive/p3mx/misc.S

   1 #include <config.h>
   2 #include <74xx_7xx.h>
   3 #include "version.h"
   4
   5 #include <ppc_asm.tmpl>
   6 #include <ppc_defs.h>
   7
   8 #include <asm/cache.h>
   9 #include <asm/mmu.h>
  10
  11 #include "../../Marvell/include/mv_gen_reg.h"
  12
  13 #ifdef CONFIG_ECC
  14         /* Galileo specific asm code for initializing ECC */
  15         .globl board_relocate_rom
  16 board_relocate_rom:
  17         mflr    r7
  18         /* update the location of the GT registers */
  19         lis     r11, CONFIG_SYS_GT_REGS@h
  20         /* if we're using ECC, we must use the DMA engine to copy ourselves */
  21         bl      start_idma_transfer_0
  22         bl      wait_for_idma_0
  23         bl      stop_idma_engine_0
  24
  25         mtlr    r7
  26         blr
  27
  28         .globl board_init_ecc
  29 board_init_ecc:
  30         mflr    r7
  31         /* NOTE: r10 still contains the location we've been relocated to
  32          * which happens to be TOP_OF_RAM - CONFIG_SYS_MONITOR_LEN */
  33
  34         /* now that we're running from ram, init the rest of main memory
  35          * for ECC use */
  36         lis     r8, CONFIG_SYS_MONITOR_LEN@h
  37         ori     r8, r8, CONFIG_SYS_MONITOR_LEN@l
  38
  39         divw    r3, r10, r8
  40
  41         /* set up the counter, and init the starting address */
  42         mtctr   r3
  43         li      r12, 0
  44
  45         /* bytes per transfer */
  46         mr      r5, r8
  47 about_to_init_ecc:
  48 1:      mr      r3, r12
  49         mr      r4, r12
  50         bl      start_idma_transfer_0
  51         bl      wait_for_idma_0
  52         bl      stop_idma_engine_0
  53         add     r12, r12, r8
  54         bdnz    1b
  55
  56         mtlr    r7
  57         blr
  58
  59         /* r3:  dest addr
  60          * r4:  source addr
  61          * r5:  byte count
  62          * r11: gt regbase
  63          * trashes:      r6, r5
  64          */
  65 start_idma_transfer_0:
  66         /* set the byte count, including the OWN bit */
  67         mr      r6, r11
  68         ori     r6, r6, CHANNEL0_DMA_BYTE_COUNT
  69         stwbrx  r5, 0, (r6)
  70
  71         /* set the source address */
  72         mr      r6, r11
  73         ori     r6, r6, CHANNEL0_DMA_SOURCE_ADDRESS
  74         stwbrx  r4, 0, (r6)
  75
  76         /* set the dest address */
  77         mr      r6, r11
  78         ori     r6, r6, CHANNEL0_DMA_DESTINATION_ADDRESS
  79         stwbrx  r3, 0, (r6)
  80
  81         /* set the next record pointer */
  82         li      r5, 0
  83         mr      r6, r11
  84         ori     r6, r6, CHANNEL0NEXT_RECORD_POINTER
  85         stwbrx  r5, 0, (r6)
  86
  87         /* set the low control register */
  88         /* bit 9 is NON chained mode, bit 31 is new style descriptors.
  89            bit 12 is channel enable */
  90         ori     r5, r5, (1 << 12) | (1 << 12) | (1 << 11)
  91         /* 15 shifted by 16 (oris) == bit 31 */
  92         oris    r5, r5, (1 << 15)
  93         mr      r6, r11
  94         ori     r6, r6, CHANNEL0CONTROL
  95         stwbrx  r5, 0, (r6)
  96
  97         blr
  98
  99         /* this waits for the bytecount to return to zero, indicating
 100          * that the trasfer is complete */
 101 wait_for_idma_0:
 102         mr      r5, r11
 103         lis     r6, 0xff
 104         ori     r6, r6, 0xffff
 105         ori     r5, r5, CHANNEL0_DMA_BYTE_COUNT
 106 1:      lwbrx   r4, 0, (r5)
 107         and.    r4, r4, r6
 108         bne     1b
 109
 110         blr
 111
 112         /* this turns off channel 0 of the idma engine */
 113 stop_idma_engine_0:
 114         /* shut off the DMA engine */
 115         li      r5, 0
 116         mr      r6, r11
 117         ori     r6, r6, CHANNEL0CONTROL
 118         stwbrx  r5, 0, (r6)
 119
 120         blr
 121 #endif
 122
 123 #ifdef CONFIG_SYS_BOARD_ASM_INIT
 124         /* NOTE: trashes r3-r7 */
 125         .globl board_asm_init
 126 board_asm_init:
 127         /* just move the GT registers to where they belong */
 128         lis     r3, CONFIG_SYS_DFL_GT_REGS@h
 129         ori     r3, r3, CONFIG_SYS_DFL_GT_REGS@l
 130         lis     r4, CONFIG_SYS_GT_REGS@h
 131         ori     r4, r4, CONFIG_SYS_GT_REGS@l
 132         li      r5, INTERNAL_SPACE_DECODE
 133
 134         /* test to see if we've already moved */
 135         lwbrx   r6, r5, r4
 136         andi.   r6, r6, 0xffff
 137         /* check loading of R7 is: 0x0F80 should: 0xf800: DONE */
 138 /*      rlwinm  r7, r4, 8, 16, 31
 139         rlwinm  r7, r4, 12, 16, 31      */ /* original */
 140         rlwinm  r7, r4, 16, 16, 31
 141         /* -----------------------------------------------------*/
 142         cmp     cr0, r7, r6
 143         beqlr
 144
 145         /* nope, have to move the registers */
 146         lwbrx   r6, r5, r3
 147         andis.  r6, r6, 0xffff
 148         or      r6, r6, r7
 149         stwbrx  r6, r5, r3
 150
 151         /* now, poll for the change */
 152 1:      lwbrx   r7, r5, r4
 153         cmp     cr0, r7, r6
 154         bne     1b
 155
 156         lis     r3, CONFIG_SYS_INT_SRAM_BASE@h
 157         ori     r3, r3, CONFIG_SYS_INT_SRAM_BASE@l
 158         rlwinm  r3, r3, 16, 16, 31
 159         lis     r4, CONFIG_SYS_GT_REGS@h
 160         ori     r4, r4, CONFIG_SYS_GT_REGS@l
 161         li      r5, INTEGRATED_SRAM_BASE_ADDR
 162         stwbrx  r3, r5, r4
 163
 164 2:      lwbrx   r6, r5, r4
 165         cmp     cr0, r3, r6
 166         bne     2b
 167
 168         /* done! */
 169         blr
 170 #endif
 171
 172 /* For use of the debug LEDs */
 173         .global led_on0_relocated
 174 led_on0_relocated:
 175         xor     r21, r21, r21
 176         xor     r18, r18, r18
 177         lis     r18, 0xFC80
 178         ori     r18, r18, 0x8000
 179 /*      stw     r21, 0x0(r18)   */
 180         sync
 181         blr
 182
 183         .global led_off0_relocated
 184 led_off0_relocated:
 185         xor     r21, r21, r21
 186         xor     r18, r18, r18
 187         lis     r18, 0xFC81
 188         ori     r18, r18, 0x4000
 189 /*      stw     r21, 0x0(r18)   */
 190         sync
 191         blr
 192
 193         .global led_on0
 194 led_on0:
 195         xor     r18, r18, r18
 196         lis     r18, 0x1c80
 197         ori     r18, r18, 0x8000
 198 /*      stw     r18, 0x0(r18)  */
 199         sync
 200         blr
 201
 202         .global led_off0
 203 led_off0:
 204         xor     r18, r18, r18
 205         lis     r18, 0x1c81
 206         ori     r18, r18, 0x4000
 207 /*      stw     r18, 0x0(r18)  */
 208         sync
 209         blr
 210
 211         .global led_on1
 212 led_on1:
 213         xor     r18, r18, r18
 214         lis     r18, 0x1c80
 215         ori     r18, r18, 0xc000
 216 /*      stw     r18, 0x0(r18)  */
 217         sync
 218         blr
 219
 220         .global led_off1
 221 led_off1:
 222         xor     r18, r18, r18
 223         lis     r18, 0x1c81
 224         ori     r18, r18, 0x8000
 225 /*      stw     r18, 0x0(r18)  */
 226         sync
 227         blr
 228
 229         .global led_on2
 230 led_on2:
 231         xor     r18, r18, r18
 232         lis     r18, 0x1c81
 233         ori     r18, r18, 0x0000
 234 /*      stw     r18, 0x0(r18)  */
 235         sync
 236         blr
 237
 238         .global led_off2
 239 led_off2:
 240         xor     r18, r18, r18
 241         lis     r18, 0x1c81
 242         ori     r18, r18, 0xc000
 243 /*      stw     r18, 0x0(r18)  */
 244         sync
 245         blr