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 */
|
---|