Context Navigation

← Previous Revision
Latest Revision
Next Revision →
Blame
Revision Log

pridataq.c@ 61

Last change on this file since 61 was 61, checked in by ertl-honda, 11 years ago
ASP for EWARM のコミット．
File size: 18.6 KB

Line
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-2010 by Embedded and Real-Time Systems Laboratory
9	* Graduate School of Information Science, Nagoya Univ., JAPAN
10	*
11	* ãLì ÒÍCÈºÌ(1)`(4)Ìðð½·êÉÀèC{\tgEF
12	* Ai{\tgEFAðüÏµ½àÌðÜÞDÈº¯¶jðgpE¡»Eü
13	* ÏEÄzziÈºCpÆÄÔj·é±Æð³Åø·éD
14	* (1) {\tgEFAð\[XR[hÌ`Åp·éêÉÍCãLÌì
15	* \¦C±Ìpð¨æÑºLÌ³ÛØKèªC»ÌÜÜÌ`Å\[
16	* XR[hÉÜÜêÄ¢é±ÆD
17	* (2) {\tgEFAðCCu`®ÈÇC¼Ì\tgEFAJÉg
18	* pÅ«é`ÅÄzz·éêÉÍCÄzzÉº¤hL
19	gip
20	* Ò}j
21	AÈÇjÉCãLÌì \¦C±Ìpð¨æÑºL
22	* Ì³ÛØKèðfÚ·é±ÆD
23	* (3) {\tgEFAðC@íÉgÝÞÈÇC¼Ì\tgEFAJÉg
24	* pÅ«È¢`ÅÄzz·éêÉÍCÌ¢¸ê©Ìðð½·±
25	* ÆD
26	* (a) ÄzzÉº¤hL
27	gipÒ}j
28	AÈÇjÉCãLÌ
29	* ì \¦C±Ìpð¨æÑºLÌ³ÛØKèðfÚ·é±ÆD
30	* (b) ÄzzÌ`ÔðCÊÉèßéû@ÉæÁÄCTOPPERSvWFNgÉ
31	* ñ·é±ÆD
32	* (4) {\tgEFAÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶é¢©Èé¹
33	* Q©çàCãLì Ò¨æÑTOPPERSvWFNgðÆÓ·é±ÆD
34	* Ü½C{\tgEFAÌ[UÜ½ÍGh[U©çÌ¢©Èé
35	* RÉîÃ¿©çàCãLì Ò¨æÑTOPPERSvWFNgð
36	* ÆÓ·é±ÆD
37	*
38	* {\tgEFAÍC³ÛØÅñ³êÄ¢éàÌÅ éDãLì Ò¨
39	* æÑTOPPERSvWFNgÍC{\tgEFAÉÖµÄCÁèÌgpÚI
40	* ÉÎ·éK«àÜßÄC¢©ÈéÛØàsíÈ¢DÜ½C{\tgEF
41	* AÌpÉæè¼ÚIÜ½ÍÔÚIÉ¶¶½¢©Èé¹QÉÖµÄàC»
42	* ÌÓCðíÈ¢D
43	*
44	* @(#) $Id: pridataq.c 1966 2010-11-20 07:23:56Z ertl-hiro $
45	*/
46
47	/*
48	* Dæxf[^L
49	[@\
50	*/
51
52	#include "kernel_impl.h"
53	#include "check.h"
54	#include "task.h"
55	#include "wait.h"
56	#include "pridataq.h"
57
58	/*
59	* g[XO}NÌftHgè`
60	*/
61	#ifndef LOG_ACRE_PDQ_ENTER
62	#define LOG_ACRE_PDQ_ENTER(pk_cpdq)
63	#endif /* LOG_ACRE_PDQ_ENTER */
64
65	#ifndef LOG_ACRE_PDQ_LEAVE
66	#define LOG_ACRE_PDQ_LEAVE(ercd)
67	#endif /* LOG_ACRE_PDQ_LEAVE */
68
69	#ifndef LOG_DEL_PDQ_ENTER
70	#define LOG_DEL_PDQ_ENTER(pdqid)
71	#endif /* LOG_DEL_PDQ_ENTER */
72
73	#ifndef LOG_DEL_PDQ_LEAVE
74	#define LOG_DEL_PDQ_LEAVE(ercd)
75	#endif /* LOG_DEL_PDQ_LEAVE */
76
77	#ifndef LOG_SND_PDQ_ENTER
78	#define LOG_SND_PDQ_ENTER(pdqid, data, datapri)
79	#endif /* LOG_SND_PDQ_ENTER */
80
81	#ifndef LOG_SND_PDQ_LEAVE
82	#define LOG_SND_PDQ_LEAVE(ercd)
83	#endif /* LOG_SND_PDQ_LEAVE */
84
85	#ifndef LOG_PSND_PDQ_ENTER
86	#define LOG_PSND_PDQ_ENTER(pdqid, data, datapri)
87	#endif /* LOG_PSND_PDQ_ENTER */
88
89	#ifndef LOG_PSND_PDQ_LEAVE
90	#define LOG_PSND_PDQ_LEAVE(ercd)
91	#endif /* LOG_PSND_PDQ_LEAVE */
92
93	#ifndef LOG_IPSND_PDQ_ENTER
94	#define LOG_IPSND_PDQ_ENTER(pdqid, data, datapri)
95	#endif /* LOG_IPSND_PDQ_ENTER */
96
97	#ifndef LOG_IPSND_PDQ_LEAVE
98	#define LOG_IPSND_PDQ_LEAVE(ercd)
99	#endif /* LOG_IPSND_PDQ_LEAVE */
100
101	#ifndef LOG_TSND_PDQ_ENTER
102	#define LOG_TSND_PDQ_ENTER(pdqid, data, datapri, tmout)
103	#endif /* LOG_TSND_PDQ_ENTER */
104
105	#ifndef LOG_TSND_PDQ_LEAVE
106	#define LOG_TSND_PDQ_LEAVE(ercd)
107	#endif /* LOG_TSND_PDQ_LEAVE */
108
109	#ifndef LOG_RCV_PDQ_ENTER
110	#define LOG_RCV_PDQ_ENTER(pdqid, p_data, p_datapri)
111	#endif /* LOG_RCV_PDQ_ENTER */
112
113	#ifndef LOG_RCV_PDQ_LEAVE
114	#define LOG_RCV_PDQ_LEAVE(ercd, data, datapri)
115	#endif /* LOG_RCV_PDQ_LEAVE */
116
117	#ifndef LOG_PRCV_PDQ_ENTER
118	#define LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri)
119	#endif /* LOG_PRCV_PDQ_ENTER */
120
121	#ifndef LOG_PRCV_PDQ_LEAVE
122	#define LOG_PRCV_PDQ_LEAVE(ercd, data, datapri)
123	#endif /* LOG_PRCV_PDQ_LEAVE */
124
125	#ifndef LOG_TRCV_PDQ_ENTER
126	#define LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout)
127	#endif /* LOG_TRCV_PDQ_ENTER */
128
129	#ifndef LOG_TRCV_PDQ_LEAVE
130	#define LOG_TRCV_PDQ_LEAVE(ercd, data, datapri)
131	#endif /* LOG_TRCV_PDQ_LEAVE */
132
133	#ifndef LOG_INI_PDQ_ENTER
134	#define LOG_INI_PDQ_ENTER(pdqid)
135	#endif /* LOG_INI_PDQ_ENTER */
136
137	#ifndef LOG_INI_PDQ_LEAVE
138	#define LOG_INI_PDQ_LEAVE(ercd)
139	#endif /* LOG_INI_PDQ_LEAVE */
140
141	#ifndef LOG_REF_PDQ_ENTER
142	#define LOG_REF_PDQ_ENTER(pdqid, pk_rpdq)
143	#endif /* LOG_REF_PDQ_ENTER */
144
145	#ifndef LOG_REF_PDQ_LEAVE
146	#define LOG_REF_PDQ_LEAVE(ercd, pk_rpdq)
147	#endif /* LOG_REF_PDQ_LEAVE */
148
149	/*
150	* Dæxf[^L
151	[Ì
152	*/
153	#define tnum_pdq ((uint_t)(tmax_pdqid - TMIN_PDQID + 1))
154	#define tnum_spdq ((uint_t)(tmax_spdqid - TMIN_PDQID + 1))
155
156	/*
157	* Dæxf[^L
158	[ID©çDæxf[^L
159	[ÇubNðæèo·½
160	* ßÌ}N
161	*/
162	#define INDEX_PDQ(pdqid) ((uint_t)((pdqid) - TMIN_PDQID))
163	#define get_pdqcb(pdqid) (&(pdqcb_table[INDEX_PDQ(pdqid)]))
164
165	#ifdef TOPPERS_pdqini
166
167	/*
168	* gpµÄ¢È¢Dæxf[^L
169	[ÇubNÌXg
170	*/
171	QUEUE free_pdqcb;
172
173	/*
174	* Dæxf[^L
175	[@\Ìú»
176	*/
177	void
178	initialize_pridataq(void)
179	{
180	uint_t i, j;
181	PDQCB *p_pdqcb;
182	PDQINIB *p_pdqinib;
183
184	for (p_pdqcb = pdqcb_table, i = 0; i < tnum_spdq; p_pdqcb++, i++) {
185	queue_initialize(&(p_pdqcb->swait_queue));
186	p_pdqcb->p_pdqinib = &(pdqinib_table[i]);
187	queue_initialize(&(p_pdqcb->rwait_queue));
188	p_pdqcb->count = 0U;
189	p_pdqcb->p_head = NULL;
190	p_pdqcb->unused = 0U;
191	p_pdqcb->p_freelist = NULL;
192	}
193	queue_initialize(&free_pdqcb);
194	for (j = 0; i < tnum_pdq; p_pdqcb++, i++, j++) {
195	p_pdqinib = &(apdqinib_table[j]);
196	p_pdqinib->pdqatr = TA_NOEXS;
197	p_pdqcb->p_pdqinib = ((const PDQINIB *) p_pdqinib);
198	queue_insert_prev(&free_pdqcb, &(p_pdqcb->swait_queue));
199	}
200	}
201
202	#endif /* TOPPERS_pdqini */
203
204	/*
205	* Dæxf[^L
206	[Ì¶¬
207	*/
208	#ifdef TOPPERS_acre_pdq
209
210	ER_UINT
211	acre_pdq(const T_CPDQ *pk_cpdq)
212	{
213	PDQCB *p_pdqcb;
214	PDQINIB *p_pdqinib;
215	ATR pdqatr;
216	PDQMB *p_pdqmb;
217	ER ercd;
218
219	LOG_ACRE_PDQ_ENTER(pk_cpdq);
220	CHECK_TSKCTX_UNL();
221	CHECK_RSATR(pk_cpdq->pdqatr, TA_TPRI);
222	CHECK_DPRI(pk_cpdq->maxdpri);
223	pdqatr = pk_cpdq->pdqatr;
224	p_pdqmb = pk_cpdq->pdqmb;
225
226	t_lock_cpu();
227	if (queue_empty(&free_pdqcb)) {
228	ercd = E_NOID;
229	}
230	else {
231	if (pk_cpdq->pdqcnt != 0 && p_pdqmb == NULL) {
232	p_pdqmb = kernel_malloc(sizeof(PDQMB) * pk_cpdq->pdqcnt);
233	pdqatr \|= TA_MBALLOC;
234	}
235	if (pk_cpdq->pdqcnt != 0 && p_pdqmb == NULL) {
236	ercd = E_NOMEM;
237	}
238	else {
239	p_pdqcb = ((PDQCB *) queue_delete_next(&free_pdqcb));
240	p_pdqinib = (PDQINIB *)(p_pdqcb->p_pdqinib);
241	p_pdqinib->pdqatr = pdqatr;
242	p_pdqinib->pdqcnt = pk_cpdq->pdqcnt;
243	p_pdqinib->maxdpri = pk_cpdq->maxdpri;
244	p_pdqinib->p_pdqmb = p_pdqmb;
245
246	queue_initialize(&(p_pdqcb->swait_queue));
247	queue_initialize(&(p_pdqcb->rwait_queue));
248	p_pdqcb->count = 0U;
249	p_pdqcb->p_head = NULL;
250	p_pdqcb->unused = 0U;
251	p_pdqcb->p_freelist = NULL;
252	ercd = PDQID(p_pdqcb);
253	}
254	}
255	t_unlock_cpu();
256
257	error_exit:
258	LOG_ACRE_PDQ_LEAVE(ercd);
259	return(ercd);
260	}
261
262	#endif /* TOPPERS_acre_pdq */
263
264	/*
265	* Dæxf[^L
266	[Ìí
267	*/
268	#ifdef TOPPERS_del_pdq
269
270	ER
271	del_pdq(ID pdqid)
272	{
273	PDQCB *p_pdqcb;
274	PDQINIB *p_pdqinib;
275	bool_t dspreq;
276	ER ercd;
277
278	LOG_DEL_PDQ_ENTER(pdqid);
279	CHECK_TSKCTX_UNL();
280	CHECK_PDQID(pdqid);
281	p_pdqcb = get_pdqcb(pdqid);
282
283	t_lock_cpu();
284	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
285	ercd = E_NOEXS;
286	}
287	else if (PDQID(p_pdqcb) > tmax_spdqid) {
288	dspreq = init_wait_queue(&(p_pdqcb->swait_queue));
289	if (init_wait_queue(&(p_pdqcb->rwait_queue))) {
290	dspreq = true;
291	};
292	p_pdqinib = (PDQINIB *)(p_pdqcb->p_pdqinib);
293	if ((p_pdqinib->pdqatr & TA_MBALLOC) != 0U) {
294	kernel_free(p_pdqinib->p_pdqmb);
295	}
296	p_pdqinib->pdqatr = TA_NOEXS;
297	queue_insert_prev(&free_pdqcb, &(p_pdqcb->swait_queue));
298	if (dspreq) {
299	dispatch();
300	}
301	ercd = E_OK;
302	}
303	else {
304	ercd = E_OBJ;
305	}
306	t_unlock_cpu();
307
308	error_exit:
309	LOG_DEL_PDQ_LEAVE(ercd);
310	return(ercd);
311	}
312
313	#endif /* TOPPERS_del_pdq */
314
315	/*
316	* Dæxf[^L
317	[ÇÌæÖÌf[^Ìi[
318	*/
319	#ifdef TOPPERS_pdqenq
320
321	void
322	enqueue_pridata(PDQCB *p_pdqcb, intptr_t data, PRI datapri)
323	{
324	PDQMB *p_pdqmb;
325	PDQMB *pp_prev_next, p_next;
326
327	if (p_pdqcb->p_freelist != NULL) {
328	p_pdqmb = p_pdqcb->p_freelist;
329	p_pdqcb->p_freelist = p_pdqmb->p_next;
330	}
331	else {
332	p_pdqmb = p_pdqcb->p_pdqinib->p_pdqmb + p_pdqcb->unused;
333	p_pdqcb->unused++;
334	}
335
336	p_pdqmb->data = data;
337	p_pdqmb->datapri = datapri;
338
339	pp_prev_next = &(p_pdqcb->p_head);
340	while ((p_next = *pp_prev_next) != NULL) {
341	if (p_next->datapri > datapri) {
342	break;
343	}
344	pp_prev_next = &(p_next->p_next);
345	}
346	p_pdqmb->p_next = p_next;
347	*pp_prev_next = p_pdqmb;
348	p_pdqcb->count++;
349	}
350
351	#endif /* TOPPERS_pdqenq */
352
353	/*
354	* Dæxf[^L
355	[ÇÌæ©çÌf[^Ìæoµ
356	*/
357	#ifdef TOPPERS_pdqdeq
358
359	void
360	dequeue_pridata(PDQCB p_pdqcb, intptr_t p_data, PRI *p_datapri)
361	{
362	PDQMB *p_pdqmb;
363
364	p_pdqmb = p_pdqcb->p_head;
365	p_pdqcb->p_head = p_pdqmb->p_next;
366	p_pdqcb->count--;
367
368	*p_data = p_pdqmb->data;
369	*p_datapri = p_pdqmb->datapri;
370
371	p_pdqmb->p_next = p_pdqcb->p_freelist;
372	p_pdqcb->p_freelist = p_pdqmb;
373	}
374
375	#endif /* TOPPERS_pdqdeq */
376
377	/*
378	* Dæxf[^L
379	[ÖÌf[^M
380	*/
381	#ifdef TOPPERS_pdqsnd
382
383	bool_t
384	send_pridata(PDQCB p_pdqcb, intptr_t data, PRI datapri, bool_t p_reqdsp)
385	{
386	TCB *p_tcb;
387
388	if (!queue_empty(&(p_pdqcb->rwait_queue))) {
389	p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->rwait_queue));
390	((WINFO_PDQ *)(p_tcb->p_winfo))->data = data;
391	((WINFO_PDQ *)(p_tcb->p_winfo))->datapri = datapri;
392	*p_reqdsp = wait_complete(p_tcb);
393	return(true);
394	}
395	else if (p_pdqcb->count < p_pdqcb->p_pdqinib->pdqcnt) {
396	enqueue_pridata(p_pdqcb, data, datapri);
397	*p_reqdsp = false;
398	return(true);
399	}
400	else {
401	return(false);
402	}
403	}
404
405	#endif /* TOPPERS_pdqsnd */
406
407	/*
408	* Dæxf[^L
409	[©çÌf[^óM
410	*/
411	#ifdef TOPPERS_pdqrcv
412
413	bool_t
414	receive_pridata(PDQCB p_pdqcb, intptr_t p_data,
415	PRI p_datapri, bool_t p_reqdsp)
416	{
417	TCB *p_tcb;
418	intptr_t data;
419	PRI datapri;
420
421	if (p_pdqcb->count > 0U) {
422	dequeue_pridata(p_pdqcb, p_data, p_datapri);
423	if (!queue_empty(&(p_pdqcb->swait_queue))) {
424	p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->swait_queue));
425	data = ((WINFO_PDQ *)(p_tcb->p_winfo))->data;
426	datapri = ((WINFO_PDQ *)(p_tcb->p_winfo))->datapri;
427	enqueue_pridata(p_pdqcb, data, datapri);
428	*p_reqdsp = wait_complete(p_tcb);
429	}
430	else {
431	*p_reqdsp = false;
432	}
433	return(true);
434	}
435	else if (!queue_empty(&(p_pdqcb->swait_queue))) {
436	p_tcb = (TCB *) queue_delete_next(&(p_pdqcb->swait_queue));
437	p_data = ((WINFO_PDQ )(p_tcb->p_winfo))->data;
438	p_datapri = ((WINFO_PDQ )(p_tcb->p_winfo))->datapri;
439	*p_reqdsp = wait_complete(p_tcb);
440	return(true);
441	}
442	else {
443	return(false);
444	}
445	}
446
447	#endif /* TOPPERS_pdqrcv */
448
449	/*
450	* Dæxf[^L
451	[ÖÌM
452	*/
453	#ifdef TOPPERS_snd_pdq
454
455	ER
456	snd_pdq(ID pdqid, intptr_t data, PRI datapri)
457	{
458	PDQCB *p_pdqcb;
459	WINFO_PDQ winfo_pdq;
460	bool_t reqdsp;
461	ER ercd;
462
463	LOG_SND_PDQ_ENTER(pdqid, data, datapri);
464	CHECK_DISPATCH();
465	CHECK_PDQID(pdqid);
466	p_pdqcb = get_pdqcb(pdqid);
467	CHECK_PAR(TMIN_DPRI <= datapri && datapri <= p_pdqcb->p_pdqinib->maxdpri);
468
469	t_lock_cpu();
470	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
471	ercd = E_NOEXS;
472	}
473	else if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
474	if (reqdsp) {
475	dispatch();
476	}
477	ercd = E_OK;
478	}
479	else {
480	winfo_pdq.data = data;
481	winfo_pdq.datapri = datapri;
482	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_SPDQ);
483	wobj_make_wait((WOBJCB ) p_pdqcb, (WINFO_WOBJ ) &winfo_pdq);
484	dispatch();
485	ercd = winfo_pdq.winfo.wercd;
486	}
487	t_unlock_cpu();
488
489	error_exit:
490	LOG_SND_PDQ_LEAVE(ercd);
491	return(ercd);
492	}
493
494	#endif /* TOPPERS_snd_pdq */
495
496	/*
497	* Dæxf[^L
498	[ÖÌMi\|[Oj
499	*/
500	#ifdef TOPPERS_psnd_pdq
501
502	ER
503	psnd_pdq(ID pdqid, intptr_t data, PRI datapri)
504	{
505	PDQCB *p_pdqcb;
506	bool_t reqdsp;
507	ER ercd;
508
509	LOG_PSND_PDQ_ENTER(pdqid, data, datapri);
510	CHECK_TSKCTX_UNL();
511	CHECK_PDQID(pdqid);
512	p_pdqcb = get_pdqcb(pdqid);
513	CHECK_PAR(TMIN_DPRI <= datapri && datapri <= p_pdqcb->p_pdqinib->maxdpri);
514
515	t_lock_cpu();
516	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
517	ercd = E_NOEXS;
518	}
519	else if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
520	if (reqdsp) {
521	dispatch();
522	}
523	ercd = E_OK;
524	}
525	else {
526	ercd = E_TMOUT;
527	}
528	t_unlock_cpu();
529
530	error_exit:
531	LOG_PSND_PDQ_LEAVE(ercd);
532	return(ercd);
533	}
534
535	#endif /* TOPPERS_psnd_pdq */
536
537	/*
538	* Dæxf[^L
539	[ÖÌMi\|[OCñ^XNReLXgpj
540	*/
541	#ifdef TOPPERS_ipsnd_pdq
542
543	ER
544	ipsnd_pdq(ID pdqid, intptr_t data, PRI datapri)
545	{
546	PDQCB *p_pdqcb;
547	bool_t reqdsp;
548	ER ercd;
549
550	LOG_IPSND_PDQ_ENTER(pdqid, data, datapri);
551	CHECK_INTCTX_UNL();
552	CHECK_PDQID(pdqid);
553	p_pdqcb = get_pdqcb(pdqid);
554	CHECK_PAR(TMIN_DPRI <= datapri && datapri <= p_pdqcb->p_pdqinib->maxdpri);
555
556	i_lock_cpu();
557	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
558	ercd = E_NOEXS;
559	}
560	else if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
561	if (reqdsp) {
562	reqflg = true;
563	}
564	ercd = E_OK;
565	}
566	else {
567	ercd = E_TMOUT;
568	}
569	i_unlock_cpu();
570
571	error_exit:
572	LOG_IPSND_PDQ_LEAVE(ercd);
573	return(ercd);
574	}
575
576	#endif /* TOPPERS_ipsnd_pdq */
577
578	/*
579	* Dæxf[^L
580	[ÖÌMi^CAEg èj
581	*/
582	#ifdef TOPPERS_tsnd_pdq
583
584	ER
585	tsnd_pdq(ID pdqid, intptr_t data, PRI datapri, TMO tmout)
586	{
587	PDQCB *p_pdqcb;
588	WINFO_PDQ winfo_pdq;
589	TMEVTB tmevtb;
590	bool_t reqdsp;
591	ER ercd;
592
593	LOG_TSND_PDQ_ENTER(pdqid, data, datapri, tmout);
594	CHECK_DISPATCH();
595	CHECK_PDQID(pdqid);
596	CHECK_TMOUT(tmout);
597	p_pdqcb = get_pdqcb(pdqid);
598	CHECK_PAR(TMIN_DPRI <= datapri && datapri <= p_pdqcb->p_pdqinib->maxdpri);
599
600	t_lock_cpu();
601	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
602	ercd = E_NOEXS;
603	}
604	else if (send_pridata(p_pdqcb, data, datapri, &reqdsp)) {
605	if (reqdsp) {
606	dispatch();
607	}
608	ercd = E_OK;
609	}
610	else if (tmout == TMO_POL) {
611	ercd = E_TMOUT;
612	}
613	else {
614	winfo_pdq.data = data;
615	winfo_pdq.datapri = datapri;
616	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_SPDQ);
617	wobj_make_wait_tmout((WOBJCB ) p_pdqcb, (WINFO_WOBJ ) &winfo_pdq,
618	&tmevtb, tmout);
619	dispatch();
620	ercd = winfo_pdq.winfo.wercd;
621	}
622	t_unlock_cpu();
623
624	error_exit:
625	LOG_TSND_PDQ_LEAVE(ercd);
626	return(ercd);
627	}
628
629	#endif /* TOPPERS_tsnd_pdq */
630
631	/*
632	* Dæxf[^L
633	[©çÌóM
634	*/
635	#ifdef TOPPERS_rcv_pdq
636
637	ER
638	rcv_pdq(ID pdqid, intptr_t p_data, PRI p_datapri)
639	{
640	PDQCB *p_pdqcb;
641	WINFO_PDQ winfo_pdq;
642	bool_t reqdsp;
643	ER ercd;
644
645	LOG_RCV_PDQ_ENTER(pdqid, p_data, p_datapri);
646	CHECK_DISPATCH();
647	CHECK_PDQID(pdqid);
648	p_pdqcb = get_pdqcb(pdqid);
649
650	t_lock_cpu();
651	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
652	ercd = E_NOEXS;
653	}
654	else if (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
655	if (reqdsp) {
656	dispatch();
657	}
658	ercd = E_OK;
659	}
660	else {
661	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_RPDQ);
662	make_wait(&(winfo_pdq.winfo));
663	queue_insert_prev(&(p_pdqcb->rwait_queue), &(p_runtsk->task_queue));
664	winfo_pdq.p_pdqcb = p_pdqcb;
665	LOG_TSKSTAT(p_runtsk);
666	dispatch();
667	ercd = winfo_pdq.winfo.wercd;
668	if (ercd == E_OK) {
669	*p_data = winfo_pdq.data;
670	*p_datapri = winfo_pdq.datapri;
671	}
672	}
673	t_unlock_cpu();
674
675	error_exit:
676	LOG_RCV_PDQ_LEAVE(ercd, p_data, p_datapri);
677	return(ercd);
678	}
679
680	#endif /* TOPPERS_rcv_pdq */
681
682	/*
683	* Dæxf[^L
684	[©çÌóMi\|[Oj
685	*/
686	#ifdef TOPPERS_prcv_pdq
687
688	ER
689	prcv_pdq(ID pdqid, intptr_t p_data, PRI p_datapri)
690	{
691	PDQCB *p_pdqcb;
692	bool_t reqdsp;
693	ER ercd;
694
695	LOG_PRCV_PDQ_ENTER(pdqid, p_data, p_datapri);
696	CHECK_TSKCTX_UNL();
697	CHECK_PDQID(pdqid);
698	p_pdqcb = get_pdqcb(pdqid);
699
700	t_lock_cpu();
701	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
702	ercd = E_NOEXS;
703	}
704	else if (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
705	if (reqdsp) {
706	dispatch();
707	}
708	ercd = E_OK;
709	}
710	else {
711	ercd = E_TMOUT;
712	}
713	t_unlock_cpu();
714
715	error_exit:
716	LOG_PRCV_PDQ_LEAVE(ercd, p_data, p_datapri);
717	return(ercd);
718	}
719
720	#endif /* TOPPERS_prcv_pdq */
721
722	/*
723	* Dæxf[^L
724	[©çÌóMi^CAEg èj
725	*/
726	#ifdef TOPPERS_trcv_pdq
727
728	ER
729	trcv_pdq(ID pdqid, intptr_t p_data, PRI p_datapri, TMO tmout)
730	{
731	PDQCB *p_pdqcb;
732	WINFO_PDQ winfo_pdq;
733	TMEVTB tmevtb;
734	bool_t reqdsp;
735	ER ercd;
736
737	LOG_TRCV_PDQ_ENTER(pdqid, p_data, p_datapri, tmout);
738	CHECK_DISPATCH();
739	CHECK_PDQID(pdqid);
740	CHECK_TMOUT(tmout);
741	p_pdqcb = get_pdqcb(pdqid);
742
743	t_lock_cpu();
744	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
745	ercd = E_NOEXS;
746	}
747	else if (receive_pridata(p_pdqcb, p_data, p_datapri, &reqdsp)) {
748	if (reqdsp) {
749	dispatch();
750	}
751	ercd = E_OK;
752	}
753	else if (tmout == TMO_POL) {
754	ercd = E_TMOUT;
755	}
756	else {
757	p_runtsk->tstat = (TS_WAITING \| TS_WAIT_RPDQ);
758	make_wait_tmout(&(winfo_pdq.winfo), &tmevtb, tmout);
759	queue_insert_prev(&(p_pdqcb->rwait_queue), &(p_runtsk->task_queue));
760	winfo_pdq.p_pdqcb = p_pdqcb;
761	LOG_TSKSTAT(p_runtsk);
762	dispatch();
763	ercd = winfo_pdq.winfo.wercd;
764	if (ercd == E_OK) {
765	*p_data = winfo_pdq.data;
766	*p_datapri = winfo_pdq.datapri;
767	}
768	}
769	t_unlock_cpu();
770
771	error_exit:
772	LOG_TRCV_PDQ_LEAVE(ercd, p_data, p_datapri);
773	return(ercd);
774	}
775
776	#endif /* TOPPERS_trcv_pdq */
777
778	/*
779	* Dæxf[^L
780	[ÌÄú»
781	*/
782	#ifdef TOPPERS_ini_pdq
783
784	ER
785	ini_pdq(ID pdqid)
786	{
787	PDQCB *p_pdqcb;
788	bool_t dspreq;
789	ER ercd;
790
791	LOG_INI_PDQ_ENTER(pdqid);
792	CHECK_TSKCTX_UNL();
793	CHECK_PDQID(pdqid);
794	p_pdqcb = get_pdqcb(pdqid);
795
796	t_lock_cpu();
797	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
798	ercd = E_NOEXS;
799	}
800	else {
801	dspreq = init_wait_queue(&(p_pdqcb->swait_queue));
802	if (init_wait_queue(&(p_pdqcb->rwait_queue))) {
803	dspreq = true;
804	}
805	p_pdqcb->count = 0U;
806	p_pdqcb->p_head = NULL;
807	p_pdqcb->unused = 0U;
808	p_pdqcb->p_freelist = NULL;
809	if (dspreq) {
810	dispatch();
811	}
812	ercd = E_OK;
813	}
814	t_unlock_cpu();
815
816	error_exit:
817	LOG_INI_PDQ_LEAVE(ercd);
818	return(ercd);
819	}
820
821	#endif /* TOPPERS_ini_pdq */
822
823	/*
824	* Dæxf[^L
825	[ÌóÔQÆ
826	*/
827	#ifdef TOPPERS_ref_pdq
828
829	ER
830	ref_pdq(ID pdqid, T_RPDQ *pk_rpdq)
831	{
832	PDQCB *p_pdqcb;
833	ER ercd;
834
835	LOG_REF_PDQ_ENTER(pdqid, pk_rpdq);
836	CHECK_TSKCTX_UNL();
837	CHECK_PDQID(pdqid);
838	p_pdqcb = get_pdqcb(pdqid);
839
840	t_lock_cpu();
841	if (p_pdqcb->p_pdqinib->pdqatr == TA_NOEXS) {
842	ercd = E_NOEXS;
843	}
844	else {
845	pk_rpdq->stskid = wait_tskid(&(p_pdqcb->swait_queue));
846	pk_rpdq->rtskid = wait_tskid(&(p_pdqcb->rwait_queue));
847	pk_rpdq->spdqcnt = p_pdqcb->count;
848	ercd = E_OK;
849	}
850	t_unlock_cpu();
851
852	error_exit:
853	LOG_REF_PDQ_LEAVE(ercd, pk_rpdq);
854	return(ercd);
855	}
856
857	#endif /* TOPPERS_ref_pdq */

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

Context Navigation

source: asp_ewarm/asp-1.7.0/extension/dcre/kernel/pridataq.c@ 61

Download in other formats: