source: rtems/c/src/lib/libbsp/powerpc/shared/start/start.S @ 95273a6

4.104.114.84.95
Last change on this file since 95273a6 was 95273a6, checked in by Joel Sherrill <joel.sherrill@…>, on 01/03/00 at 14:06:42

Combination of coverhd.h cleanup and MVME23xx/MCP750 patch from Eric Valette
<valette@…> and Jay Kulpinski <jskulpin@…>.

  • Property mode set to 100644
File size: 3.3 KB
Line 
1/*
2 *  start.S :     RTEMS entry point
3 *
4 *  Copyright (C) 1999 Eric Valette. valette@crf.canon.fr
5 *
6 *  The license and distribution terms for this file may be
7 *  found in found in the file LICENSE in this distribution or at
8 *  http://www.OARcorp.com/rtems/license.html.
9 *
10 *  $Id$
11 *
12 */
13
14#include <libcpu/cpu.h>
15#include <libcpu/io.h>
16#include <rtems/score/targopts.h>
17#include <rtems/score/cpu.h>
18#include "asm.h"
19
20#define SYNC \
21        sync; \
22        isync
23
24#define KERNELBASE      0x0
25
26#define MONITOR_ENTER                   \
27        mfmsr   r10             ;       \
28        ori     r10,r10,MSR_IP  ;       \
29        mtmsr   r10             ;       \
30        li      r10,0x63        ;       \
31        sc
32                       
33        .text
34        .globl  __rtems_entry_point
35        .type   __rtems_entry_point,@function
36__rtems_entry_point:
37#ifdef DEBUG_EARLY_START
38        MONITOR_ENTER
39#endif 
40               
41/*
42 * PREP
43 * This is jumped to on prep systems right after the kernel is relocated
44 * to its proper place in memory by the boot loader.  The expected layout
45 * of the regs is:     
46 *   r3: ptr to residual data
47 *   r4: initrd_start or if no initrd then 0
48 *   r5: initrd_end - unused if r4 is 0
49 *   r6: Start of command line string
50 *   r7: End of command line string
51 *
52 *   The Prep boot loader insure that the MMU is currently off...
53 *
54 */
55       
56        mr      r31,r3                  /* save parameters */
57        mr      r30,r4
58        mr      r29,r5
59        mr      r28,r6
60        mr      r27,r7
61        /*
62         * Make sure we have nothing in BATS and TLB
63         */
64        bl      clear_bats
65        bl      flush_tlbs
66/*
67 * Use the first pair of BAT registers to map the 1st 64MB
68 * of RAM to KERNELBASE.
69 */
70        lis     r11,KERNELBASE@h
71        ori     r11,r11,0x7fe           /* set up BAT registers for 604 */
72        li      r8,2                    /* R/W access */
73        isync
74        mtspr   DBAT0L,r8               /* N.B. 6xx (not 601) have valid */
75        mtspr   DBAT0U,r11              /* bit in upper BAT register */
76        mtspr   IBAT0L,r8
77        mtspr   IBAT0U,r11
78        isync
79
80/*
81 * we now have the 1st 64M of ram mapped with the bats.
82 */
83       
84enter_C_code:
85        bl      MMUon
86        /*
87         * stack = &__rtems_end + 4096
88         */
89        addis   r9,r0, __rtems_end+(4096-CPU_MINIMUM_STACK_FRAME_SIZE)@ha
90        addi    r9,r9, __rtems_end+(4096-CPU_MINIMUM_STACK_FRAME_SIZE)@l
91        mr      r1, r9
92        bl      zero_bss
93        /*
94         * restore prep boot params
95         */
96        mr      r3,r31
97        mr      r4,r30
98        mr      r5,r29
99        mr      r6,r28
100        mr      r7,r27
101        bl      save_boot_params
102        bl      boot_card
103        bl      _return_to_ppcbug
104       
105        .globl  MMUon
106        .type   MMUon,@function
107MMUon: 
108        mfmsr   r0
109        ori     r0,r0, MSR_IP | MSR_RI | MSR_IR | MSR_DR | MSR_EE | MSR_FE0 | MSR_FE1
110        xori    r0, r0, MSR_EE | MSR_IP | MSR_FP
111        mflr    r11
112        mtsrr0  r11
113        mtsrr1  r0
114        SYNC
115        rfi
116       
117        .globl  MMUoff
118        .type   MMUoff,@function
119MMUoff:
120        mfmsr   r0
121        ori     r0,r0,MSR_IR| MSR_DR | MSR_IP
122        mflr    r11
123        xori    r0,r0,MSR_IR|MSR_DR
124        mtsrr0  r11
125        mtsrr1  r0
126        SYNC
127        rfi
128
129        .globl  _return_to_ppcbug
130        .type   _return_to_ppcbug,@function
131
132       
133_return_to_ppcbug:
134        mflr    r30
135        bl      MMUoff
136        MONITOR_ENTER
137        bl      MMUon
138        mtctr   r30
139        bctr   
140
141/*
142 * An undocumented "feature" of 604e requires that the v bit
143 * be cleared before changing BAT values.
144 *
145 * Also, newer IBM firmware does not clear bat3 and 4 so
146 * this makes sure it's done.
147 *  -- Cort
148 */
149clear_bats:
150        li      r20,0
151        mfspr   r9,PVR
152        rlwinm  r9,r9,16,16,31          /* r9 = 1 for 601, 4 for 604 */
153        cmpwi   r9, 1
154        SYNC
155        beq     1f
156        mtspr   DBAT0U,r20
157        mtspr   DBAT0L,r20     
158        mtspr   DBAT1U,r20
159        mtspr   DBAT1L,r20
160        mtspr   DBAT2U,r20
161        mtspr   DBAT2L,r20     
162        mtspr   DBAT3U,r20
163        mtspr   DBAT3L,r20
1641:     
165        mtspr   IBAT0U,r20
166        mtspr   IBAT0L,r20
167        mtspr   IBAT1U,r20
168        mtspr   IBAT1L,r20
169        mtspr   IBAT2U,r20
170        mtspr   IBAT2L,r20
171        mtspr   IBAT3U,r20
172        mtspr   IBAT3L,r20
173        SYNC   
174        blr
175
176flush_tlbs:
177        lis     r20, 0x1000
1781:      addic.  r20, r20, -0x1000
179        tlbie   r20
180        blt     1b
181        sync
182        blr
183       
Note: See TracBrowser for help on using the repository browser.