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