annotate packages/hal/powerpc/arch/current/src/vectors.S @ 34:29bc183297e1 ecos-sw-1999-09-02

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