Mercurial > flash_v2
annotate packages/hal/mips/arch/current/src/hal_misc.c @ 66:bf00f99aec69 ecos-sw-2000-02-02
Merge from eCos master repository on 2000-02-02-19:16:44-GMT
| author | jlarmour |
|---|---|
| date | Wed, 02 Feb 2000 19:57:02 +0000 |
| parents | c38311975d4f |
| children | 435cced73e2f |
| rev | line source |
|---|---|
| 2 | 1 //========================================================================== |
| 0 | 2 // |
| 2 | 3 // hal_misc.c |
| 0 | 4 // |
| 2 | 5 // HAL miscellaneous functions |
| 0 | 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 |
| 35 // Contributors: nickg, jlarmour | |
| 36 // Date: 1999-01-21 | |
| 37 // Purpose: HAL miscellaneous functions | |
| 38 // Description: This file contains miscellaneous functions provided by the | |
| 39 // HAL. | |
| 0 | 40 // |
| 41 //####DESCRIPTIONEND#### | |
| 42 // | |
| 2 | 43 //========================================================================*/ |
| 0 | 44 |
| 45 #include <pkgconf/hal.h> | |
| 46 | |
| 47 #include <cyg/infra/cyg_type.h> // Base types | |
| 48 #include <cyg/infra/cyg_trac.h> // tracing macros | |
| 49 #include <cyg/infra/cyg_ass.h> // assertion macros | |
| 50 | |
| 51 #include <cyg/hal/hal_arch.h> // architectural definitions | |
| 52 | |
| 53 #include <cyg/hal/hal_intr.h> // Interrupt handling | |
| 54 | |
| 55 #include <cyg/hal/hal_cache.h> // Cache handling | |
| 56 | |
| 2 | 57 /*------------------------------------------------------------------------*/ |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
58 /* If required, define a variable to store the clock period. */ |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
59 |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
60 #ifdef CYGHWR_HAL_CLOCK_PERIOD_DEFINED |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
61 |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
62 CYG_WORD32 cyg_hal_clock_period; |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
63 |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
64 #endif |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
65 |
|
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
66 /*------------------------------------------------------------------------*/ |
| 2 | 67 /* First level C exception handler. */ |
| 0 | 68 |
| 69 externC void __handle_exception (void); | |
| 70 | |
| 71 externC HAL_SavedRegisters *_hal_registers; | |
| 72 | |
|
36
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
73 externC void *__mem_fault_handler; |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
74 |
|
26
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
75 externC cyg_uint8 cyg_hal_mips_process_fpe( HAL_SavedRegisters *regs ); |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
76 |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
77 externC cyg_uint32 cyg_hal_exception_handler(HAL_SavedRegisters *regs) |
| 0 | 78 { |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
50
diff
changeset
|
79 #if defined(CYGHWR_HAL_MIPS_FPU) && \ |
|
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
50
diff
changeset
|
80 defined(CYGSEM_HAL_MIPS_EMULATE_UNIMPLEMENTED_FPU_OPS) |
|
26
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
81 // We may be required to emulate certain unimplemented Floating Point |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
82 // operations |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
83 |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
84 if ((regs->vector>>2) == CYGNUM_HAL_VECTOR_FPE) { |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
85 |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
86 // cyg_hal_mips_process_fpe() returns non-zero if it could handle |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
87 // the exception successfully. If so, we just return |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
88 |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
89 if ( cyg_hal_mips_process_fpe(regs) ) |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
90 return 0; |
|
26
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
91 } |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
92 #endif |
|
4741a3c3496a
Merge from eCos master repository on 1999-07-23-05:47:06-BST
jlarmour
parents:
18
diff
changeset
|
93 |
| 0 | 94 #if defined(CYGDBG_HAL_DEBUG_GDB_INCLUDE_STUBS) |
| 95 | |
|
36
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
96 // If we caught an exception inside the stubs, see if we were expecting it |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
97 // and if so jump to the saved address |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
98 if (__mem_fault_handler) { |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
99 regs->pc = (CYG_ADDRWORD)__mem_fault_handler; |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
100 return 0; // Caught an exception inside stubs |
|
36
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
101 } |
|
e97d78785e2d
Merge from eCos master repository on 1999-09-12-15:40:34-BST
jlarmour
parents:
26
diff
changeset
|
102 |
| 0 | 103 // Set the pointer to the registers of the current exception |
| 104 // context. At entry the GDB stub will expand the | |
| 105 // HAL_SavedRegisters structure into a (bigger) register array. | |
| 106 _hal_registers = regs; | |
| 107 __handle_exception(); | |
| 108 | |
| 109 #elif defined(CYGFUN_HAL_COMMON_KERNEL_SUPPORT) && defined(CYGPKG_HAL_EXCEPTIONS) | |
| 110 | |
| 111 // We should decode the vector and pass a more appropriate | |
| 112 // value as the second argument. For now we simply pass a | |
| 113 // pointer to the saved registers. We should also divert | |
| 114 // breakpoint and other debug vectors into the debug stubs. | |
| 115 | |
| 2 | 116 cyg_hal_deliver_exception( regs->vector>>2, (CYG_ADDRWORD)regs ); |
| 0 | 117 |
| 118 #else | |
| 119 | |
| 120 CYG_FAIL("Exception!!!"); | |
| 121 | |
| 122 #endif | |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
123 return 0; |
| 0 | 124 } |
| 125 | |
| 2 | 126 /*------------------------------------------------------------------------*/ |
| 127 /* default ISR */ | |
| 0 | 128 |
| 129 externC cyg_uint32 hal_default_isr(CYG_ADDRWORD vector, CYG_ADDRWORD data) | |
| 130 { | |
|
50
a0774359f013
Merge from eCos master repository on 1999-11-02-17:02:15-GMT
jlarmour
parents:
38
diff
changeset
|
131 #if defined(CYGDBG_HAL_MIPS_DEBUG_GDB_CTRLC_SUPPORT) && \ |
|
10
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
132 defined(CYGHWR_HAL_GDB_PORT_VECTOR) && \ |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
133 defined(HAL_CTRLC_ISR) |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
134 |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
135 #ifndef CYGIMP_HAL_COMMON_INTERRUPTS_CHAIN |
|
10
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
136 if( vector == CYGHWR_HAL_GDB_PORT_VECTOR ) |
|
18
7253dcc42a09
Merge from eCos master repository on 1999-06-25-15:31:50-BST
jlarmour
parents:
16
diff
changeset
|
137 #endif |
|
10
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
138 { |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
139 cyg_uint32 result = HAL_CTRLC_ISR( vector, data ); |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
140 if( result != 0 ) return result; |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
141 } |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
142 |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
50
diff
changeset
|
143 #if defined(CYGSEM_HAL_USE_ROM_MONITOR_CygMon) |
|
38
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
144 #if defined(HAL_DIAG_IRQ_CHECK) |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
145 { |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
146 cyg_uint32 ret; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
147 /* let ROM monitor handle unexpected interrupts */ |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
148 HAL_DIAG_IRQ_CHECK(vector, ret); |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
149 if (ret<=0) |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
150 return ret; |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
151 } |
|
e7ba79f6d3a8
Merge from eCos master repository on 1999-09-23-20:10:25-BST
jlarmour
parents:
36
diff
changeset
|
152 #endif // def HAL_DIAG_IRQ_CHECK |
|
62
7a6ac9edc838
Merge from eCos master repository on 2000-01-24-19:43:49-GMT
jlarmour
parents:
50
diff
changeset
|
153 #endif // def CYGSEM_HAL_USE_ROM_MONITOR_CygMon |
|
10
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
154 #endif |
|
d3fbcdfa1b2f
Merge from eCos master repository on 1999-05-29-00:13:11-BST
jlarmour
parents:
6
diff
changeset
|
155 |
| 0 | 156 CYG_TRACE1(true, "Interrupt: %d", vector); |
| 157 CYG_FAIL("Spurious Interrupt!!!"); | |
| 158 return 0; | |
| 159 } | |
| 160 | |
| 2 | 161 /*------------------------------------------------------------------------*/ |
| 162 /* data copy and bss zero functions */ | |
| 0 | 163 |
|
16
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
164 typedef void (CYG_SYM_ADDRESS)(void); |
| 0 | 165 |
|
16
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
166 // All these must use this type of address to stop them being given relocations |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
167 // relative to $gp (i.e. assuming they would be in .sdata) |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
168 extern CYG_SYM_ADDRESS __ram_data_start; |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
169 extern CYG_SYM_ADDRESS __ram_data_end; |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
170 extern CYG_SYM_ADDRESS __rom_data_start; |
| 2 | 171 |
| 172 #ifdef CYG_HAL_STARTUP_ROM | |
| 0 | 173 void hal_copy_data(void) |
| 174 { | |
|
16
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
175 char *p = (char *)&__ram_data_start; |
| 0 | 176 char *q = (char *)&__rom_data_start; |
| 177 | |
| 178 while( p != (char *)&__ram_data_end ) | |
| 179 *p++ = *q++; | |
| 180 } | |
| 181 #endif | |
| 182 | |
|
16
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
183 extern CYG_SYM_ADDRESS __bss_start; |
|
4f2df4ab82c8
Merge from eCos master repository on 1999-06-18-15:25:04-BST
jlarmour
parents:
12
diff
changeset
|
184 extern CYG_SYM_ADDRESS __bss_end; |
| 2 | 185 |
| 0 | 186 void hal_zero_bss(void) |
| 187 { | |
| 188 char *p = (char *)&__bss_start; | |
| 189 | |
| 2 | 190 while( p != (char *)&__bss_end ) |
| 0 | 191 *p++ = 0; |
| 192 } | |
| 193 | |
| 2 | 194 /*------------------------------------------------------------------------*/ |
| 0 | 195 |
| 2 | 196 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG |
| 197 cyg_bool cyg_hal_stop_constructors; | |
| 198 #endif | |
| 199 | |
| 200 typedef void (*pfunc) (void); | |
| 201 extern pfunc __CTOR_LIST__[]; | |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
202 extern pfunc __CTOR_END__[]; |
| 0 | 203 |
| 204 void | |
| 2 | 205 cyg_hal_invoke_constructors(void) |
| 0 | 206 { |
| 2 | 207 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
208 static pfunc *p = &__CTOR_END__[-1]; |
| 2 | 209 |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
210 cyg_hal_stop_constructors = 0; |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
211 for (; p >= __CTOR_LIST__; p--) { |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
212 (*p) (); |
| 2 | 213 if (cyg_hal_stop_constructors) { |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
214 p--; |
| 2 | 215 break; |
| 216 } | |
| 217 } | |
| 218 #else | |
|
12
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
219 pfunc *p; |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
220 |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
221 for (p = &__CTOR_END__[-1]; p >= __CTOR_LIST__; p--) |
|
4cc3eff958ab
Merge from eCos master repository on 1999-06-04-22:24:56-BST
jlarmour
parents:
10
diff
changeset
|
222 (*p) (); |
| 2 | 223 #endif |
| 0 | 224 |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
225 } // cyg_hal_invoke_constructors() |
| 0 | 226 |
| 2 | 227 /*------------------------------------------------------------------------*/ |
| 228 /* Determine the index of the ls bit of the supplied mask. */ | |
| 0 | 229 |
| 230 cyg_uint32 hal_lsbit_index(cyg_uint32 mask) | |
| 231 { | |
| 232 cyg_uint32 n = mask; | |
| 233 | |
| 234 static const signed char tab[64] = | |
| 235 { -1, 0, 1, 12, 2, 6, 0, 13, 3, 0, 7, 0, 0, 0, 0, 14, 10, | |
| 236 4, 0, 0, 8, 0, 0, 25, 0, 0, 0, 0, 0, 21, 27 , 15, 31, 11, | |
| 237 5, 0, 0, 0, 0, 0, 9, 0, 0, 24, 0, 0 , 20, 26, 30, 0, 0, 0, | |
| 238 0, 23, 0, 19, 29, 0, 22, 18, 28, 17, 16, 0 | |
| 239 }; | |
| 240 | |
| 241 n &= ~(n-1UL); | |
| 242 n = (n<<16)-n; | |
| 243 n = (n<<6)+n; | |
| 244 n = (n<<4)+n; | |
| 245 | |
| 246 return tab[n>>26]; | |
| 247 } | |
| 248 | |
| 2 | 249 /*------------------------------------------------------------------------*/ |
| 250 /* Determine the index of the ms bit of the supplied mask. */ | |
| 0 | 251 |
| 252 cyg_uint32 hal_msbit_index(cyg_uint32 mask) | |
| 253 { | |
| 254 cyg_uint32 x = mask; | |
| 255 cyg_uint32 w; | |
| 256 | |
| 257 /* Phase 1: make word with all ones from that one to the right */ | |
| 258 x |= x >> 16; | |
| 259 x |= x >> 8; | |
| 260 x |= x >> 4; | |
| 261 x |= x >> 2; | |
| 262 x |= x >> 1; | |
| 263 | |
| 264 /* Phase 2: calculate number of "1" bits in the word */ | |
| 265 w = (x & 0x55555555) + ((x >> 1) & 0x55555555); | |
| 266 w = (w & 0x33333333) + ((w >> 2) & 0x33333333); | |
| 267 w = w + (w >> 4); | |
| 268 w = (w & 0x000F000F) + ((w >> 8) & 0x000F000F); | |
| 269 return (cyg_uint32)((w + (w >> 16)) & 0xFF); | |
| 270 | |
| 271 } | |
| 272 | |
| 2 | 273 /*------------------------------------------------------------------------*/ |
| 274 /* Idle thread action */ | |
| 0 | 275 |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
276 #include <cyg/infra/diag.h> |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
277 |
| 0 | 278 void hal_idle_thread_action( cyg_uint32 count ) |
| 279 { | |
| 280 #if 0 //def CYG_HAL_MIPS_SIM | |
| 281 if( (count % 1000) == 0 ) | |
| 282 { | |
| 283 // This code causes a fake interrupt. | |
| 284 asm volatile ( | |
| 285 "xor $24,$24,$24;" | |
| 286 "mtc0 $24,$13;" | |
| 287 "lui $25,%%hi(1f);" | |
| 288 "ori $25,$25,%%lo(1f);" | |
| 289 "j other_vector;" | |
| 290 "nop;" | |
| 291 "1:" | |
| 292 : | |
| 293 : | |
| 294 : "t8", "t9" | |
| 295 ); | |
| 296 } | |
| 297 #endif | |
| 298 #if 0 //def CYG_HAL_MIPS_JMR3904 | |
| 299 | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
300 if( (count % 100000 ) == 0 ) |
| 0 | 301 { |
| 302 // cyg_uint32 tval, isr, imr, ilr; | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
303 cyg_uint32 sr = 0, cr = 0, ctr = 0, cpr = 0; |
| 0 | 304 // HAL_CLOCK_READ( &tval ); |
| 305 // HAL_READ_UINT32( 0xFFFFC000, isr ); | |
| 306 // HAL_READ_UINT32( 0xFFFFC004, imr ); | |
| 307 // HAL_READ_UINT32( 0xFFFFC01C, ilr ); | |
| 308 // CYG_TRACE2(1, "Timer value, ISR ",tval, isr); | |
| 309 // CYG_TRACE2(1, "IMR ILR0 ", imr, ilr); | |
| 310 | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
311 // asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
312 // "mfc0 %0,$12;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
313 // "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
314 // "mfc0 %1,$13;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
315 // "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
316 // "mfc0 %2,$9;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
317 // "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
318 // "mfc0 %3,$11;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
319 // "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
320 // : "=r"(sr), "=r"(cr), "=r"(ctr), "=r"(cpr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
321 // ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
322 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
323 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
324 // diag_printf("Status %08x ", sr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
325 // diag_printf("Cause %08x ", cr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
326 // diag_printf("Counter %08x ", ctr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
327 // diag_printf("Compare %08x\n", cpr); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
328 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
329 #if 0 |
| 0 | 330 asm volatile ( |
| 331 "mfc0 %0,$12;" | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
332 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
333 : "=r"(sr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
334 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
335 diag_write_string("Status "); diag_write_hex( sr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
336 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
337 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
338 "mfc0 %0,$13;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
339 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
340 : "=r"(cr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
341 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
342 diag_write_string(" Cause "); diag_write_hex( cr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
343 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
344 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
345 "mfc0 %0,$9;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
346 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
347 : "=r"(ctr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
348 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
349 diag_write_string(" Counter "); diag_write_hex( ctr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
350 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
351 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
352 "mfc0 %0,$11;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
353 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
354 : "=r"(cpr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
355 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
356 diag_write_string(" Compare "); diag_write_hex( cpr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
357 diag_write_string( "\n" ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
358 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
359 #endif |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
360 #if 1 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
361 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
362 "mfc0 %0,$12;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
363 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
364 : "=r"(sr) |
| 0 | 365 ); |
| 366 | |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
367 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
368 "mfc0 %0,$13;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
369 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
370 : "=r"(cr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
371 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
372 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
373 CYG_INSTRUMENT_USER( 1, sr, cr ); |
| 0 | 374 |
|
6
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
375 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
376 "mfc0 %0,$9;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
377 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
378 : "=r"(ctr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
379 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
380 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
381 asm volatile ( |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
382 "mfc0 %0,$11;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
383 "nop; nop; nop;" |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
384 : "=r"(cpr) |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
385 ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
386 |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
387 CYG_INSTRUMENT_USER( 2, ctr, cpr ); |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
388 #endif |
|
d376b777e2ce
Merge from eCos master repository on 1999-05-14-19:27:43-BST
jlarmour
parents:
2
diff
changeset
|
389 |
| 0 | 390 // if( count == 4 ) |
| 391 // { | |
| 392 // HAL_ENABLE_INTERRUPTS(); | |
| 393 // } | |
| 394 | |
| 395 // if( count >= 10 ) | |
| 396 // for(;;); | |
| 397 } | |
| 398 #endif | |
| 399 } | |
| 400 | |
| 2 | 401 /*------------------------------------------------------------------------*/ |
| 402 /* End of hal_misc.c */ |
