nand-ecoscentric: packages/hal/mips/arch/current/src/hal

annotate packages/hal/mips/arch/current/src/hal_misc.c @ 6:d376b777e2ce ecos-sw-1999-05-14

Merge from eCos master repository on 1999-05-14-19:27:43-BST

author	jlarmour
date	Fri, 14 May 1999 12:20:00 +0000
parents	443894e2e912
children	d3fbcdfa1b2f

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 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	94 CYG_TRACE1(true, "Interrupt: %d", vector);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	95 CYG_FAIL("Spurious Interrupt!!!");
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	96 return 0;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	97 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	98
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	99 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	100 /* data copy and bss zero functions */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	101
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	102 typedef void (CYG_ROM_ADDRESS)(void);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	103
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	104 extern char __ram_data_start;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	105 extern char __ram_data_end;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	106 extern CYG_ROM_ADDRESS __rom_data_start;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	107
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	108 #ifdef CYG_HAL_STARTUP_ROM
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	109 void hal_copy_data(void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	110 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	111 char *p = &__ram_data_start;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	112 char q = (char )&__rom_data_start;
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 while( p != (char *)&__ram_data_end )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	115 p++ = q++;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	116 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	117 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	118
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	119 extern CYG_ROM_ADDRESS __bss_start;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	120 extern CYG_ROM_ADDRESS __bss_end;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	121
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	122 void hal_zero_bss(void)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	123 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	124 char p = (char )&__bss_start;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	125
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	126 while( p != (char *)&__bss_end )
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	127 *p++ = 0;
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
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	130 /------------------------------------------------------------------------/
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	131
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	132 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	133 cyg_bool cyg_hal_stop_constructors;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	134 #endif
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	135
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	136 typedef void (*pfunc) (void);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	137 extern pfunc __CTOR_LIST__[];
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	138
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	139 void
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	140 cyg_hal_invoke_constructors(void)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	141 {
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	142 #if 0
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	143
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	144 #else
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	145
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	146 pfunc p;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	147
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	148 #ifdef CYGSEM_HAL_STOP_CONSTRUCTORS_ON_FLAG
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	149 static long i = 0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	150 long j = (long)(__CTOR_LIST__[0]);
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	151
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	152 cyg_hal_stop_constructors=0;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	153 for ( ; i < j; i++ )
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	154 {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	155 p = __CTOR_LIST__[j - i];
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	156 p ();
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	157 if (cyg_hal_stop_constructors) {
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	158 i++;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	159 break;
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	160 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	161 }
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	162 #else
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	163 long i = (long)(__CTOR_LIST__[0]);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	164
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	165 for ( ; i > 0; i-- )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	166 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	167 p = __CTOR_LIST__[i];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	168 p ();
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	169 }
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	170 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	171
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	172 #endif
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	173
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	174 } // cyg_hal_invoke_constructors()
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	175
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	176 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	177 /* Determine the index of the ls bit of the supplied mask. */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	178
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	179 cyg_uint32 hal_lsbit_index(cyg_uint32 mask)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	180 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	181 cyg_uint32 n = mask;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	182
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	183 static const signed char tab[64] =
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	184 { -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	185 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	186 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	187 0, 23, 0, 19, 29, 0, 22, 18, 28, 17, 16, 0
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
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	190 n &= ~(n-1UL);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	191 n = (n<<16)-n;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	192 n = (n<<6)+n;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	193 n = (n<<4)+n;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	194
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	195 return tab[n>>26];
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	196 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	197
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	198 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	199 /* Determine the index of the ms bit of the supplied mask. */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	200
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	201 cyg_uint32 hal_msbit_index(cyg_uint32 mask)
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	202 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	203 cyg_uint32 x = mask;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	204 cyg_uint32 w;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	205
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	206 /* 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	207 x \|= x >> 16;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	208 x \|= x >> 8;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	209 x \|= x >> 4;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	210 x \|= x >> 2;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	211 x \|= x >> 1;
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	212
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	213 /* Phase 2: calculate number of "1" bits in the word */
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	214 w = (x & 0x55555555) + ((x >> 1) & 0x55555555);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	215 w = (w & 0x33333333) + ((w >> 2) & 0x33333333);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	216 w = w + (w >> 4);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	217 w = (w & 0x000F000F) + ((w >> 8) & 0x000F000F);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	218 return (cyg_uint32)((w + (w >> 16)) & 0xFF);
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 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	221
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	222 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	223 /* Idle thread action */
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	224
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	225 #include <cyg/infra/diag.h>
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	226
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	227 void hal_idle_thread_action( cyg_uint32 count )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	228 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	229 #if 0 //def CYG_HAL_MIPS_SIM
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	230 if( (count % 1000) == 0 )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	231 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	232 // This code causes a fake interrupt.
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	233 asm volatile (
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	234 "xor $24,$24,$24;"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	235 "mtc0 $24,$13;"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	236 "lui $25,%%hi(1f);"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	237 "ori $25,$25,%%lo(1f);"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	238 "j other_vector;"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	239 "nop;"
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	240 "1:"
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 :
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	243 : "t8", "t9"
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 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	246 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	247 #if 0 //def CYG_HAL_MIPS_JMR3904
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	248
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	249 if( (count % 100000 ) == 0 )
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	250 {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	251 // 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	252 cyg_uint32 sr = 0, cr = 0, ctr = 0, cpr = 0;
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	253 // HAL_CLOCK_READ( &tval );
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	254 // HAL_READ_UINT32( 0xFFFFC000, isr );
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	255 // HAL_READ_UINT32( 0xFFFFC004, imr );
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	256 // HAL_READ_UINT32( 0xFFFFC01C, ilr );
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	257 // CYG_TRACE2(1, "Timer value, ISR ",tval, isr);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	258 // CYG_TRACE2(1, "IMR ILR0 ", imr, ilr);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	259
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	260 // asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	261 // "mfc0 %0,$12;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	262 // "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	263 // "mfc0 %1,$13;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	264 // "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	265 // "mfc0 %2,$9;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	266 // "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	267 // "mfc0 %3,$11;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	268 // "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	269 // : "=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	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
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	273 // diag_printf("Status %08x ", sr );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	274 // diag_printf("Cause %08x ", cr );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	275 // diag_printf("Counter %08x ", ctr );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	276 // 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	277
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	278 #if 0
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	279 asm volatile (
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	280 "mfc0 %0,$12;"
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	281 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	282 : "=r"(sr)
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	283 );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	284 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	285
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	286 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	287 "mfc0 %0,$13;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	288 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	289 : "=r"(cr)
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	290 );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	291 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	292
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	293 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	294 "mfc0 %0,$9;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	295 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	296 : "=r"(ctr)
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	297 );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	298 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	299
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	300 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	301 "mfc0 %0,$11;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	302 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	303 : "=r"(cpr)
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	304 );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	305 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	306 diag_write_string( "\n" );
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	307
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	308 #endif
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	309 #if 1
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	310 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	311 "mfc0 %0,$12;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	312 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	313 : "=r"(sr)
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	314 );
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	315
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	316 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	317 "mfc0 %0,$13;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	318 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	319 : "=r"(cr)
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 CYG_INSTRUMENT_USER( 1, sr, cr );
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	323
6 d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	324 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	325 "mfc0 %0,$9;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	326 "nop; nop; nop;"
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	327 : "=r"(ctr)
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
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	330 asm volatile (
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	331 "mfc0 %0,$11;"
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"(cpr)
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
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	336 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	337 #endif
d376b777e2ce Merge from eCos master repository on 1999-05-14-19:27:43-BST jlarmour parents: 2 diff changeset	338
0 3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	339 // if( count == 4 )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	340 // {
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	341 // HAL_ENABLE_INTERRUPTS();
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
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	344 // if( count >= 10 )
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	345 // for(;;);
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	346 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	347 #endif
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	348 }
3111d98ba7b3 Initial commit of eCos version 1.1 jlarmour parents: diff changeset	349
2 443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	350 /------------------------------------------------------------------------/
443894e2e912 Block commit of eCos version 1.2.1 jlarmour parents: 0 diff changeset	351 /* End of hal_misc.c */

Mercurial > nand-ecoscentric

annotate packages/hal/mips/arch/current/src/hal_misc.c @ 6:d376b777e2ce ecos-sw-1999-05-14