Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

source: ssp_qb_r5f100le_cs/trunk/extension/alarm.c@ 93

Last change on this file since 93 was 93, checked in by nmir-saito, 8 years ago
add Combined package of SSP kernel for QB-R5F100LE-TB(RL78 processor)
File size: 6.2 KB

Line
1	/*
2	* TOPPERS/SSP Kernel
3	* Smallest Set Profile Kernel
4	*
5	* Copyright (C) 2011 by Meika Sugimoto
6	* Copyright (C) 2015 by Naoki Saito
7	* Nagoya Municipal Industrial Research Institute, JAPAN
8	*
9	* ãLì ÒÍCÈºÌ (1)`(4) Ìðð½·êÉÀèC{\tgEF
10	* Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»EüÏE
11	* ÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
12	* (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
13	* \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[X
14	* R[hÉÜÜêÄ¢é±ÆD
15	* (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉgp
16	* Å«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
17	gipÒ}
18	* j
19	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºLÌ³Û
20	* ØKèðfÚ·é±ÆD
21	* (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉgp
22	* Å«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±ÆD
23	* (a) ÄzzÉº¤hL
24	gipÒ}j
25	AÈÇjÉCãLÌì
26	* \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
27	* (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉñ
28	* ·é±ÆD
29	* (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹Q
30	* ©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆDÜ½C
31	* {\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©ÈéRÉîÃ
32	* ¿©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
33	*
34	* {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨æ
35	* ÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚIÉÎ·
36	* éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEFAÌp
37	* Éæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»ÌÓCð
38	* íÈ¢D
39	*
40	*/
41
42	/*
43	* A[nh@\
44	*/
45
46	#include "alarm.h"
47	#include "check.h"
48	#include "time_event.h"
49
50	/*
51	* g[XO}NÌftHgè`
52	*/
53
54	#ifndef LOG_ALM_ENTER
55	#define LOG_ALM_ENTER(almidx)
56	#endif /* LOG_ALM_ENTER */
57
58	#ifndef LOG_ALM_LEAVE
59	#define LOG_ALM_LEAVE(almidx)
60	#endif /* LOG_ALM_LEAVE */
61
62	#ifndef LOG_STA_ALM_ENTER
63	#define LOG_STA_ALM_ENTER(almid, almtim)
64	#endif /* LOG_STA_ALM_ENTER */
65
66	#ifndef LOG_STA_ALM_LEAVE
67	#define LOG_STA_ALM_LEAVE(ercd)
68	#endif /* LOG_STA_ALM_LEAVE */
69
70	#ifndef LOG_ISTA_ALM_ENTER
71	#define LOG_ISTA_ALM_ENTER(almid, almtim)
72	#endif /* LOG_ISTA_ALM_ENTER */
73
74	#ifndef LOG_ISTA_ALM_LEAVE
75	#define LOG_ISTA_ALM_LEAVE(ercd)
76	#endif /* LOG_ISTA_ALM_LEAVE */
77
78	#ifndef LOG_STP_ALM_ENTER
79	#define LOG_STP_ALM_ENTER(almid)
80	#endif /* LOG_STP_ALM_ENTER */
81
82	#ifndef LOG_STP_ALM_LEAVE
83	#define LOG_STP_ALM_LEAVE(ercd)
84	#endif /* LOG_STP_ALM_LEAVE */
85
86	#ifndef LOG_ISTP_ALM_ENTER
87	#define LOG_ISTP_ALM_ENTER(almid)
88	#endif /* LOG_ISTP_ALM_ENTER */
89
90	#ifndef LOG_ISTP_ALM_LEAVE
91	#define LOG_ISTP_ALM_LEAVE(ercd)
92	#endif /* LOG_ISTP_ALM_LEAVE */
93
94
95	/* üúnhIDð^CCxgIDÉÏ· */
96	#define ALM_EVTID(almid) ((ID)(INDEX_ALM(almid) + almevtid_offset))
97	#define INDEX_ALM(almid) ((uint_t)((almid) - TMIN_ALMID))
98
99	/* A[nhÌÂ */
100	#define tnum_alm ((uint_t)(tmax_almid - TMIN_ALMID + 1))
101
102	/* A[Ì®ìóÔð\·rbg}bv */
103	#define ALMACT_BIT(index) (1U << (index))
104
105
106	/* A[nhÀs^CCxg */
107	void call_almhdr(uintptr_t almidx);
108
109
110	/*
111	* A[nh@\Ìú»
112	*/
113
114	#ifdef TOPPERS_almcal
115
116	void
117	initialize_alarm(void)
118	{
119	/* SÄÌA[ðâ~óÔÉ·é */
120	almcb_almact = 0U;
121	}
122
123	#endif /* TOPPERS_almcal */
124
125	/*
126	* A[ÌJn
127	*/
128
129	#ifdef TOPPERS_sta_alm
130
131	ER
132	sta_alm(ID almid , RELTIM almtim)
133	{
134	ER ercd;
135	uint_t index = INDEX_ALM(almid);
136
137	LOG_STA_ALM_ENTER(almid, almtim);
138	CHECK_TSKCTX_UNL();
139	CHECK_ALMID(almid);
140
141	t_lock_cpu();
142
143	if((almcb_almact & ALMACT_BIT(index)) != 0U) {
144	time_event_dequeue(ALM_EVTID(almid));
145	}
146	else {
147	almcb_almact \|= ALMACT_BIT(index);
148	}
149
150	time_event_enqueue(ALM_EVTID(almid) ,
151	current_time + (EVTTIM)almtim , (CBACK)call_almhdr , index);
152
153	ercd = E_OK;
154	t_unlock_cpu();
155
156	error_exit:
157	LOG_STA_ALM_LEAVE(ercd);
158	return ercd;
159	}
160
161	#endif /* TOPPERS_sta_alm */
162
163	/*
164	* A[ÌJn(ñ^XNReLXgp)
165	*/
166
167	#ifdef TOPPERS_ista_alm
168
169	ER
170	ista_alm(ID almid , RELTIM almtim)
171	{
172	ER ercd;
173	uint_t index = INDEX_ALM(almid);
174
175	LOG_ISTA_ALM_ENTER(almid, almtim);
176	CHECK_INTCTX_UNL();
177	CHECK_ALMID(almid);
178
179	i_lock_cpu();
180
181	if((almcb_almact & ALMACT_BIT(index)) != 0U) {
182	time_event_dequeue(ALM_EVTID(almid));
183	}
184	else {
185	almcb_almact \|= ALMACT_BIT(index);
186	}
187
188	time_event_enqueue(ALM_EVTID(almid) ,
189	current_time + (EVTTIM)almtim , (CBACK)call_almhdr , index);
190
191	ercd = E_OK;
192	i_unlock_cpu();
193
194	error_exit:
195	LOG_ISTA_ALM_LEAVE(ercd);
196	return ercd;
197	}
198
199	#endif /* TOPPERS_ista_alm */
200
201	/*
202	* A[Ìâ~
203	*/
204
205	#ifdef TOPPERS_stp_alm
206
207	ER
208	stp_alm(ID almid)
209	{
210	ER ercd;
211	uint_t index = INDEX_ALM(almid);
212
213	LOG_STP_ALM_ENTER(almid);
214	CHECK_TSKCTX_UNL();
215	CHECK_ALMID(almid);
216
217	t_lock_cpu();
218
219	if((almcb_almact & ALMACT_BIT(index)) != 0U) {
220	almcb_almact &= ~ALMACT_BIT(index);
221	time_event_dequeue(ALM_EVTID(almid));
222	}
223	ercd = E_OK;
224	t_unlock_cpu();
225
226	error_exit:
227	LOG_STP_ALM_LEAVE(ercd);
228	return ercd;
229	}
230
231	#endif /* TOPPERS_stp_alm */
232
233	/*
234	* A[Ìâ~(ñ^XNReLXgp)
235	*/
236
237	#ifdef TOPPERS_istp_alm
238
239	ER
240	istp_alm(ID almid)
241	{
242	ER ercd;
243	uint_t index = INDEX_ALM(almid);
244
245	LOG_ISTP_ALM_ENTER(almid);
246	CHECK_INTCTX_UNL();
247	CHECK_ALMID(almid);
248
249	i_lock_cpu();
250
251	if((almcb_almact & ALMACT_BIT(index)) != 0U) {
252	almcb_almact &= ~ALMACT_BIT(index);
253	time_event_dequeue(ALM_EVTID(almid));
254	}
255	ercd = E_OK;
256	i_unlock_cpu();
257
258	error_exit:
259	LOG_ISTP_ALM_LEAVE(ercd);
260	return ercd;
261	}
262
263	#endif /* TOPPERS_istp_alm */
264
265	/*
266	* A[nhN®[`
267	*/
268
269	#ifdef TOPPERS_almcal
270
271	void
272	call_almhdr(uintptr_t almidx)
273	{
274	/* A[nhðâ~óÔÉ·é */
275	almcb_almact &= ~ALMACT_BIT(almidx);
276
277	i_unlock_cpu();
278
279	/* A[nhÌÀs */
280	LOG_ALM_ENTER(almidx);
281	(*alminib_almhdr[almidx])(alminib_exinf[almidx]);
282	LOG_ALM_LEAVE(almidx);
283
284	if (!i_sense_lock()) {
285	i_lock_cpu();
286	}
287	}
288
289	#endif /* TOPPERS_almcal */
290

Note: See TracBrowser for help on using the repository browser.

Download in other formats: