annotate packages/hal/powerpc/arch/current/src/vectors.S @ 18:7253dcc42a09 ecos-sw-1999-06-25

Merge from eCos master repository on 1999-06-25-15:31:50-BST
author jlarmour
date Fri, 25 Jun 1999 08:28:05 +0000
parents 4f2df4ab82c8
children 5f5102441818
Ignore whitespace changes - Everywhere: Within whitespace: At end of lines:
rev   line source
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
1 ##==========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
2 ##
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
3 ## vectors.S
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
4 ##
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
5 ## PowerPC exception vectors
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
6 ##
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
7 ##==========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
8 #####COPYRIGHTBEGIN####
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
9 #
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
10 # -------------------------------------------
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
11 # The contents of this file are subject to the Cygnus eCos Public License
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
12 # Version 1.0 (the "License"); you may not use this file except in
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
13 # compliance with the License. You may obtain a copy of the License at
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
14 # http://sourceware.cygnus.com/ecos
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
15 #
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
16 # Software distributed under the License is distributed on an "AS IS"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
17 # basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
18 # License for the specific language governing rights and limitations under
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
19 # the License.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
20 #
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
21 # The Original Code is eCos - Embedded Cygnus Operating System, released
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
22 # September 30, 1998.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
23 #
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
24 # The Initial Developer of the Original Code is Cygnus. Portions created
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
25 # by Cygnus are Copyright (C) 1998,1999 Cygnus Solutions. All Rights Reserved.
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
26 # -------------------------------------------
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
27 #
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
28 #####COPYRIGHTEND####
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
29 ##==========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
30 #######DESCRIPTIONBEGIN####
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
31 ##
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
32 ## Author(s): nickg, jskov
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
33 ## Contributors: nickg, jskov
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
34 ## Date: 1999-02-20
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
35 ## Purpose: PowerPC exception vectors
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
36 ## Description: This file defines the code placed into the exception
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
37 ## vectors. It also contains the first level default VSRs
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
38 ## that save and restore state for both exceptions and
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
39 ## interrupts.
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
40 ##
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
41 ######DESCRIPTIONEND####
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
42 ##
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
43 ##==========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
44
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
45 #include <pkgconf/hal.h>
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
46
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
47 #ifdef CYGPKG_KERNEL
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
48 #include <pkgconf/kernel.h> // CYGPKG_KERNEL_INSTRUMENT
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
49 #endif
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
50
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
51 #define CYGARC_HAL_COMMON_EXPORT_CPU_MACROS
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
52 #include "cyg/hal/ppc_regs.h"
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
53 #include "cyg/hal/ppc.inc"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
54
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
55 #===========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
56
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
57 .file "vectors.S"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
58
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
59 .extern hal_interrupt_handlers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
60 .extern hal_interrupt_data
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
61 .extern hal_interrupt_objects
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
62
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
63 .extern cyg_instrument
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
64
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
65 .extern hal_hardware_init
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
66
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
67 #===========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
68 # MSR initialization value
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
69 # zero all bits except:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
70 # FP = floating point available
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
71 # ME = machine check enabled
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
72 # IP = vectors at 0xFFFxxxxx (ROM startup only)
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
73 # IR = instruction address translation
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
74 # DR = data address translation
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
75 # RI = recoverable interrupt
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
76
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
77 #define CYG_MSR_COMMON (MSR_FP | MSR_ME | MSR_IR | MSR_DR | MSR_RI)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
78 #if defined(CYG_HAL_STARTUP_ROM) || defined(CYG_HAL_STARTUP_STUBS)
16
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
79 # ifdef CYG_HAL_POWERPC_COPY_VECTORS
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
80 # define CYG_MSR CYG_MSR_COMMON
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
81 # else
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
82 # define CYG_MSR (CYG_MSR_COMMON | MSR_IP)
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
83 # endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
84 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
85 #ifdef CYG_HAL_STARTUP_RAM
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
86 #define CYG_MSR CYG_MSR_COMMON
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
87 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
88 #ifdef CYG_HAL_POWERPC_SIM
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
89 # When building for SIM, don~t enable MMU -- it~s not needed since caches
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
90 # are disabled, and there is a runtime simulation overhead.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
91 #undef CYG_MSR
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
92 #define CYG_MSR (CYG_MSR_COMMON & ~(MSR_IR | MSR_DR))
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
93 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
94
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
95 #===========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
96 # If the following option is enabled, we only save registers up to R12.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
97 # The PowerPC ABI defines registers 13..31 as callee saved and thus we do
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
98 # not need to save them when calling C functions.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
99
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
100 #ifdef CYGDBG_HAL_COMMON_INTERRUPTS_SAVE_MINIMUM_CONTEXT
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
101
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
102 #define MAX_SAVE_REG 12
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
103
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
104 #else
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
105
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
106 #define MAX_SAVE_REG 31
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
107
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
108 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
109
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
110 #===========================================================================
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
111 # Start by defining the exceptions vectors that must be placed at
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
112 # locations 0xFFF00000 and 0x00000000. The following code will normally
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
113 # be located at 0xFFF00000 in the ROM. It may optionally be copied out
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
114 # to 0x00000000 if we want to use the RAM vectors. For this reason this code
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
115 # MUST BE POSITION INDEPENDENT. In RAM loaded configurations, this code may
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
116 # be placed at 0x00000000 during loading.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
117
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
118 .section ".vectors","ax"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
119
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
120 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
121 # Unused first vector.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
122
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
123 rom_vectors:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
124 lwi r3,_start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
125 mtlr r3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
126 blr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
127
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
128 .byte 0x11
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
129 .byte 0x22
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
130 .byte 0x33
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
131 .byte 0x44
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
132
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
133 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
134 # Reset vector.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
135
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
136 .p2align 8
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
137 .globl reset_vector
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
138
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
139 reset_vector:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
140 lwi r3,_start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
141 mtlr r3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
142 blr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
143
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
144 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
145 # Macro for generating an exception vector service routine
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
146
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
147 .macro exception_vector name
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
148 .p2align 8
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
149 .globl __exception_\name
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
150 __exception_\name:
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
151 mtspr SPRG1,r3 # stash some work registers away
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
152 mtspr SPRG2,r4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
153 mtspr SPRG3,r5
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
154 mfcr r4 # stash CR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
155 li r5,__exception_\name@L # load low half of vector address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
156 srwi r5,r5,6 # shift right by 6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
157 lwi r3,hal_vsr_table # table base
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
158 lwzx r3,r3,r5 # address of vsr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
159 mflr r5 # save link register
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
160 mtlr r3 # put vsr address into it
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
161 li r3,__exception_\name@L # reload low half of vector address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
162 blr # go to common code
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
163 .endm
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
164
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
165 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
166 # Define the exception vectors.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
167
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
168 # These are the architecture defined vectors that
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
169 # are always present.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
170
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
171 exception_vector machine_check
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
172 exception_vector data_storage
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
173 exception_vector instruction_storage
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
174 exception_vector external
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
175 exception_vector alignment
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
176 #if defined(CYG_HAL_STARTUP_ROM) || defined(CYG_HAL_STARTUP_STUBS) \
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
177 || defined(CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS)
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
178 exception_vector program
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
179 #else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
180 # Provide a crude hook to the GDB exception handler in ROM.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
181 # This allows the testing infrastructure to rely on breakpoints
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
182 # to terminate tests, even when the tests are compiled without
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
183 # the GDB stub.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
184 # It is _not_ a generic solution to the problem; in particular it
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
185 # is not possible to continue after a breakpoint is hit.
18
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
186 #
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
187 # Note that for platforms where StubROM vectors are copied into RAM
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
188 # at 0x00000000, simply skipping the copy of vector 0x700 is a
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
189 # better solution. See CYGPRI_STUBROM_HAS_RAM_VECTORS below.
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
190
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
191 .p2align 8
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
192 .globl __exception_program
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
193 __exception_program:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
194 bl _init_CPU # disable caches.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
195 lwi r3,0xfff00700 # address of trap handler
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
196 mtlr r3 # in ROM.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
197 blr # jump to it.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
198
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
199 #endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
200 exception_vector floatingpoint_unavailable
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
201 exception_vector decrementer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
202 exception_vector reserved_00a00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
203 exception_vector reserved_00b00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
204 exception_vector system_call
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
205 exception_vector trace
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
206 exception_vector floatingpoint_assist
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
207 exception_vector reserved_00f00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
208
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
209 # There are some additional vectors defined
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
210 # on various implementations.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
211
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
212 #ifdef CYG_HAL_POWERPC_MPC8xx
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
213 # MPC8xx vectors
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
214
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
215 exception_vector software_emu
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
216 exception_vector instruction_tlb_miss
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
217 exception_vector data_tlb_miss
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
218 exception_vector instruction_tlb_error
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
219 exception_vector data_tlb_error
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
220 exception_vector reserved_01500
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
221 exception_vector reserved_01600
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
222 exception_vector reserved_01700
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
223 exception_vector reserved_01800
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
224 exception_vector reserved_01900
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
225 exception_vector reserved_01A00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
226 exception_vector reserved_01B00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
227 exception_vector data_breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
228 exception_vector instruction_breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
229 exception_vector peripheral_breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
230 exception_vector NMI_port
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
231
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
232 #endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
233 rom_vectors_end:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
234
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
235 #===========================================================================
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
236 # Real startup code. We jump here from the various reset vectors to set up
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
237 # the world.
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
238
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
239 .text
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
240 .globl _start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
241
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
242 _start:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
243 # Initialize CPU
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
244 bl _init_CPU
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
245
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
246 #ifdef CYG_HAL_POWERPC_MPC8xx
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
247 # Disable special MPC8xx "development support" which
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
248 # suppresses trace exceptions. The CPU seems to hang, not
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
249 # executing from offset 0x1e00(?) as expected.
16
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
250
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
251 lwi r3,0x00000007
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
252 mtspr ICTRL,r3
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
253
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
254 li r3,0
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
255 mtspr DER, r3
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
256 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
257
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
258 # Set up global offset table
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
259 lwi r2,_GLOBAL_OFFSET_TABLE_
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
260
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
261 # set up time base register to zero
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
262 xor r3,r3,r3
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
263 mtspr TBL_W,r3
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
264 xor r4,r4,r4
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
265 mtspr TBU_W,r4
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
266
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
267 # Call platform specific hardware initialization
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
268 # This may include memory controller initialization. It is not
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
269 # safe to access RAM until after this point.
16
4f2df4ab82c8 Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents: 14
diff changeset
270 bl hal_hardware_init # this is platform dependent
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
271
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
272 # set up stack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
273 lwi sp,__interrupt_stack
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
274 mtspr SPRG0,sp # save in sprg0 for later use
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
275
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
276 #if defined(CYG_HAL_STARTUP_ROM) || defined(CYG_HAL_STARTUP_STUBS)
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
277
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
278 # Copy data from ROM to ram
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
279 lwi r3,__rom_data_start # r3 = rom start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
280 lwi r4,__ram_data_start # r4 = ram start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
281 lwi r5,__ram_data_end # r5 = ram end
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
282
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
283 cmplw r4,r5 # skip if no data
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
284 beq 2f
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
285
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
286 1:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
287 lwz r0,0(r3) # get word from ROM
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
288 stw r0,0(r4) # store in RAM
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
289 addi r3,r3,4 # increment by 1 word
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
290 addi r4,r4,4 # increment by 1 word
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
291 cmplw r4,r5 # compare
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
292 blt 1b # loop if not yet done
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
293 2:
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
294 #endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
295
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
296
18
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
297 #ifdef CYG_HAL_POWERPC_COPY_VECTORS // only for StubRom-supported startup
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
298
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
299
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
300 #ifdef CYGPRI_STUBROM_HAS_RAM_VECTORS
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
301 # ifdef CYG_HAL_STARTUP_RAM
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
302 # ifndef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
303 # define CYGPRI_SKIP_BREAKPOINT_VECTOR
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
304 # endif // no stubs
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
305 # endif // RAM startup
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
306 #endif // Stubrom vectors are in RAM
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
307
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
308 # Copy RAM exception vectors from ROM (or load place) to RAM
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
309 lwi r3,rom_vectors # r3 = rom start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
310 lwi r4,0 # r4 = ram start
18
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
311 #ifdef CYGPRI_SKIP_BREAKPOINT_VECTOR
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
312 lwi r5,__exception_program # r5 = end of first leg of copy
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
313 #else
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
314 lwi r5,rom_vectors_end # r5 = rom end
18
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
315 #endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
316
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
317 cmplw r3,r5 # skip if no vectors
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
318 beq 2f
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
319
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
320 1:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
321 lwz r0,0(r3) # get word from ROM
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
322 stw r0,0(r4) # store in RAM
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
323 addi r3,r3,4 # increment by 1 word
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
324 addi r4,r4,4 # increment by 1 word
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
325 cmplw r3,r5 # compare
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
326 blt 1b # loop if not yet done
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
327 2:
18
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
328 #ifdef CYGPRI_SKIP_BREAKPOINT_VECTOR
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
329 cmplwi r4,__exception_program@L
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
330 bne 3f # is it the breakpoint vector?
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
331 addi r4,r4,0x100 # if so, leave it well alone
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
332 addi r3,r3,0x100
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
333 lwi r5,rom_vectors_end # r5 = rom end
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
334 b 1b # and do the rest of the copy
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
335 3:
7253dcc42a09 Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents: 16
diff changeset
336 #endif // Skip copying the breakpoint vector
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
337 #endif
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
338
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
339 # clear BSS
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
340 .extern __bss_start
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
341 .extern __bss_end
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
342 lwi r3,__bss_start # r3 = start
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
343 lwi r4,__bss_end # r4 = end
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
344 li r0,0 # r0 = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
345 cmplw r3,r4 # skip if no bss
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
346 beq 2f
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
347
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
348 1: stw r0,0(r3) # store zero
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
349 addi r3,r3,4 # increment by 1 word
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
350 cmplw r3,r4 # compare
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
351 blt 1b # loop if not yet done
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
352 2:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
353
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
354 # clear SBSS
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
355 .extern __sbss_start
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
356 .extern __sbss_end
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
357 lwi r3,__sbss_start # r3 = start
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
358 lwi r4,__sbss_end # r4 = end
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
359 cmplw r3,r4 # skip if no sbss
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
360 beq 2f
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
361
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
362 1: stw r0,0(r3) # store zero
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
363 addi r3,r3,4 # increment by 1 word
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
364 cmplw r3,r4 # compare
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
365 blt 1b # loop if not yet done
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
366 2:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
367
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
368 # It is now safe to call C functions which may rely on initialized
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
369 # data.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
370
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
371 # Set up stack for calls to C code.
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
372 subi sp,sp,12 # make space on stack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
373 li r0,0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
374 stw r0,0(sp) # clear back chain
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
375 stw r0,8(sp) # zero return pc
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
376 stwu sp,-ppc_stack_frame_size(sp) # create new stack frame
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
377
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
378 # Initialize MMU.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
379 .extern hal_MMU_init
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
380 bl hal_MMU_init
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
381
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
382 # Enable MMU it so we can safely enable caches.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
383 lwi r3,CYG_MSR
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
384 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
385 mtmsr r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
386 sync
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
387
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
388 # Enable caches
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
389 .extern hal_enable_caches
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
390 bl hal_enable_caches
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
391
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
392 # call c++ constructors
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
393 .extern cyg_hal_invoke_constructors
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
394 bl cyg_hal_invoke_constructors
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
395
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
396 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
397 .extern initialize_stub
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
398 bl initialize_stub
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
399 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
400
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
401 .extern cyg_start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
402 bl cyg_start # call cyg_start
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
403 9:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
404 b 9b # if we return, loop
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
405
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
406 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
407 # This code handles the common part of all exception handlers.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
408 # It saves the machine state onto the stack and then calls
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
409 # a "C" routine to do the rest of the work. This work may result
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
410 # in thread switches, and changes to the saved state. When we return
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
411 # here the saved state is restored and execution is continued.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
412
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
413 .text
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
414
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
415 .extern __default_exception_vsr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
416 __default_exception_vsr:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
417
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
418 # We come here with all register containing their
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
419 # pre-exception values except:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
420 # R3 = ls 16 bits of vector address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
421 # R4 = saved CR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
422 # R5 = saved LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
423 # LR = VSR address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
424 # SPRG1 = old R3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
425 # SPRG2 = old R4
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
426 # SPRG3 = old R5
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
427 # SRR0 = old PC
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
428 # SRR1 = old MSR and the exception cause (the POW state is lost!)
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
429
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
430 subi r1,r1,ppc_exception_decrement
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
431 # leave space for registers and
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
432 # a safety margin
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
433
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
434 # First, save away some registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
435 stw r3,ppcreg_vector(r1) # stash vector
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
436 stw r4,ppcreg_cr(r1) # stash CR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
437 stw r5,ppcreg_lr(r1) # stash LR
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
438
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
439 # Enable MMU.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
440 lwi r3,CYG_MSR
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
441 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
442 mtmsr r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
443 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
444
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
445 mfspr r3,SPRG1 # save original R3
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
446 stw r3,ppcreg_regs+3*4(r1)
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
447 mfspr r4,SPRG2 # save original R4
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
448 stw r4,ppcreg_regs+4*4(r1)
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
449 mfspr r5,SPRG3 # save original R5
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
450 stw r5,ppcreg_regs+5*4(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
451
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
452 stw r0,ppcreg_regs(r1) # save R0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
453 stw r2,ppcreg_regs+2*4(r1) # save R2
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
454
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
455 mr r3,r1 # recreate original R1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
456 addi r3,r3,ppc_exception_decrement
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
457 stw r3,ppcreg_regs+1*4(r1) # and save it in state
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
458
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
459 # Save registers r6..r12/r31
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
460 .set _reg,6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
461 .rept MAX_SAVE_REG+1-6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
462 stw _reg,(ppcreg_regs+_reg*4)(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
463 .set _reg,_reg+1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
464 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
465
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
466 # Save registers used in vsr (r14+r15)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
467 stw r14,(ppcreg_regs+14*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
468 stw r15,(ppcreg_regs+15*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
469
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
470 # get remaining CPU registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
471 mfxer r3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
472 mfctr r5
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
473 mfdar r6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
474 mfdsisr r7
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
475 mfpvr r8
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
476 mfsrr0 r9
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
477 mfsrr1 r10
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
478
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
479 # and store them
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
480 stw r3,ppcreg_xer(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
481 stw r5,ppcreg_ctr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
482 stw r6,ppcreg_dar(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
483 stw r7,ppcreg_dsisr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
484 stw r8,ppcreg_pvr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
485 stw r9,ppcreg_pc(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
486 stw r10,ppcreg_msr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
487
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
488 # The entire CPU state is now stashed on the stack,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
489 # call into C to do something with it.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
490
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
491 mr r3,sp # R3 = register dump
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
492
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
493 subi sp,sp,ppc_stack_frame_size # make a null frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
494
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
495 li r0,0 # R0 = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
496 stw r0,0(sp) # backchain = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
497 stw r0,8(sp) # return pc = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
498
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
499 stwu sp,-ppc_stack_frame_size(sp) # create new stack frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
500 # where C code can save LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
501
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
502 lwi r5,restore_state # get return link
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
503 mtlr r5 # to link register
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
504
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
505 .extern cyg_hal_exception_handler
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
506 b cyg_hal_exception_handler # call C code, r3 = registers
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
507
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
508 # When the call returns it will go to restore_state below.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
509
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
510
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
511 ##--------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
512 ## The following macros are defined depending on whether the Interrupt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
513 ## system is using isr tables or chaining, and depending on the interrupt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
514 ## controller in the system.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
515
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
516 ## Note: CYG_ISR_TABLE_SIZE must match CYG_ISR_COUNT defined in hal_intr.h.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
517
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
518 #ifdef CYG_HAL_POWERPC_MPC8xx
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
519
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
520 ## First level decoding of MPC8xx SIU interrupt controller.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
521
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
522 #define CYG_ISR_TABLE_SIZE 59
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
523
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
524 # decode the interrupt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
525 .macro decode_interrupt dreg,state
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
526 lwz \dreg,ppcreg_vector(\state) # retrieve vector number,
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
527 rlwinm. \dreg,\dreg,22,31,31 # isolate bit 21
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
528 beq 0f # done if decrementer (vec 0)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
529 lwi \dreg,CYGARC_REG_IMM_SIVEC # if external, get SIU
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
530 lbz \dreg,0(\dreg) # vector.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
531 srwi \dreg,\dreg,2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
532 addi \dreg,\dreg,1 # Skip decrementer vector
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
533 0: stw \dreg,ppcreg_vector(\state) # update vector in state frame.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
534 slwi \dreg,\dreg,2 # convert to byte offset.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
535 .endm
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
536
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
537 #else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
538
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
539 ## This is the simple version. No interrupt controller, ppcreg_vector
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
540 ## is updated with the decoded interrupt vector. Isr tables/chaining
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
541 ## use same interrupt decoder.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
542 ## Bit 21 biffers between decrementer (0) and external (1).
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
543
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
544 #define CYG_ISR_TABLE_SIZE 2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
545
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
546 # decode the interrupt
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
547 .macro decode_interrupt dreg,state
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
548 lwz \dreg,ppcreg_vector(\state) # retrieve vector number,
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
549 rlwinm \dreg,\dreg,22,31,31 # isolate bit 21 and update
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
550 stw \dreg,ppcreg_vector(\state) # vector in state frame.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
551 slwi \dreg,\dreg,2 # convert to word offset.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
552 .endm
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
553
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
554 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
555
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
556 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
557 # Common interrupt handling code.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
558
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
559 .extern __default_interrupt_vsr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
560 __default_interrupt_vsr:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
561
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
562 # We come here with all register containing their
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
563 # pre-exception values except:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
564 # R3 = ls 16 bits of vector address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
565 # R4 = saved CR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
566 # R5 = saved LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
567 # LR = VSR address
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
568 # SPRG1 = old R3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
569 # SPRG2 = old R4
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
570 # SPRG3 = old R5
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
571 # SRR0 = old PC
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
572 # SRR1 = old MSR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
573
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
574
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
575 subi r1,r1,ppc_exception_decrement
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
576 # leave space for registers and
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
577 # a safety margin
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
578
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
579 stw r3,ppcreg_vector(r1) # stash vector
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
580 stw r4,ppcreg_cr(r1) # stash CR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
581 stw r5,ppcreg_lr(r1) # stash LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
582
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
583 # Enable MMU.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
584 lwi r3,CYG_MSR
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
585 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
586 mtmsr r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
587 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
588
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
589 mfspr r3,SPRG1 # save original R3
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
590 stw r3,ppcreg_regs+3*4(r1)
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
591 mfspr r4,SPRG2 # save original R4
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
592 stw r4,ppcreg_regs+4*4(r1)
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
593 mfspr r5,SPRG3 # save original R5
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
594 stw r5,ppcreg_regs+5*4(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
595
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
596 stw r0,ppcreg_regs(r1) # save R0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
597 stw r2,ppcreg_regs+2*4(r1) # save R2
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
598
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
599 mr r3,r1 # recreate original R1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
600 addi r3,r3,ppc_exception_decrement
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
601 stw r3,ppcreg_regs+1*4(r1) # and save it in state
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
602
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
603 # Save registers r6..r12/r31
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
604 .set _reg,6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
605 .rept MAX_SAVE_REG+1-6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
606 stw _reg,(ppcreg_regs+_reg*4)(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
607 .set _reg,_reg+1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
608 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
609
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
610 # Save registers used in vsr (r14+r15)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
611 stw r14,(ppcreg_regs+14*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
612 stw r15,(ppcreg_regs+15*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
613
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
614 # get remaining CPU registers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
615 mfxer r3
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
616 mfctr r5
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
617 mfsrr0 r6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
618 mfsrr1 r7
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
619
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
620 # and store them
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
621 stw r3,ppcreg_xer(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
622 stw r5,ppcreg_ctr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
623 stw r6,ppcreg_pc(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
624 stw r7,ppcreg_msr(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
625
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
626 # The entire CPU state is now stashed on the stack,
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
627 # increment the scheduler lock and call the ISR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
628 # for this vector.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
629
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
630 #ifdef CYGFUN_HAL_COMMON_KERNEL_SUPPORT
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
631 .extern cyg_scheduler_sched_lock
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
632 lwi r3,cyg_scheduler_sched_lock
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
633 lwz r4,0(r3)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
634 addi r4,r4,1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
635 stw r4,0(r3)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
636 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
637
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
638 mr r14,sp # r14 = register dump
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
639
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
640 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
641 lwi r3,__interrupt_stack # stack top
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
642 lwi r4,__interrupt_stack_base # stack base
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
643 sub. r5,sp,r4 # sp - base
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
644 blt 1f # if < 0 - not on istack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
645 sub. r5,r3,sp # top - sp
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
646 bgt 2f # if > 0 - already on istack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
647
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
648 1: mr sp,r3 # switch to istack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
649
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
650 2: stwu r14,-4(sp) # save old SP on stack
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
651
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
652 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
653
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
654 subi sp,sp,ppc_stack_frame_size # make a null frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
655
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
656 li r0,0 # R0 = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
657 stw r0,0(sp) # backchain = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
658 stw r0,8(sp) # return pc = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
659
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
660 stwu sp,-ppc_stack_frame_size(sp) # create new stack frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
661 # where C code can save LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
662
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
663 #if defined(CYGPKG_KERNEL_INSTRUMENT) && defined(CYGDBG_KERNEL_INSTRUMENT_INTR)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
664
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
665 lwi r3,0x0301 # r3 = type = INTR,RAISE
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
666 lwz r4,ppcreg_vector(r14) # arg1 = vector address
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
667 srwi r4,r4,8 # arg1 = vector number
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
668 xor r5,r5,r5 # arg2 = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
669 bl cyg_instrument # call instrument function
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
670
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
671 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
672
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
673 decode_interrupt r15,r14 # get table index
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
674
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
675 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
676 .extern cyg_hal_gdb_isr
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
677 lwz r3,ppcreg_pc(r14) # for serial receive irq.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
678 bl cyg_hal_gdb_isr # (arg1 is PC)
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
679 cmpwi r3,0x0000 # Call ISR proper?
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
680 beq 2f # (r3 is 0 when skipping
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
681 # to avoid DSR call)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
682 1:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
683 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
684
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
685 #ifdef CYGSEM_HAL_COMMON_INTERRUPTS_ALLOW_NESTING
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
686
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
687 #ifdef CYG_HAL_POWERPC_MPC8xx
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
688 # The CPM controller allows nested interrupts. However,
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
689 # it sits on the back of the SIU controller which has no
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
690 # HW support for this. In effect, SW masking of lower
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
691 # priority IRQs in the SIU would be required for this to work.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
692 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
693
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
694 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
695
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
696 lwz r3,ppcreg_vector(r14) # retrieve decoded vector #
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
697
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
698 lwi r6,hal_interrupt_handlers # get interrupt handler table
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
699 lwzx r6,r6,r15 # load routine pointer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
700
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
701 lwi r4,hal_interrupt_data # get interrupt data table
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
702 lwzx r4,r4,r15 # load data pointer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
703 # R4 = data argument
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
704
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
705 mtctr r6 # put isr address in ctr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
706
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
707 bctrl # branch to ctr reg and link
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
708
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
709 #ifdef CYGDBG_HAL_DEBUG_GDB_BREAK_SUPPORT
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
710 # If interrupt was caused by GDB, the ISR call above
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
711 # is skipped by jumping here.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
712 2:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
713 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
714
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
715 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
716
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
717 # If we are returning from the last nested interrupt, move back
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
718 # to the thread stack. interrupt_end() must be called on the
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
719 # thread stack since it potentially causes a context switch.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
720 # Since we have arranged for the top of stack location to
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
721 # contain the sp we need to go back to here, just pop it off
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
722 # and put it in SP.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
723
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
724
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
725 lwz sp,ppc_stack_frame_size*2(sp) # sp = *sp
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
726
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
727 subi sp,sp,ppc_stack_frame_size # make a null frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
728
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
729 li r0,0 # R0 = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
730 stw r0,0(sp) # backchain = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
731 stw r0,8(sp) # return pc = 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
732
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
733 stwu sp,-ppc_stack_frame_size(sp) # create new stack frame
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
734 # where C code can save LR
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
735 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
736
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
737 #ifdef CYGFUN_HAL_COMMON_KERNEL_SUPPORT
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
738
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
739 # We only need to call _interrupt_end() when there is a kernel
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
740 # present to do any tidying up.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
741
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
742 # on return r3 bit 1 will indicate whether a DSR is
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
743 # to be posted. Pass this together with a pointer to
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
744 # the interrupt object we have just used to the
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
745 # interrupt tidy up routine.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
746
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
747 # Note that r14 and r15 are defined to be preserved across
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
748 # calls by the calling convention, so they still contain
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
749 # the register dump and the vector number respectively.
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
750
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
751 # Note: The instructions restoring the msr mask out the POW bit.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
752 # When eCos gets power management aware, this bit will have to be
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
753 # set to the correct state rather than just cleared.
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
754
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
755 lwi r4,hal_interrupt_objects # get interrupt object table
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
756 lwzx r4,r4,r15 # load object pointer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
757
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
758 lwz r6,ppcreg_msr(r14) # restore msr, including
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
759 lis r5,0xfffe # interrupt enable.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
760 andc r6,r6,r5 # mask out reserved bits
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
761 sync # (and POW!)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
762 mtmsr r6
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
763 sync
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
764
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
765 mr r5,r14 # arg3 = saved register dump
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
766
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
767 .extern interrupt_end
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
768 bl interrupt_end # call into C to finish off
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
769 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
770
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
771 restore_state:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
772 # All done, restore CPU state and continue
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
773
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
774 addi sp,sp,ppc_stack_frame_size*2 # retrieve CPU state pointer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
775
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
776 # get sprs we want to restore
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
777 lwz r3,ppcreg_cr(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
778 lwz r4,ppcreg_pc(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
779 lwz r5,ppcreg_msr(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
780 lwz r6,ppcreg_xer(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
781 lwz r7,ppcreg_lr(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
782 lwz r8,ppcreg_ctr(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
783
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
784
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
785 # stuff some of them into the CPU
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
786 mtxer r6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
787 mtlr r7
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
788 mtctr r8
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
789
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
790 # restore R0 and R2
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
791 lwz r0,ppcreg_regs(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
792 lwz r2,ppcreg_regs+2*4(sp)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
793
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
794 # Restore registers used in vsr (r14+r15)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
795 lwz r14,(ppcreg_regs+14*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
796 lwz r15,(ppcreg_regs+15*4)(r1)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
797
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
798 # restore registers r6..r12/r31
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
799 .set _reg,6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
800 .rept MAX_SAVE_REG+1-6
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
801 lwz _reg,(ppcreg_regs+_reg*4)(r1)
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
802 .set _reg,_reg+1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
803 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
804
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
805 # Here all the registers are loaded except
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
806 # r1 = ppcregs
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
807 # r3 = ccr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
808 # r4 = srr0 = pc
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
809 # r5 = srr1 = msr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
810
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
811 # We have to disable interrupts while srr0 and
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
812 # srr1 are loaded, since another interrupt will
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
813 # destroy them.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
814
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
815 mtcr r3 # set ccr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
816
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
817 lwi r3,CYG_MSR # do rest with ints disabled
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
818 sync
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
819 mtmsr r3
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
820 sync
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
821
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
822 mtsrr0 r4 # load old pc
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
823 mtsrr1 r5 # load old msr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
824
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
825 lwz r3,ppcreg_regs+3*4(r1) # load r3 value
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
826 lwz r4,ppcreg_regs+4*4(r1) # load r4 value
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
827 lwz r5,ppcreg_regs+5*4(r1) # load r5 value
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
828 lwz r1,ppcreg_regs+1*4(r1) # restore r1
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
829
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
830 sync # settle things down
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
831 isync
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
832 rfi # and return
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
833
10
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
834
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
835
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
836 ##-----------------------------------------------------------------------------
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
837 ## Execute pending DSRs on the interrupt stack with interrupts enabled.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
838 ## Note: this can only be called from code running on a thread stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
839
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
840 #ifdef CYGIMP_HAL_COMMON_INTERRUPTS_USE_INTERRUPT_STACK
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
841 .extern cyg_interrupt_call_pending_DSRs
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
842
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
843 FUNC_START(hal_interrupt_stack_call_pending_DSRs)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
844 # Disable interrupts
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
845 mfmsr r4
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
846 lis r3,0
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
847 ori r3,r3,0x8000
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
848 andc r5,r4,r3
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
849 mtmsr r5
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
850
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
851 # Change to interrupt stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
852 mr r3,sp
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
853 lwi sp,__interrupt_stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
854 stwu r3,-4(sp) # store old stackptr on stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
855 mflr r3
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
856 stwu r3,-4(sp) # store lr on stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
857 stwu r4,-4(sp) # store msr values on stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
858 stwu r5,-4(sp)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
859
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
860 # Set up stack for calls to C code.
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
861 subi sp,sp,12 # make space on stack
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
862 li r0,0
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
863 stw r0,0(sp) # clear back chain
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
864 stw r0,8(sp) # zero return pc
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
865 stwu sp,-ppc_stack_frame_size(sp) # create new stack frame
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
866
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
867 # Restore interrupt state
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
868 mtmsr r4
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
869
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
870 # Call into kernel which will execute DSRs
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
871 bl cyg_interrupt_call_pending_DSRs
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
872
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
873 # Unwind stack and get msr values
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
874 lwzu r5,12+ppc_stack_frame_size(sp)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
875 lwz r4,4(sp)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
876 lwz r3,8(sp)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
877 mtlr r3
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
878
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
879 # Disable interrupts
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
880 mtmsr r5
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
881
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
882 # Restore original stack pointer, original interrupt state and return
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
883 lwz sp,12(sp)
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
884 mtmsr r4
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
885
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
886 blr
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
887 #endif
d3fbcdfa1b2f Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents: 8
diff changeset
888
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
889 #---------------------------------------------------------------------------
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
890 # Code for putting the CPU in a post-reset state; disabling MMU and caches.
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
891 _init_CPU:
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
892 #ifdef CYG_HAL_POWERPC_MPC8xx
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
893 lwi r3,CYGARC_REG_DC_CMD_CD
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
894 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
895 mtspr CYGARC_REG_DC_CST,r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
896 lwi r3,CYGARC_REG_IC_CMD_CD
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
897 isync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
898 mtspr CYGARC_REG_IC_CST,r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
899 isync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
900 #endif
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
901
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
902 # Set up MSR (disable MMU for now)
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
903 lwi r3,(CYG_MSR & ~(MSR_IR | MSR_DR))
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
904 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
905 mtmsr r3
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
906 sync
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
907 blr
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
908
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
909 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
910 # This table contains a VSR pointer for each defined exception.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
911 # All of these except 5 and 9 point to the __default_exception_vsr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
912 # above, 5 and 9 point to the __default_interrupt_vsr. Entries in
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
913 # this table may be changed using Cyg_Interrupt::set_vsr().
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
914
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
915 .data
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
916
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
917 .globl hal_vsr_table
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
918 hal_vsr_table:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
919 # Architecture defined vectors
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
920 .long __default_exception_vsr # reserved
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
921 .long __default_exception_vsr # system reset
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
922 .long __default_exception_vsr # machine check
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
923 .long __default_exception_vsr # data storage
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
924 .long __default_exception_vsr # instruction storage
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
925
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
926 .long __default_interrupt_vsr # external interrupt
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
927
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
928 .long __default_exception_vsr # alignment
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
929 .long __default_exception_vsr # program
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
930 .long __default_exception_vsr # floating point unavailable
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
931
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
932 .long __default_interrupt_vsr # decrementer
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
933
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
934 .long __default_exception_vsr # reserved 0x0a00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
935 .long __default_exception_vsr # reserved 0x0b00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
936 .long __default_exception_vsr # system call
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
937 .long __default_exception_vsr # trace
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
938 .long __default_exception_vsr # floating point assist
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
939 .long __default_exception_vsr # reserved 0x0f00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
940
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
941 #ifdef CYG_HAL_POWERPC_MPC8xx
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
942
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
943 # Implementation defined vectors
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
944 .long __default_exception_vsr # software emulation
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
945 .long __default_exception_vsr # instruction TLB miss
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
946 .long __default_exception_vsr # data TLB miss
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
947 .long __default_exception_vsr # instruction TLB error
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
948 .long __default_exception_vsr # data TLB error
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
949 .long __default_exception_vsr # reserved 0x1500
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
950 .long __default_exception_vsr # reserved 0x1600
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
951 .long __default_exception_vsr # reserved 0x1700
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
952 .long __default_exception_vsr # reserved 0x1800
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
953 .long __default_exception_vsr # reserved 0x1900
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
954 .long __default_exception_vsr # reserved 0x1a00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
955 .long __default_exception_vsr # reserved 0x1b00
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
956 .long __default_exception_vsr # data breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
957 .long __default_exception_vsr # instruction breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
958 .long __default_exception_vsr # peripheral breakpoint
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
959 .long __default_exception_vsr # non maskable development port
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
960 #endif
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
961
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
962 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
963 # Interrupt vector tables.
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
964 # These tables contain the isr, data and object pointers used to deliver
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
965 # interrupts to user code.
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
966
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
967 #if (CYG_ISR_TABLE_SIZE > 2)
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
968 .data
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
969 #else
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
970 .section ".sdata","aw"
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
971 #endif
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
972
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
973 .extern hal_default_decrementer_isr
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
974 .extern hal_default_isr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
975
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
976 .globl hal_interrupt_handlers
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
977 hal_interrupt_handlers:
14
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
978 .long hal_default_decrementer_isr
01ce82f3e11a Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents: 10
diff changeset
979 .rept CYG_ISR_TABLE_SIZE-1
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
980 .long hal_default_isr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
981 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
982
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
983 .globl hal_interrupt_data
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
984 hal_interrupt_data:
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
985 .rept CYG_ISR_TABLE_SIZE
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
986 .long 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
987 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
988
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
989 .globl hal_interrupt_objects
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
990 hal_interrupt_objects:
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
991 .rept CYG_ISR_TABLE_SIZE
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
992 .long 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
993 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
994
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
995 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
996 ## Temporary interrupt stack
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
997
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
998 .section ".bss"
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
999
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1000 .balign 16
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
1001 .global cyg_interrupt_stack_base
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
1002 cyg_interrupt_stack_base:
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1003 __interrupt_stack_base:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1004 .rept CYGNUM_HAL_COMMON_INTERRUPTS_STACK_SIZE
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1005 .byte 0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1006 .endr
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1007 .balign 16
8
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
1008 .global cyg_interrupt_stack
ece80412419a Merge from eCos master repository on 1999-05-21-22:05:54-BST
jlarmour
parents: 2
diff changeset
1009 cyg_interrupt_stack:
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1010 __interrupt_stack:
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1011
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1012 .long 0,0,0,0,0,0,0,0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1013
2
443894e2e912 Block commit of eCos version 1.2.1
jlarmour
parents: 0
diff changeset
1014 #---------------------------------------------------------------------------
0
3111d98ba7b3 Initial commit of eCos version 1.1
jlarmour
parents:
diff changeset
1015 # end of vectors.S