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