source: soft/giet_vm/boot/reset.S @ 173

Last change on this file since 173 was 173, checked in by karaoui, 12 years ago

Adding BLOB type for vobj.
Don't forget to set as BLOB type the mapping_info vobj in the xml.
File size: 4.8 KB
Line 
1/********************************************************************************/
2/*      File : reset.S                                                              */
3/*      Author : Alain Greiner  & Mohamed karaoui                                   */
4/*      Date : 03/06/2012                                                                                       */
5/********************************************************************************/
6/* This boot code is for a multi-cluster, multi-processor architecture,             */
7/* running one or several multi-tasks software application(s) defined in        */
8/* the mapping_info data-structure.                                                                     */
9/* Procesor 0 uses the mapping_info data structure to build all page tables     */
10/* before jumping to the kernel_init code.                                                                              */
11/* Other processors are waiting until the mapping_info signature has been       */
12/* modified by processor 0 (done while executing kernel_init code).             */
13/* Implementation note:                                                                                                                 */
14/* The entry point is 0xbfc00000, but the actual boot code starts at address    */
15/* 0xbfc00500, and a minimal boot exception handler is implemented at address   */
16/* 0xbfc0380.                                                                                                   */
17/********************************************************************************/
18               
19#include <giet_config.h>
20#include "../sys/mips32_registers.h"
21
22#define EXCEP_ORG               0x380
23#define START_ORG               0x500
24
25#define OUT_MAPPING_SIGNATURE   0xBABEF00D
26
27        .section .boot,"ax",@progbits
28        .align  2
29        .set noreorder
30
31/********************************************************/
32/* reset entry point                                    */
33/* (address 0xBFC00000 imposed by the hardware)         */
34/********************************************************/
35boot_reset:
36    j   boot_start
37        nop
38
39/*******************************************************/
40/* handling exceptions in the boot phase               */
41/* (address 0xBFC00380 imposed by the hardware         */
42/*******************************************************/
43        .align  2
44    .org        EXCEP_ORG
45boot_excep:
46    la  a0,     boot_error_string
47    jal boot_puts
48    nop
49    mfc0        a0,     CP0_TIME
50        jal     boot_putw
51        nop
52    la  a0,     boot_lf_string
53    jal boot_puts
54    nop
55
56        la      a0,     boot_pid_string
57    jal boot_puts
58    nop
59    mfc0        k0,     CP0_PROCID
60    andi        a0,     k0,     0xFFF
61        jal     boot_putw
62    nop
63    la  a0,     boot_lf_string
64    jal boot_puts
65    nop
66
67        la      a0,     boot_epc_string
68    jal boot_puts
69    nop
70    mfc0        a0,     CP0_EPC
71        jal     boot_putw
72    nop
73    la  a0,     boot_lf_string
74    jal boot_puts
75    nop
76
77        la      a0,     boot_cr_string
78    jal boot_puts
79    nop
80    mfc0        a0,     CP0_CR
81        jal     boot_putw
82    nop
83    la  a0,     boot_lf_string
84    jal boot_puts
85    nop
86
87        la      a0,     boot_sr_string
88    jal boot_puts
89    nop
90    mfc0        a0,     CP0_SR
91        jal     boot_putw
92    nop
93    la  a0,     boot_lf_string
94    jal boot_puts
95    nop
96
97        la      a0,     boot_bar_string
98    jal boot_puts
99    nop
100    mfc0        a0,     CP0_BAR
101        jal     boot_putw
102    nop
103    la  a0,     boot_lf_string
104    jal boot_puts
105    nop
106
107        j       boot_exit
108        nop
109
110/*******************************************/
111/* actual starting point for the boot code */
112/*******************************************/
113    .align      2
114    .org        START_ORG
115
116boot_start:
117    /* get the procid */
118    mfc0        k0,     CP0_PROCID
119    andi        k0,     k0,     0xFFF   /* no more than 4096 processors... */
120
121    /* Only processor 0 does init */
122    bne k0,     zero,   boot_wait_signature
123    nop
124
125    /* Processor 0 get a temporary stack */
126    la      sp, seg_boot_stack_base
127    addiu       sp,     sp,     0x3000                          /* SP <= seg_boot_stack + 12K */
128
129    /* Processor 0 initialises all Page Tables */
130    jal boot_pt_init
131    nop
132 
133    /* jump to kernel_init */
134    j           boot_to_kernel_init
135    nop
136
137boot_wait_signature:
138
139    /* all other processors are waiting signature change */
140    la  k0, seg_mapping_base
141    cache   0x11,   0(k0)                               /* invalidate local cache copy */
142    lw  k0, 0(k0)                                               /* k0 <= mapping_info[0]       */
143    li  k1,     OUT_MAPPING_SIGNATURE
144    bne k1, k0, boot_wait_signature
145    nop
146       
147    /* all other processors get a temporary stack of 256 bytes */
148    la      sp, seg_boot_stack_base
149    addiu   sp, sp, 0x3100                             
150    mfc0        k0, CP0_PROCID
151    andi    k0, k0, 0xFFF
152    sll     k0, k0, 8                                   
153    addu    sp, sp, k0          /* SP <= seg_boot_stack_base + 12K + (pid+1)*256 */
154
155boot_to_kernel_init:
156
157    /* all processors initialize PTPR with PTAB[0] */
158    la      k1, _ptabs
159    lw      k1, 0(k1)   
160    srl     k1, k1, 13
161    mtc2        k1,     CP2_PTPR                /* PTPR <= _ptabs[0]  */
162
163        /* all processors activate MMU */
164    li      k1, 0xF
165    mtc2    k1, CP2_MODE        /* MODE register */
166
167    /* jump to kernel_init */
168    la      k0, seg_kernel_init_base
169    j       k0
170    nop
171
172boot_error_string:      .asciiz "\n[BOOT] Fatal Error in reset.S at cycle "
173boot_pid_string:        .asciiz "    PID  = "
174boot_sr_string:         .asciiz "    SR   = "
175boot_cr_string:         .asciiz "    CR   = "
176boot_epc_string:        .asciiz "    EPC  = "
177boot_bar_string:        .asciiz "    BAR  = "
178boot_lf_string:         .asciiz "\n"
179
180.set    reorder
181
182
Note: See TracBrowser for help on using the repository browser.