Mercurial > flash_v2
annotate packages/hal/powerpc/arch/current/src/hal_misc.c @ 70:c5536bad4c24 ecos-sw-2000-02-11
Merge from eCos master repository on 2000-02-11-15:46:40-GMT
| author | jlarmour |
|---|---|
| date | Fri, 11 Feb 2000 16:47:32 +0000 |
| parents | f74b2666b30d |
| children | da3908c9cd10 |
| rev | line source |
|---|---|
| 2 | 1 //========================================================================== |
| 0 | 2 // |
| 3 // hal_misc.c | |
| 4 // | |
| 5 // HAL miscellaneous functions | |
| 6 // | |
| 2 | 7 //========================================================================== |
| 0 | 8 //####COPYRIGHTBEGIN#### |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
9 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
10 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
11 // The contents of this file are subject to the Red Hat eCos Public License |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
12 // Version 1.1 (the "License"); you may not use this file except in |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
13 // compliance with the License. You may obtain a copy of the License at |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
14 // http://www.redhat.com/ |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
15 // |
|
66
bf00f99aec69
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
jlarmour
parents:
64
diff
changeset
|
16 // Software distributed under the License is distributed on an "AS IS" |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
17 // basis, WITHOUT WARRANTY OF ANY KIND, either express or implied. See the |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
18 // License for the specific language governing rights and limitations under |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
19 // the License. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
20 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
21 // The Original Code is eCos - Embedded Configurable Operating System, |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
22 // released September 30, 1998. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
23 // |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
24 // The Initial Developer of the Original Code is Red Hat. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
25 // Portions created by Red Hat are |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
26 // Copyright (C) 1998, 1999, 2000 Red Hat, Inc. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
27 // All Rights Reserved. |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
28 // ------------------------------------------- |
|
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
29 // |
| 0 | 30 //####COPYRIGHTEND#### |
| 2 | 31 //========================================================================== |
| 0 | 32 //#####DESCRIPTIONBEGIN#### |
| 33 // | |
| 2 | 34 // Author(s): nickg, jskov |
| 35 // Contributors: nickg, jskov, | |
| 36 // jlarmour | |
| 37 // Date: 1999-02-20 | |
| 38 // Purpose: HAL miscellaneous functions | |
| 39 // Description: This file contains miscellaneous functions provided by the | |
| 40 // HAL. | |
| 0 | 41 // |
| 42 //####DESCRIPTIONEND#### | |
| 43 // | |
| 2 | 44 //=========================================================================== |
| 0 | 45 |
| 46 #include <pkgconf/hal.h> | |
| 47 | |
| 2 | 48 #define CYGARC_HAL_COMMON_EXPORT_CPU_MACROS |
| 49 #include <cyg/hal/ppc_regs.h> // SPR definitions | |
| 50 | |
| 0 | 51 #include <cyg/infra/cyg_type.h> |
| 52 #include <cyg/infra/cyg_trac.h> // tracing macros | |
| 53 #include <cyg/infra/cyg_ass.h> // assertion macros | |
| 2 | 54 #include <cyg/infra/diag.h> // diag_printf |
| 0 | 55 |
| 56 #include <cyg/hal/hal_arch.h> // HAL header | |
| 2 | 57 #include <cyg/hal/hal_cache.h> // HAL cache |
| 58 #if defined(CYGFUN_HAL_COMMON_KERNEL_SUPPORT) && \ | |
| 59 defined(CYGPKG_HAL_EXCEPTIONS) | |
| 60 # include <cyg/hal/hal_intr.h> // HAL interrupts/exceptions | |
| 61 #endif | |
| 0 | 62 |
| 63 //--------------------------------------------------------------------------- | |
| 2 | 64 // Functions used during initialization. |
| 0 | 65 |
| 2 | 66 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG |
| 67 cyg_bool cyg_hal_stop_constructors; | |
| 68 #endif | |
| 69 | |
| 70 typedef void (*pfunc) (void); | |
| 71 extern pfunc __CTOR_LIST__[]; | |
| 72 extern pfunc __CTOR_END__[]; | |
| 0 | 73 |
| 2 | 74 void |
| 75 cyg_hal_invoke_constructors (void) | |
| 76 { | |
| 77 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG | |
| 78 static pfunc *p = &__CTOR_END__[-1]; | |
| 79 | |
| 80 cyg_hal_stop_constructors = 0; | |
| 81 for (; p >= __CTOR_LIST__; p--) { | |
| 82 (*p) (); | |
| 83 if (cyg_hal_stop_constructors) { | |
| 84 p--; | |
| 85 break; | |
| 0 | 86 } |
| 87 } | |
| 2 | 88 #else |
| 89 pfunc *p; | |
| 90 | |
| 91 for (p = &__CTOR_END__[-1]; p >= __CTOR_LIST__; p--) | |
| 92 (*p) (); | |
| 93 #endif | |
| 0 | 94 } |
| 95 | |
| 96 // Override any __eabi the compiler might generate. We don't want | |
| 97 // constructors to be called twice. | |
| 98 void __eabi (void) {} | |
| 99 | |
| 100 //--------------------------------------------------------------------------- | |
| 101 // First level C exception handler. | |
| 102 | |
| 103 externC void __handle_exception (void); | |
| 104 | |
| 105 externC HAL_SavedRegisters *_hal_registers; | |
| 106 | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
107 externC void *__mem_fault_handler; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
108 |
| 2 | 109 void |
| 110 cyg_hal_exception_handler(HAL_SavedRegisters *regs) | |
| 0 | 111 { |
| 112 #ifdef CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS | |
| 113 | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
114 // If we caught an exception inside the stubs, see if we were expecting it |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
115 // and if so jump to the saved address |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
116 if (__mem_fault_handler) { |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
117 regs->pc = (CYG_ADDRWORD)__mem_fault_handler; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
118 return; // Caught an exception inside stubs |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
119 } |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
120 |
| 0 | 121 // Set the pointer to the registers of the current exception |
| 122 // context. At entry the GDB stub will expand the | |
| 123 // HAL_SavedRegisters structure into a (bigger) register array. | |
| 124 _hal_registers = regs; | |
| 125 | |
| 126 __handle_exception(); | |
| 127 | |
|
32
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
128 #ifdef CYGPKG_HAL_QUICC |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
129 { |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
130 // This is unpleasant: it appears that if we interrupt the board |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
131 // using ^C coming in on the QUICC's SMC1, by planting a breakpoint |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
132 // at the interrupt return address, the decrementer interrupt is |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
133 // not taken when the bp exception returns AND WORSE no other |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
134 // interrupt is possible until the decrementer fires again. This |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
135 // does not apply to simple "incoming character" interrupts; it |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
136 // seems it has to be combined with an immediate trap on RTI for |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
137 // this to occur. |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
138 // |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
139 // The solution is to test for decrementer underflow after the |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
140 // (any) exception, and maybe reinitialize the decrementer. If the |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
141 // decrementer interrupt gets taken, that causes decrementer reinit |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
142 // too, and no harm is done. |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
143 |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
144 cyg_uint32 result; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
145 asm volatile( |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
146 "mfdec %0;" |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
147 : "=r"(result) |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
148 ); |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
149 |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
150 if ( CYGNUM_HAL_RTC_PERIOD < result ) { |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
151 // then we missed a tick, but the exception masked it |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
152 // reset the decrementer here |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
153 asm volatile( |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
154 "mtdec %0;" |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
155 : : "r"(CYGNUM_HAL_RTC_PERIOD) |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
156 ); |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
157 } |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
158 } |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
159 #endif |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
160 |
| 2 | 161 #elif defined(CYGFUN_HAL_COMMON_KERNEL_SUPPORT) && \ |
| 162 defined(CYGPKG_HAL_EXCEPTIONS) | |
| 163 int vector = regs->vector>>8; | |
| 0 | 164 |
| 165 // We should decode the vector and pass a more appropriate | |
| 166 // value as the second argument. For now we simply pass a | |
| 167 // pointer to the saved registers. We should also divert | |
| 168 // breakpoint and other debug vectors into the debug stubs. | |
| 169 | |
| 2 | 170 if (vector==CYGNUM_HAL_VECTOR_PROGRAM) { |
| 171 int srr1; | |
| 172 CYGARC_MFSPR(CYGARC_REG_SRR1, srr1); // get srr1 | |
| 173 | |
| 174 switch ((srr1 >> 17) & 0xf) { | |
| 175 case 1: | |
| 176 vector = CYGNUM_HAL_EXCEPTION_TRAP; | |
| 177 break; | |
| 178 case 2: | |
| 179 vector = CYGNUM_HAL_EXCEPTION_PRIVILEGED_INSTRUCTION; | |
| 180 break; | |
| 181 case 4: | |
| 182 vector = CYGNUM_HAL_EXCEPTION_ILLEGAL_INSTRUCTION; | |
| 183 break; | |
| 184 case 8: | |
| 185 vector = CYGNUM_HAL_EXCEPTION_FPU; | |
| 186 break; | |
| 187 default: | |
| 188 CYG_FAIL("Unknown PROGRAM exception!!"); | |
| 189 } | |
| 190 } | |
| 191 cyg_hal_deliver_exception( vector, (CYG_ADDRWORD)regs ); | |
| 0 | 192 |
| 193 #else | |
| 194 | |
| 195 CYG_FAIL("Exception!!!"); | |
| 196 | |
| 197 #endif | |
| 198 | |
| 199 return; | |
| 200 } | |
| 201 | |
| 202 //--------------------------------------------------------------------------- | |
|
14
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
203 // Default ISRs |
| 0 | 204 |
| 2 | 205 externC cyg_uint32 |
| 206 hal_default_isr(CYG_ADDRWORD vector, CYG_ADDRWORD data) | |
| 0 | 207 { |
| 2 | 208 diag_printf("Interrupt: %d\n", vector); |
| 209 | |
| 0 | 210 CYG_FAIL("Spurious Interrupt!!!"); |
| 211 return 0; | |
| 212 } | |
| 213 | |
|
14
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
214 // The decrementer default ISR has to do nothing. The reason is that |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
215 // decrementer interrupts cannot be disabled - if a kernel configuration |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
216 // does not use the RTC, but does use external interrupts, the decrementer |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
217 // underflow could cause a CYG_FAIL (as above) even though the user did |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
218 // not expect any decrementer interrupts to happen. |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
219 externC cyg_uint32 |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
220 hal_default_decrementer_isr(CYG_ADDRWORD vector, CYG_ADDRWORD data) |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
221 { |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
222 return 0; |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
223 } |
|
01ce82f3e11a
Merge from eCos master repository on 1999-06-11-17:05:41-BST
jlarmour
parents:
2
diff
changeset
|
224 |
| 0 | 225 //--------------------------------------------------------------------------- |
| 226 // Idle thread action | |
| 227 | |
| 2 | 228 void |
| 229 hal_idle_thread_action( cyg_uint32 count ) | |
| 0 | 230 { |
|
32
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
231 #if 0 |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
232 #ifdef CYGPKG_HAL_POWERPC_MPC860 |
|
32
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
233 register cyg_uint32 result; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
234 |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
235 cyg_uint32 *psivec = (cyg_uint32*)CYGARC_REG_IMM_SIVEC ; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
236 cyg_uint32 *psimask = (cyg_uint32*)CYGARC_REG_IMM_SIMASK; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
237 cyg_uint32 *psipend = (cyg_uint32*)CYGARC_REG_IMM_SIPEND; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
238 cyg_uint16 *ptbscr = (cyg_uint16*)CYGARC_REG_IMM_TBSCR; |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
239 |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
240 asm volatile( |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
241 "mfdec %0;" |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
242 : "=r"(result) |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
243 ); |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
244 diag_printf( "Dec %08x, TBSCR %04x, vec %d: sivec %08x, simask %08x, sipend %08x\n", |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
245 result, (cyg_uint32)(*ptbscr), (*psivec)>>26, *psivec, *psimask, *psipend ); |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
246 #endif |
|
5af43b635655
Merge from eCos master repository on 1999-08-18-15:20:01-BST
jlarmour
parents:
18
diff
changeset
|
247 #endif |
| 0 | 248 } |
| 249 | |
| 250 //--------------------------------------------------------------------------- | |
| 2 | 251 // Use MMU resources to map memory regions. |
| 252 // Takes and returns an int used to ID the MMU resource to use. This ID | |
| 253 // is increased as resources are used and should be used for subsequent | |
| 254 // invocations. | |
| 255 static int | |
| 256 hal_map_memory (int id,CYG_ADDRESS virt, CYG_ADDRESS phys, | |
| 257 cyg_int32 size, cyg_uint8 flags) | |
| 258 { | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
259 #ifdef CYGPKG_HAL_POWERPC_MPC603 |
| 2 | 260 { |
| 261 // Use BATs to map the memory. | |
| 262 cyg_uint32 ubat, lbat; | |
| 263 | |
| 264 ubat = (virt & UBAT_BEPIMASK) | UBAT_VS | UBAT_VP; | |
| 265 lbat = (phys & LBAT_BRPNMASK); | |
| 266 if (flags & CYGARC_MEMDESC_CI) | |
| 267 lbat |= LBAT_I; | |
| 268 if (flags & CYGARC_MEMDESC_GUARDED) | |
| 269 lbat |= LBAT_G; | |
| 270 | |
| 271 // There are 4 BATs, size is programmable. | |
| 272 while (id < 4 && size > 0) { | |
| 273 cyg_uint32 blk_size = 128*1024; | |
| 274 cyg_uint32 bl = 0; | |
| 275 while (blk_size < 256*1024*1024 && blk_size < size) { | |
| 276 blk_size *= 2; | |
| 277 bl = (bl << 1) | 1; | |
| 278 } | |
| 279 ubat = (ubat & ~UBAT_BLMASK) | (bl << 2); | |
| 280 | |
| 281 switch (id) { | |
| 282 case 0: | |
| 283 CYGARC_MTSPR (IBAT0U, ubat); | |
| 284 CYGARC_MTSPR (IBAT0L, lbat); | |
| 285 CYGARC_MTSPR (DBAT0U, ubat); | |
| 286 CYGARC_MTSPR (DBAT0L, lbat); | |
| 287 break; | |
| 288 case 1: | |
| 289 CYGARC_MTSPR (IBAT1U, ubat); | |
| 290 CYGARC_MTSPR (IBAT1L, lbat); | |
| 291 CYGARC_MTSPR (DBAT1U, ubat); | |
| 292 CYGARC_MTSPR (DBAT1L, lbat); | |
| 293 break; | |
| 294 case 2: | |
| 295 CYGARC_MTSPR (IBAT2U, ubat); | |
| 296 CYGARC_MTSPR (IBAT2L, lbat); | |
| 297 CYGARC_MTSPR (DBAT2U, ubat); | |
| 298 CYGARC_MTSPR (DBAT2L, lbat); | |
| 299 break; | |
| 300 case 3: | |
| 301 CYGARC_MTSPR (IBAT3U, ubat); | |
| 302 CYGARC_MTSPR (IBAT3L, lbat); | |
| 303 CYGARC_MTSPR (DBAT3U, ubat); | |
| 304 CYGARC_MTSPR (DBAT3L, lbat); | |
| 305 break; | |
| 306 } | |
| 307 | |
| 308 size -= blk_size; | |
| 309 id++; | |
| 310 } | |
| 311 } | |
| 312 #endif | |
| 313 | |
| 314 | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
315 #ifdef CYGPKG_HAL_POWERPC_MPC8xx |
| 2 | 316 { |
| 317 // The MPC8xx CPUs do not have BATs. Fortunately we don't | |
| 318 // currently use the MMU, so we can simulate BATs by using the | |
| 319 // TLBs. | |
| 320 | |
| 321 cyg_uint32 epn, rpn, ctr, twc; | |
| 322 int max_tlbs; | |
| 323 | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
324 #if defined(CYGPKG_HAL_POWERPC_MPC860) |
| 2 | 325 // There are 32 TLBs. |
| 326 max_tlbs = 32; | |
| 327 #endif | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
328 #if defined(CYGPKG_HAL_POWERPC_MPC823) || defined(CYGPKG_HAL_POWERPC_MPC850) |
| 2 | 329 // There are 8 TLBs. |
| 330 max_tlbs = 8; | |
| 331 #endif | |
| 332 | |
| 333 epn = (virt & MI_EPN_EPNMASK) | MI_EPN_EV; | |
| 334 rpn = ((phys & MI_RPN_RPNMASK) | |
| 335 | MI_RPN_PPRWRW | MI_RPN_LPS | MI_RPN_SH | MI_RPN_V); | |
| 336 if (flags & CYGARC_MEMDESC_CI) | |
| 337 rpn |= MI_RPN_CI; | |
| 338 | |
| 339 twc = MI_TWC_PS8MB | MI_TWC_V; | |
| 340 if (flags & CYGARC_MEMDESC_GUARDED) | |
| 341 twc |= MI_TWC_G; | |
| 342 | |
| 343 // Ignore attempts to use more than max_tlbs. | |
| 344 while (id < max_tlbs && size > 0) { | |
| 345 ctr = id << MI_CTR_INDX_SHIFT; | |
| 346 | |
| 347 // Instruction TLB. | |
| 348 CYGARC_MTSPR (MI_TWC, twc); | |
| 349 CYGARC_MTSPR (MI_CTR, ctr); | |
| 350 CYGARC_MTSPR (MI_EPN, epn); | |
| 351 CYGARC_MTSPR (MI_RPN, rpn); | |
| 352 | |
| 353 // Data TLB. | |
| 354 { | |
| 355 cyg_uint32 drpn; | |
| 356 | |
| 357 // Need to mark data page as changed or an exception | |
| 358 // will be generated on first write to the page. | |
| 359 drpn = rpn | MD_RPN_CHANGED; | |
| 360 | |
| 361 CYGARC_MTSPR (MD_TWC, twc); | |
| 362 CYGARC_MTSPR (MD_CTR, ctr); | |
| 363 CYGARC_MTSPR (MD_EPN, epn); | |
| 364 CYGARC_MTSPR (MD_RPN, drpn); | |
| 365 } | |
| 366 | |
| 367 // Move to next 8MB block. | |
| 368 size -= 8*1024*1024; | |
| 369 epn += 8*1024*1024; | |
| 370 rpn += 8*1024*1024; | |
| 371 id++; | |
| 372 } | |
| 373 } | |
| 374 #endif | |
| 375 | |
| 376 return id; | |
| 377 } | |
| 378 | |
| 379 | |
| 380 // Initialize MMU to a sane (NOP) state. | |
| 381 static void | |
| 382 hal_clear_MMU (void) | |
| 383 { | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
384 #ifdef CYGPKG_HAL_POWERPC_MPC603 |
| 2 | 385 { |
| 386 cyg_uint32 ubat, lbat; | |
| 387 | |
| 388 // Initialize BATs with 0 -- VS&VP are unset, making all matches fail | |
| 389 ubat = 0; | |
| 390 lbat = 0; | |
| 391 | |
| 392 CYGARC_MTSPR (IBAT0U, ubat); | |
| 393 CYGARC_MTSPR (IBAT0L, lbat); | |
| 394 CYGARC_MTSPR (DBAT0U, ubat); | |
| 395 CYGARC_MTSPR (DBAT0L, lbat); | |
| 396 CYGARC_MTSPR (IBAT1U, ubat); | |
| 397 CYGARC_MTSPR (IBAT1L, lbat); | |
| 398 CYGARC_MTSPR (DBAT1U, ubat); | |
| 399 CYGARC_MTSPR (DBAT1L, lbat); | |
| 400 CYGARC_MTSPR (IBAT2U, ubat); | |
| 401 CYGARC_MTSPR (IBAT2L, lbat); | |
| 402 CYGARC_MTSPR (DBAT2U, ubat); | |
| 403 CYGARC_MTSPR (DBAT2L, lbat); | |
| 404 CYGARC_MTSPR (IBAT3U, ubat); | |
| 405 CYGARC_MTSPR (IBAT3L, lbat); | |
| 406 CYGARC_MTSPR (DBAT3U, ubat); | |
| 407 CYGARC_MTSPR (DBAT3L, lbat); | |
| 408 } | |
| 409 #endif | |
| 410 | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
411 #ifdef CYGPKG_HAL_POWERPC_MPC8xx |
| 2 | 412 { |
| 413 // Initialize TLBs with 0, Valid bits unset. | |
| 414 | |
| 415 cyg_uint32 ctr; | |
| 416 int id; | |
| 417 int max_tlbs; | |
| 418 | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
419 #if defined(CYGPKG_HAL_POWERPC_MPC860) |
| 2 | 420 // There are 32 TLBs. |
| 421 max_tlbs = 32; | |
| 422 #endif | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
423 #if defined(CYGPKG_HAL_POWERPC_MPC823) || defined(CYGPKG_HAL_POWERPC_MPC850) |
| 2 | 424 // There are 8 TLBs. |
| 425 max_tlbs = 8; | |
| 426 #endif | |
| 427 | |
| 428 CYGARC_MTSPR (M_CASID, 0); | |
| 429 | |
| 430 for (id = 0; id < max_tlbs; id++) { | |
| 431 ctr = id << MI_CTR_INDX_SHIFT; | |
| 432 | |
| 433 // Instruction TLBs. | |
| 434 CYGARC_MTSPR (MI_TWC, 0); | |
| 435 CYGARC_MTSPR (MI_CTR, ctr); | |
| 436 CYGARC_MTSPR (MI_EPN, 0); | |
| 437 CYGARC_MTSPR (MI_RPN, 0); | |
| 438 // Data TLBs. | |
| 439 CYGARC_MTSPR (MD_TWC, 0); | |
| 440 CYGARC_MTSPR (MD_CTR, ctr); | |
| 441 CYGARC_MTSPR (MD_EPN, 0); | |
| 442 CYGARC_MTSPR (MD_RPN, 0); | |
| 443 } | |
| 444 } | |
| 445 #endif | |
| 446 } | |
| 447 | |
|
16
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
14
diff
changeset
|
448 // NB this demands that the platform HAL has provided an |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
14
diff
changeset
|
449 // externC cyg_memdesc_t cyg_hal_mem_map[]; |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
14
diff
changeset
|
450 // as detailed in hal_cache.h: |
| 2 | 451 externC void hal_MMU_init (void) |
| 452 { | |
| 453 int id = 0; | |
| 454 int i = 0; | |
| 455 | |
| 456 hal_clear_MMU (); | |
| 457 | |
| 458 while (cyg_hal_mem_map[i].size) { | |
| 459 id = hal_map_memory (id, | |
| 460 cyg_hal_mem_map[i].virtual_addr, | |
| 461 cyg_hal_mem_map[i].physical_addr, | |
| 462 cyg_hal_mem_map[i].size, | |
| 463 cyg_hal_mem_map[i].flags); | |
| 464 i++; | |
| 465 } | |
| 466 } | |
| 467 | |
| 468 //--------------------------------------------------------------------------- | |
| 469 // Initial cache enabling | |
|
64
c38311975d4f
Merge from eCos master repository on 2000-01-28-04:28:11-GMT
jlarmour
parents:
62
diff
changeset
|
470 // Specific behavior for each platform configured via plf_cache.h |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
471 |
| 2 | 472 externC void |
| 473 hal_enable_caches(void) | |
| 474 { | |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
475 #ifdef CYGPRI_INIT_CACHES |
| 2 | 476 // Initialize caches. |
| 477 HAL_ICACHE_UNLOCK_ALL(); | |
| 478 HAL_DCACHE_UNLOCK_ALL(); | |
| 479 HAL_ICACHE_INVALIDATE_ALL(); | |
| 480 HAL_DCACHE_INVALIDATE_ALL(); | |
| 481 | |
| 482 // Enable caches. | |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
483 #ifdef CYGPRI_ENABLE_CACHES |
| 2 | 484 HAL_ICACHE_ENABLE(); |
| 485 HAL_DCACHE_ENABLE(); | |
| 486 #endif | |
| 487 #endif | |
| 488 | |
|
68
f74b2666b30d
Merge from eCos master repository on 2000-02-04-07:47:04-GMT
jlarmour
parents:
66
diff
changeset
|
489 #ifdef CYGPKG_HAL_POWERPC_MPC8xx |
| 2 | 490 // Disable serialization |
| 491 { | |
| 492 cyg_uint32 ictrl; | |
| 493 CYGARC_MFSPR (ICTRL, ictrl); | |
| 494 ictrl |= ICTRL_NOSERSHOW; | |
| 495 CYGARC_MTSPR (ICTRL, ictrl); | |
| 496 } | |
| 497 #endif | |
| 498 } | |
| 499 | |
| 500 //--------------------------------------------------------------------------- | |
|
36
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
501 //A jump via a null pointer causes the CPU to end up here. |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
502 externC void |
|
70
c5536bad4c24
Merge from eCos master repository on 2000-02-11-15:46:40-GMT
jlarmour
parents:
68
diff
changeset
|
503 hal_null_call(void) |
|
36
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
504 { |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
505 |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
506 CYG_FAIL("Call via NULL-pointer!"); |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
507 for(;;); |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
508 } |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
509 |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
34
diff
changeset
|
510 //--------------------------------------------------------------------------- |
| 0 | 511 // End of hal_misc.c |
