git.oblomov.eu Git - linux-2.6/blob - arch/m32r/kernel/head.S

   1 /*
   2  *  linux/arch/m32r/kernel/head.S
   3  *
   4  *  M32R startup code.
   5  *
   6  *  Copyright (c) 2001, 2002  Hiroyuki Kondo, Hirokazu Takata,
   7  *                            Hitoshi Yamamoto
   8  */
   9
  10 /* $Id$ */
  11
  12 #include <linux/init.h>
  13 __INIT
  14 __INITDATA
  15
  16         .text
  17 #include <linux/config.h>
  18 #include <linux/linkage.h>
  19 #include <asm/segment.h>
  20 #include <asm/page.h>
  21 #include <asm/pgtable.h>
  22 #include <asm/assembler.h>
  23 #include <asm/m32r.h>
  24 #include <asm/mmu_context.h>
  25
  26 /*
  27  * References to members of the boot_cpu_data structure.
  28  */
  29         .text
  30         .global start_kernel
  31         .global __bss_start
  32         .global _end
  33 ENTRY(stext)
  34 ENTRY(_stext)
  35 ENTRY(startup_32)
  36         /* Setup up the stack pointer */
  37         LDIMM   (r0, spi_stack_top)
  38         LDIMM   (r1, spu_stack_top)
  39         mvtc    r0, spi
  40         mvtc    r1, spu
  41
  42         /* Initilalize PSW */
  43         ldi     r0, #0x0000             /* use SPI, disable EI */
  44         mvtc    r0, psw
  45
  46         /* Set up the stack pointer */
  47         LDIMM   (r0, stack_start)
  48         ld      r0, @r0
  49         mvtc    r0, spi
  50
  51 /*
  52  * Clear BSS first so that there are no surprises...
  53  */
  54 #ifdef CONFIG_ISA_DUAL_ISSUE
  55
  56         LDIMM   (r2, __bss_start)
  57         LDIMM   (r3, _end)
  58         sub     r3, r2          ; BSS size in bytes
  59         ; R4 = BSS size in longwords (rounded down)
  60         mv      r4, r3              ||  ldi     r1, #0
  61         srli    r4, #4              ||  addi    r2, #-4
  62         beqz    r4, .Lendloop1
  63 .Lloop1:
  64 #ifndef CONFIG_CHIP_M32310
  65         ; Touch memory for the no-write-allocating cache.
  66         ld      r0, @(4,r2)
  67 #endif
  68         st      r1, @+r2            ||  addi    r4, #-1
  69         st      r1, @+r2
  70         st      r1, @+r2
  71         st      r1, @+r2            ||  cmpeq   r1, r4  ; R4 = 0?
  72         bnc     .Lloop1
  73 .Lendloop1:
  74         and3    r4, r3, #15
  75         addi    r2, #4
  76         beqz    r4, .Lendloop2
  77 .Lloop2:
  78         stb     r1, @r2             ||  addi    r4, #-1
  79         addi    r2, #1
  80         bnez    r4, .Lloop2
  81 .Lendloop2:
  82
  83 #else /* not CONFIG_ISA_DUAL_ISSUE */
  84
  85         LDIMM   (r2, __bss_start)
  86         LDIMM   (r3, _end)
  87         sub     r3, r2          ; BSS size in bytes
  88         mv      r4, r3
  89         srli    r4, #2          ; R4 = BSS size in longwords (rounded down)
  90         ldi     r1, #0          ; clear R1 for longwords store
  91         addi    r2, #-4         ; account for pre-inc store
  92         beqz    r4, .Lendloop1  ; any more to go?
  93 .Lloop1:
  94         st      r1, @+r2        ; yep, zero out another longword
  95         addi    r4, #-1         ; decrement count
  96         bnez    r4, .Lloop1     ; go do some more
  97 .Lendloop1:
  98         and3    r4, r3, #3      ; get no. of remaining BSS bytes to clear
  99         addi    r2, #4          ; account for pre-inc store
 100         beqz    r4, .Lendloop2  ; any more to go?
 101 .Lloop2:
 102         stb     r1, @r2         ; yep, zero out another byte
 103         addi    r2, #1          ; bump address
 104         addi    r4, #-1         ; decrement count
 105         bnez    r4, .Lloop2     ; go do some more
 106 .Lendloop2:
 107
 108 #endif /* not CONFIG_ISA_DUAL_ISSUE */
 109
 110 #if 0  /* M32R_FIXME */
 111 /*
 112  * Copy data segment from ROM to RAM.
 113  */
 114         .global ROM_D, TOP_DATA, END_DATA
 115
 116         LDIMM   (r1, ROM_D)
 117         LDIMM   (r2, TOP_DATA)
 118         LDIMM   (r3, END_DATA)
 119         addi    r2, #-4
 120         addi    r3, #-4
 121 loop1:
 122         ld      r0, @r1+
 123         st      r0, @+r2
 124         cmp     r2, r3
 125         bc      loop1
 126 #endif /* 0 */
 127
 128 /* Jump to kernel */
 129         LDIMM   (r2, start_kernel)
 130         jl      r2
 131         .fillinsn
 132 1:
 133         bra     1b              ; main should never return here, but
 134                                 ; just in case, we know what happens.
 135
 136 #ifdef CONFIG_SMP
 137 /*
 138  * AP startup routine
 139  */
 140         .text
 141         .global eit_vector
 142 ENTRY(startup_AP)
 143 ;; setup EVB
 144         LDIMM  (r4, eit_vector)
 145         mvtc   r4, cr5
 146
 147 ;; enable MMU
 148         LDIMM   (r2, init_tlb)
 149         jl      r2
 150         seth  r4, #high(MATM)
 151         or3   r4, r4, #low(MATM)
 152         ldi   r5, #0x01
 153         st    r5, @r4            ; Set MATM Reg(T bit ON)
 154         ld    r6, @r4            ; MATM Check
 155         LDIMM (r5, 1f)
 156         jmp   r5                 ; enable MMU
 157         nop
 158         .fillinsn
 159 1:
 160 ;; ISN check
 161         ld    r6, @r4            ; MATM Check
 162         seth  r4, #high(M32R_ICU_ISTS_ADDR)
 163         or3   r4, r4, #low(M32R_ICU_ISTS_ADDR)
 164         ld    r5, @r4           ; Read ISTSi reg.
 165         mv    r6, r5
 166         slli  r5, #13  ; PIML check
 167         srli  r5, #13  ;
 168         seth  r4, #high(M32R_ICU_IMASK_ADDR)
 169         or3   r4, r4, #low(M32R_ICU_IMASK_ADDR)
 170         st    r5, @r4           ; Write IMASKi reg.
 171         slli  r6, #4   ; ISN check
 172         srli  r6, #26  ;
 173         seth  r4, #high(M32R_IRQ_IPI5)
 174         or3   r4, r4, #low(M32R_IRQ_IPI5)
 175         bne   r4, r6, 2f  ; if (ISN != CPU_BOOT_IPI) goto sleep;
 176
 177 ;; check cpu_bootout_map and set cpu_bootin_map
 178         LDIMM (r4, cpu_bootout_map)
 179         ld    r4, @r4
 180         seth  r5, #high(M32R_CPUID_PORTL)
 181         or3   r5, r5, #low(M32R_CPUID_PORTL)
 182         ld    r5, @r5
 183         ldi   r6, #1
 184         sll   r6, r5
 185         and   r4, r6
 186         beqz  r4, 2f
 187         LDIMM (r4, cpu_bootin_map)
 188         ld    r5, @r4
 189         or    r5, r6
 190         st    r6, @r4
 191
 192 ;; clear PSW
 193         ldi   r4, #0
 194         mvtc  r4, psw
 195
 196 ;; setup SPI
 197         LDIMM (r4, stack_start)
 198         ld    r4, @r4
 199         mvtc  r4, spi
 200
 201 ;; setup BPC (start_secondary)
 202         LDIMM (r4, start_secondary)
 203         mvtc  r4, bpc
 204
 205         rte  ; goto startup_secondary
 206         nop
 207         nop
 208
 209         .fillinsn
 210 2:
 211         ;; disable MMU
 212         seth  r4, #high(MATM)
 213         or3   r4, r4, #low(MATM)
 214         ldi   r5, #0
 215         st    r5, @r4            ; Set MATM Reg(T bit OFF)
 216         ld    r6, @r4            ; MATM Check
 217         LDIMM (r4, 3f)
 218         seth  r5, #high(__PAGE_OFFSET)
 219         or3   r5, r5, #low(__PAGE_OFFSET)
 220         not   r5, r5
 221         and   r4, r5
 222         jmp   r4                 ; disable MMU
 223         nop
 224         .fillinsn
 225 3:
 226         ;; SLEEP and wait IPI
 227         LDIMM (r4, AP_loop)
 228         seth  r5, #high(__PAGE_OFFSET)
 229         or3   r5, r5, #low(__PAGE_OFFSET)
 230         not   r5, r5
 231         and   r4, r5
 232         jmp   r4
 233         nop
 234         nop
 235 #endif  /* CONFIG_SMP */
 236
 237 ENTRY(stack_start)
 238         .long   init_thread_union+8192
 239         .long   __KERNEL_DS
 240
 241 /*
 242  * This is initialized to create a identity-mapping at 0-4M (for bootup
 243  * purposes) and another mapping of the 0-4M area at virtual address
 244  * PAGE_OFFSET.
 245  */
 246         .text
 247
 248 #define  MOUNT_ROOT_RDONLY    1
 249 #define  RAMDISK_FLAGS        0         ; 1024KB
 250 #define  ORIG_ROOT_DEV        0x0100    ; /dev/ram0 (major:01, minor:00)
 251 #define  LOADER_TYPE          1         ; (??? - non-zero value seems
 252                                         ; to be needed to boot from initrd)
 253
 254 #define  COMMAND_LINE ""
 255
 256         .section        .empty_zero_page, "aw"
 257 ENTRY(empty_zero_page)
 258         .long   MOUNT_ROOT_RDONLY               /* offset: +0x00 */
 259         .long   RAMDISK_FLAGS
 260         .long   ORIG_ROOT_DEV
 261         .long   LOADER_TYPE
 262         .long   0       /* INITRD_START */      /* +0x10 */
 263         .long   0       /* INITRD_SIZE */
 264         .long   0       /* CPU_CLOCK */
 265         .long   0       /* BUS_CLOCK */
 266         .long   0       /* TIMER_DIVIDE */      /* +0x20 */
 267         .balign 256,0
 268         .asciz  COMMAND_LINE
 269         .byte   0
 270         .balign 4096,0,4096
 271
 272 /*------------------------------------------------------------------------
 273  * Stack area
 274  */
 275         .section .spi
 276         ALIGN
 277         .global spi_stack_top
 278         .zero   1024
 279 spi_stack_top:
 280
 281         .section .spu
 282         ALIGN
 283         .global spu_stack_top
 284         .zero   1024
 285 spu_stack_top:
 286
 287         .end