flash_v2: packages/hal/mips/arch/current/src/hal

annotate packages/hal/mips/arch/current/src/hal_misc.c @ 12:4cc3eff958ab ecos-sw-1999-06-04

Merge from eCos master repository on 1999-06-04-22:24:56-BST

author	jlarmour
date	Fri, 04 Jun 1999 15:08:16 +0000
parents	d3fbcdfa1b2f
children	4f2df4ab82c8

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

Mercurial > flash_v2

annotate packages/hal/mips/arch/current/src/hal_misc.c @ 12:4cc3eff958ab ecos-sw-1999-06-04