[101] | 1 | /*
|
---|
| 2 | * TOPPERS/SSP Kernel
|
---|
| 3 | * Smallest Set Profile Kernel
|
---|
| 4 | *
|
---|
| 5 | * Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
|
---|
| 6 | * Toyohashi Univ. of Technology, JAPAN
|
---|
| 7 | * Copyright (C) 2005,2006 by Embedded and Real-Time Systems Laboratory
|
---|
| 8 | * Graduate School of Information Science, Nagoya Univ., JAPAN
|
---|
| 9 | * Copyright (C) 2008-2010 by Witz Corporation, JAPAN
|
---|
| 10 | *
|
---|
| 11 | * ãLì ÒÍCÈºÌ (1)`(4) Ìð©CFree Software Foundation
|
---|
| 12 | * ÉæÁÄö\³êÄ¢é GNU General Public License Ì Version 2 ÉL
|
---|
| 13 | * q³êÄ¢éðð½·êÉÀèC{\tgEFAi{\tgEFA
|
---|
| 14 | * ðüϵ½àÌðÜÞDȺ¯¶jðgpE¡»EüÏEÄzziȺC
|
---|
| 15 | * pÆÄÔj·é±Æð³Åø·éD
|
---|
| 16 | * (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
|
---|
| 17 | * \¦C±Ìpð¨æѺL̳ÛØKèªC»ÌÜÜÌ`Å\[
|
---|
| 18 | * XR[hÉÜÜêÄ¢é±ÆD
|
---|
| 19 | * (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
|
---|
| 20 | * pÅ«é`ÅÄzz·éêÉÍCÄzzɺ¤hL
|
---|
| 21 | gip
|
---|
| 22 | * Ò}j
|
---|
| 23 | AÈÇjÉCãLÌì \¦C±Ìpð¨æѺL
|
---|
| 24 | * ̳ÛØKèðfÚ·é±ÆD
|
---|
| 25 | * (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
|
---|
| 26 | * pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
|
---|
| 27 | * ÆD
|
---|
| 28 | * (a) Äzzɺ¤hL
|
---|
| 29 | gipÒ}j
|
---|
| 30 | AÈÇjÉCãLÌ
|
---|
| 31 | * ì \¦C±Ìpð¨æѺL̳ÛØKèðfÚ·é±ÆD
|
---|
| 32 | * (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
|
---|
| 33 | * ñ·é±ÆD
|
---|
| 34 | * (4) {\tgEFAÌpÉæè¼ÚIܽÍÔÚIɶ¶é¢©Èé¹
|
---|
| 35 | * Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
|
---|
| 36 | *
|
---|
| 37 | * {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
|
---|
| 38 | * æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄC»ÌKpÂ\«à
|
---|
| 39 | * ÜßÄC¢©ÈéÛØàsíÈ¢DܽC{\tgEFAÌpÉæè¼
|
---|
| 40 | * ÚIܽÍÔÚIɶ¶½¢©Èé¹QÉÖµÄàC»ÌÓCðíÈ¢D
|
---|
| 41 | *
|
---|
| 42 | */
|
---|
| 43 |
|
---|
| 44 | /*
|
---|
| 45 | * vZbTÌÁê½ßÌCCÖè`iRX630pj
|
---|
| 46 | */
|
---|
| 47 |
|
---|
| 48 | #ifndef TOPPERS_PRC_INSN_H
|
---|
| 49 | #define TOPPERS_PRC_INSN_H
|
---|
| 50 |
|
---|
| 51 |
|
---|
| 52 | static uint32_t current_psw( void );
|
---|
| 53 | static void set_psw( uint32_t psw );
|
---|
| 54 | Inline uint32_t current_ipl( void );
|
---|
| 55 | Inline void set_ipl( uint32_t ipl );
|
---|
| 56 | static void disint( void );
|
---|
| 57 | static void enaint( void );
|
---|
| 58 | static uint16_t rev_endian_uint16( uint16_t data );
|
---|
| 59 | static uint32_t rev_endian_uint32( uint32_t data );
|
---|
| 60 |
|
---|
| 61 |
|
---|
| 62 | /*
|
---|
| 63 | * ItO, IPLðæ¾·é½ßÌ}Nè`
|
---|
| 64 | */
|
---|
| 65 | #define PSW_I_MASK ( 0x00010000UL )
|
---|
| 66 | #define PSW_IPL_MASK ( 0x0F000000UL )
|
---|
| 67 |
|
---|
| 68 |
|
---|
| 69 | /*
|
---|
| 70 | * vZbTXe[^XWX^(PSW)Ì»ÝlÌÇoµ
|
---|
| 71 | */
|
---|
| 72 | #pragma inline_asm current_psw
|
---|
| 73 | static uint32_t
|
---|
| 74 | current_psw( void )
|
---|
| 75 | {
|
---|
| 76 | mvfc psw, r1
|
---|
| 77 | }
|
---|
| 78 |
|
---|
| 79 |
|
---|
| 80 | /*
|
---|
| 81 | * vZbTXe[^XWX^(PSW)ÖÝè
|
---|
| 82 | */
|
---|
| 83 | #pragma inline_asm set_psw
|
---|
| 84 | static void
|
---|
| 85 | set_psw( uint32_t psw )
|
---|
| 86 | {
|
---|
| 87 | mvtc r1, psw
|
---|
| 88 | }
|
---|
| 89 |
|
---|
| 90 |
|
---|
| 91 | /*
|
---|
| 92 | * IPLÌ»ÝlÌÇoµ
|
---|
| 93 | */
|
---|
| 94 | Inline uint32_t
|
---|
| 95 | current_ipl( void )
|
---|
| 96 | {
|
---|
| 97 | return ( uint32_t )( current_psw() & PSW_IPL_MASK );
|
---|
| 98 | }
|
---|
| 99 |
|
---|
| 100 |
|
---|
| 101 | /*
|
---|
| 102 | * IPLÖÝè
|
---|
| 103 | */
|
---|
| 104 | Inline void
|
---|
| 105 | set_ipl( uint32_t ipl )
|
---|
| 106 | {
|
---|
| 107 | set_psw( ( current_psw() & ( ~PSW_IPL_MASK ) ) | ipl );
|
---|
| 108 | }
|
---|
| 109 |
|
---|
| 110 |
|
---|
| 111 | /*
|
---|
| 112 | * NMIð·×ÄÌÝÌÖ~
|
---|
| 113 | */
|
---|
| 114 | #pragma inline_asm disint
|
---|
| 115 | static void
|
---|
| 116 | disint( void )
|
---|
| 117 | {
|
---|
| 118 | clrpsw i
|
---|
| 119 | }
|
---|
| 120 |
|
---|
| 121 |
|
---|
| 122 | /*
|
---|
| 123 | * NMIð·×ÄÌÝÌÂ
|
---|
| 124 | */
|
---|
| 125 | #pragma inline_asm enaint
|
---|
| 126 | static void
|
---|
| 127 | enaint( void )
|
---|
| 128 | {
|
---|
| 129 | setpsw i
|
---|
| 130 | }
|
---|
| 131 |
|
---|
| 132 |
|
---|
| 133 | /*
|
---|
| 134 | * GfBAÏ· 16bit
|
---|
| 135 | */
|
---|
| 136 | #pragma inline_asm rev_endian_uint16
|
---|
| 137 | static uint16_t
|
---|
| 138 | rev_endian_uint16( uint16_t data )
|
---|
| 139 | {
|
---|
| 140 | revw r1, r1
|
---|
| 141 | }
|
---|
| 142 |
|
---|
| 143 | /*
|
---|
| 144 | * GfBAÏ· 32bit
|
---|
| 145 | */
|
---|
| 146 | #pragma inline_asm rev_endian_uint32
|
---|
| 147 | static uint32_t
|
---|
| 148 | rev_endian_uint32( uint32_t data )
|
---|
| 149 | {
|
---|
| 150 | revl r1, r1
|
---|
| 151 | }
|
---|
| 152 |
|
---|
| 153 |
|
---|
| 154 | #endif /* TOPPERS_PRC_INSN_H */
|
---|