source: EcnlProtoTool/trunk/asp3_dcre/kernel/dataqueue.c@ 279

Last change on this file since 279 was 279, checked in by coas-nagasima, 7 years ago

ファイルを追加、更新。
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 17.9 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-2017 by Embedded and Real-Time Systems Laboratory
9 * Graduate School of Information Science, Nagoya Univ., JAPAN
10 *
11 * 上記著作権者
12は，以下の(1)～(4)の条件を満たす場合に限り，本ソフトウェ
13 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
14 * 変・再é…
15å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
16 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
17 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
18 * スコード中に含まれていること．
19 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
20 * 用できる形で再é…
21å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
22å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
23 * 者
24マニュアルなど）に，上記の著作権表示，この利用条件および下記
25 * の無保証規定を掲載すること．
26 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
27 * 用できない形で再é…
28å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
29 * と．
30 * (a) 再é…
31å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
32マニュアルなど）に，上記の著
33 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
34 * (b) 再é…
35å¸ƒã®å½¢æ…
36‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
37 * 報告すること．
38 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
39 * 害からも，上記著作権者
40およびTOPPERSプロジェクトをå…
41è²¬ã™ã‚‹ã“と．
42 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
43 * 由に基づく請求からも，上記著作権者
44およびTOPPERSプロジェクトを
45 * å…
46è²¬ã™ã‚‹ã“と．
47 *
48 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
49お
50 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
51 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
52 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
53 * の責任を負わない．
54 *
55 * $Id: dataqueue.c 279 2017-04-29 07:33:37Z coas-nagasima $
56 */
57
58/*
59 * データキュー機能
60 */
61
62#include "kernel_impl.h"
63#include "check.h"
64#include "task.h"
65#include "wait.h"
66#include "dataqueue.h"
67
68/*
69 * トレースログマクロのデフォルト定義
70 */
71#ifndef LOG_ACRE_DTQ_ENTER
72#define LOG_ACRE_DTQ_ENTER(pk_cdtq)
73#endif /* LOG_ACRE_DTQ_ENTER */
74
75#ifndef LOG_ACRE_DTQ_LEAVE
76#define LOG_ACRE_DTQ_LEAVE(ercd)
77#endif /* LOG_ACRE_DTQ_LEAVE */
78
79#ifndef LOG_DEL_DTQ_ENTER
80#define LOG_DEL_DTQ_ENTER(dtqid)
81#endif /* LOG_DEL_DTQ_ENTER */
82
83#ifndef LOG_DEL_DTQ_LEAVE
84#define LOG_DEL_DTQ_LEAVE(ercd)
85#endif /* LOG_DEL_DTQ_LEAVE */
86
87#ifndef LOG_SND_DTQ_ENTER
88#define LOG_SND_DTQ_ENTER(dtqid, data)
89#endif /* LOG_SND_DTQ_ENTER */
90
91#ifndef LOG_SND_DTQ_LEAVE
92#define LOG_SND_DTQ_LEAVE(ercd)
93#endif /* LOG_SND_DTQ_LEAVE */
94
95#ifndef LOG_PSND_DTQ_ENTER
96#define LOG_PSND_DTQ_ENTER(dtqid, data)
97#endif /* LOG_PSND_DTQ_ENTER */
98
99#ifndef LOG_PSND_DTQ_LEAVE
100#define LOG_PSND_DTQ_LEAVE(ercd)
101#endif /* LOG_PSND_DTQ_LEAVE */
102
103#ifndef LOG_TSND_DTQ_ENTER
104#define LOG_TSND_DTQ_ENTER(dtqid, data, tmout)
105#endif /* LOG_TSND_DTQ_ENTER */
106
107#ifndef LOG_TSND_DTQ_LEAVE
108#define LOG_TSND_DTQ_LEAVE(ercd)
109#endif /* LOG_TSND_DTQ_LEAVE */
110
111#ifndef LOG_FSND_DTQ_ENTER
112#define LOG_FSND_DTQ_ENTER(dtqid, data)
113#endif /* LOG_FSND_DTQ_ENTER */
114
115#ifndef LOG_FSND_DTQ_LEAVE
116#define LOG_FSND_DTQ_LEAVE(ercd)
117#endif /* LOG_FSND_DTQ_LEAVE */
118
119#ifndef LOG_RCV_DTQ_ENTER
120#define LOG_RCV_DTQ_ENTER(dtqid, p_data)
121#endif /* LOG_RCV_DTQ_ENTER */
122
123#ifndef LOG_RCV_DTQ_LEAVE
124#define LOG_RCV_DTQ_LEAVE(ercd, p_data)
125#endif /* LOG_RCV_DTQ_LEAVE */
126
127#ifndef LOG_PRCV_DTQ_ENTER
128#define LOG_PRCV_DTQ_ENTER(dtqid, p_data)
129#endif /* LOG_PRCV_DTQ_ENTER */
130
131#ifndef LOG_PRCV_DTQ_LEAVE
132#define LOG_PRCV_DTQ_LEAVE(ercd, p_data)
133#endif /* LOG_PRCV_DTQ_LEAVE */
134
135#ifndef LOG_TRCV_DTQ_ENTER
136#define LOG_TRCV_DTQ_ENTER(dtqid, p_data, tmout)
137#endif /* LOG_TRCV_DTQ_ENTER */
138
139#ifndef LOG_TRCV_DTQ_LEAVE
140#define LOG_TRCV_DTQ_LEAVE(ercd, p_data)
141#endif /* LOG_TRCV_DTQ_LEAVE */
142
143#ifndef LOG_INI_DTQ_ENTER
144#define LOG_INI_DTQ_ENTER(dtqid)
145#endif /* LOG_INI_DTQ_ENTER */
146
147#ifndef LOG_INI_DTQ_LEAVE
148#define LOG_INI_DTQ_LEAVE(ercd)
149#endif /* LOG_INI_DTQ_LEAVE */
150
151#ifndef LOG_REF_DTQ_ENTER
152#define LOG_REF_DTQ_ENTER(dtqid, pk_rdtq)
153#endif /* LOG_REF_DTQ_ENTER */
154
155#ifndef LOG_REF_DTQ_LEAVE
156#define LOG_REF_DTQ_LEAVE(ercd, pk_rdtq)
157#endif /* LOG_REF_DTQ_LEAVE */
158
159/*
160 * データキューの数
161 */
162#define tnum_dtq ((uint_t)(tmax_dtqid - TMIN_DTQID + 1))
163#define tnum_sdtq ((uint_t)(tmax_sdtqid - TMIN_DTQID + 1))
164
165/*
166 * データキューIDからデータキュー管理ブロックを取り出すためのマクロ
167 */
168#define INDEX_DTQ(dtqid) ((uint_t)((dtqid) - TMIN_DTQID))
169#define get_dtqcb(dtqid) (&(dtqcb_table[INDEX_DTQ(dtqid)]))
170
171#ifdef TOPPERS_dtqini
172
173/*
174 * 使用していないデータキュー管理ブロックのリスト
175 */
176QUEUE free_dtqcb;
177
178/*
179 * データキュー機能の初期化
180 */
181void
182initialize_dataqueue(void)
183{
184 uint_t i, j;
185 DTQCB *p_dtqcb;
186 DTQINIB *p_dtqinib;
187
188 for (i = 0; i < tnum_sdtq; i++) {
189 p_dtqcb = &(dtqcb_table[i]);
190 queue_initialize(&(p_dtqcb->swait_queue));
191 p_dtqcb->p_dtqinib = &(dtqinib_table[i]);
192 queue_initialize(&(p_dtqcb->rwait_queue));
193 p_dtqcb->count = 0U;
194 p_dtqcb->head = 0U;
195 p_dtqcb->tail = 0U;
196 }
197 queue_initialize(&free_dtqcb);
198 for (j = 0; i < tnum_dtq; i++, j++) {
199 p_dtqcb = &(dtqcb_table[i]);
200 p_dtqinib = &(adtqinib_table[j]);
201 p_dtqinib->dtqatr = TA_NOEXS;
202 p_dtqcb->p_dtqinib = ((const DTQINIB *) p_dtqinib);
203 queue_insert_prev(&free_dtqcb, &(p_dtqcb->swait_queue));
204 }
205}
206
207#endif /* TOPPERS_dtqini */
208
209/*
210 * データキュー管理領域へのデータの格納
211 */
212#ifdef TOPPERS_dtqenq
213
214void
215enqueue_data(DTQCB *p_dtqcb, intptr_t data)
216{
217 (p_dtqcb->p_dtqinib->p_dtqmb + p_dtqcb->tail)->data = data;
218 p_dtqcb->count++;
219 p_dtqcb->tail++;
220 if (p_dtqcb->tail >= p_dtqcb->p_dtqinib->dtqcnt) {
221 p_dtqcb->tail = 0U;
222 }
223}
224
225#endif /* TOPPERS_dtqenq */
226
227/*
228 * データキュー管理領域へのデータの強制格納
229 */
230#ifdef TOPPERS_dtqfenq
231
232void
233force_enqueue_data(DTQCB *p_dtqcb, intptr_t data)
234{
235 (p_dtqcb->p_dtqinib->p_dtqmb + p_dtqcb->tail)->data = data;
236 p_dtqcb->tail++;
237 if (p_dtqcb->tail >= p_dtqcb->p_dtqinib->dtqcnt) {
238 p_dtqcb->tail = 0U;
239 }
240 if (p_dtqcb->count < p_dtqcb->p_dtqinib->dtqcnt) {
241 p_dtqcb->count++;
242 }
243 else {
244 p_dtqcb->head = p_dtqcb->tail;
245 }
246}
247
248#endif /* TOPPERS_dtqfenq */
249
250/*
251 * データキュー管理領域からのデータの取出し
252 */
253#ifdef TOPPERS_dtqdeq
254
255void
256dequeue_data(DTQCB *p_dtqcb, intptr_t *p_data)
257{
258 *p_data = (p_dtqcb->p_dtqinib->p_dtqmb + p_dtqcb->head)->data;
259 p_dtqcb->count--;
260 p_dtqcb->head++;
261 if (p_dtqcb->head >= p_dtqcb->p_dtqinib->dtqcnt) {
262 p_dtqcb->head = 0U;
263 }
264}
265
266#endif /* TOPPERS_dtqdeq */
267
268/*
269 * データキューへのデータ送信
270 */
271#ifdef TOPPERS_dtqsnd
272
273bool_t
274send_data(DTQCB *p_dtqcb, intptr_t data)
275{
276 TCB *p_tcb;
277
278 if (!queue_empty(&(p_dtqcb->rwait_queue))) {
279 p_tcb = (TCB *) queue_delete_next(&(p_dtqcb->rwait_queue));
280 ((WINFO_RDTQ *)(p_tcb->p_winfo))->data = data;
281 wait_complete(p_tcb);
282 return(true);
283 }
284 else if (p_dtqcb->count < p_dtqcb->p_dtqinib->dtqcnt) {
285 enqueue_data(p_dtqcb, data);
286 return(true);
287 }
288 else {
289 return(false);
290 }
291}
292
293#endif /* TOPPERS_dtqsnd */
294
295/*
296 * データキューへのデータ強制送信
297 */
298#ifdef TOPPERS_dtqfsnd
299
300void
301force_send_data(DTQCB *p_dtqcb, intptr_t data)
302{
303 TCB *p_tcb;
304
305 if (!queue_empty(&(p_dtqcb->rwait_queue))) {
306 p_tcb = (TCB *) queue_delete_next(&(p_dtqcb->rwait_queue));
307 ((WINFO_RDTQ *)(p_tcb->p_winfo))->data = data;
308 wait_complete(p_tcb);
309 }
310 else {
311 force_enqueue_data(p_dtqcb, data);
312 }
313}
314
315#endif /* TOPPERS_dtqfsnd */
316
317/*
318 * データキューからのデータ受信
319 */
320#ifdef TOPPERS_dtqrcv
321
322bool_t
323receive_data(DTQCB *p_dtqcb, intptr_t *p_data)
324{
325 TCB *p_tcb;
326 intptr_t data;
327
328 if (p_dtqcb->count > 0U) {
329 dequeue_data(p_dtqcb, p_data);
330 if (!queue_empty(&(p_dtqcb->swait_queue))) {
331 p_tcb = (TCB *) queue_delete_next(&(p_dtqcb->swait_queue));
332 data = ((WINFO_SDTQ *)(p_tcb->p_winfo))->data;
333 enqueue_data(p_dtqcb, data);
334 wait_complete(p_tcb);
335 }
336 return(true);
337 }
338 else if (!queue_empty(&(p_dtqcb->swait_queue))) {
339 p_tcb = (TCB *) queue_delete_next(&(p_dtqcb->swait_queue));
340 *p_data = ((WINFO_SDTQ *)(p_tcb->p_winfo))->data;
341 wait_complete(p_tcb);
342 return(true);
343 }
344 else {
345 return(false);
346 }
347}
348
349#endif /* TOPPERS_dtqrcv */
350
351/*
352 * データキューの生成
353 */
354#ifdef TOPPERS_acre_dtq
355
356ER_UINT
357acre_dtq(const T_CDTQ *pk_cdtq)
358{
359 DTQCB *p_dtqcb;
360 DTQINIB *p_dtqinib;
361 ATR dtqatr;
362 uint_t dtqcnt;
363 DTQMB *p_dtqmb;
364 ER ercd;
365
366 LOG_ACRE_DTQ_ENTER(pk_cdtq);
367 CHECK_TSKCTX_UNL();
368
369 dtqatr = pk_cdtq->dtqatr;
370 dtqcnt = pk_cdtq->dtqcnt;
371 p_dtqmb = pk_cdtq->dtqmb;
372
373 CHECK_RSATR(dtqatr, TA_TPRI);
374
375 lock_cpu();
376 if (tnum_dtq == 0 || queue_empty(&free_dtqcb)) {
377 ercd = E_NOID;
378 }
379 else {
380 if (dtqcnt != 0 && p_dtqmb == NULL) {
381 p_dtqmb = kernel_malloc(sizeof(DTQMB) * dtqcnt);
382 dtqatr |= TA_MBALLOC;
383 }
384 if (dtqcnt != 0 && p_dtqmb == NULL) {
385 ercd = E_NOMEM;
386 }
387 else {
388 p_dtqcb = ((DTQCB *) queue_delete_next(&free_dtqcb));
389 p_dtqinib = (DTQINIB *)(p_dtqcb->p_dtqinib);
390 p_dtqinib->dtqatr = dtqatr;
391 p_dtqinib->dtqcnt = dtqcnt;
392 p_dtqinib->p_dtqmb = p_dtqmb;
393
394 queue_initialize(&(p_dtqcb->swait_queue));
395 queue_initialize(&(p_dtqcb->rwait_queue));
396 p_dtqcb->count = 0U;
397 p_dtqcb->head = 0U;
398 p_dtqcb->tail = 0U;
399 ercd = DTQID(p_dtqcb);
400 }
401 }
402 unlock_cpu();
403
404 error_exit:
405 LOG_ACRE_DTQ_LEAVE(ercd);
406 return(ercd);
407}
408
409#endif /* TOPPERS_acre_dtq */
410
411/*
412 * データキューの削除
413 */
414#ifdef TOPPERS_del_dtq
415
416ER
417del_dtq(ID dtqid)
418{
419 DTQCB *p_dtqcb;
420 DTQINIB *p_dtqinib;
421 ER ercd;
422
423 LOG_DEL_DTQ_ENTER(dtqid);
424 CHECK_TSKCTX_UNL();
425 CHECK_PAR(VALID_DTQID(dtqid));
426 p_dtqcb = get_dtqcb(dtqid);
427
428 lock_cpu();
429 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
430 ercd = E_NOEXS;
431 }
432 else if (dtqid <= tmax_sdtqid) {
433 ercd = E_OBJ;
434 }
435 else {
436 init_wait_queue(&(p_dtqcb->swait_queue));
437 init_wait_queue(&(p_dtqcb->rwait_queue));
438 p_dtqinib = (DTQINIB *)(p_dtqcb->p_dtqinib);
439 if ((p_dtqinib->dtqatr & TA_MBALLOC) != 0U) {
440 kernel_free(p_dtqinib->p_dtqmb);
441 }
442 p_dtqinib->dtqatr = TA_NOEXS;
443 queue_insert_prev(&free_dtqcb, &(p_dtqcb->swait_queue));
444 if (p_runtsk != p_schedtsk) {
445 dispatch();
446 }
447 ercd = E_OK;
448 }
449 unlock_cpu();
450
451 error_exit:
452 LOG_DEL_DTQ_LEAVE(ercd);
453 return(ercd);
454}
455
456#endif /* TOPPERS_del_dtq */
457
458/*
459 * データキューへの送信
460 */
461#ifdef TOPPERS_snd_dtq
462
463ER
464snd_dtq(ID dtqid, intptr_t data)
465{
466 DTQCB *p_dtqcb;
467 WINFO_SDTQ winfo_sdtq;
468 ER ercd;
469
470 LOG_SND_DTQ_ENTER(dtqid, data);
471 CHECK_DISPATCH();
472 CHECK_ID(VALID_DTQID(dtqid));
473 p_dtqcb = get_dtqcb(dtqid);
474
475 lock_cpu_dsp();
476 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
477 ercd = E_NOEXS;
478 }
479 else if (p_runtsk->raster) {
480 ercd = E_RASTER;
481 }
482 else if (send_data(p_dtqcb, data)) {
483 if (p_runtsk != p_schedtsk) {
484 dispatch();
485 }
486 ercd = E_OK;
487 }
488 else {
489 winfo_sdtq.data = data;
490 p_runtsk->tstat = TS_WAITING_SDTQ;
491 wobj_make_wait((WOBJCB *) p_dtqcb, (WINFO_WOBJ *) &winfo_sdtq);
492 dispatch();
493 ercd = winfo_sdtq.winfo.wercd;
494 }
495 unlock_cpu_dsp();
496
497 error_exit:
498 LOG_SND_DTQ_LEAVE(ercd);
499 return(ercd);
500}
501
502#endif /* TOPPERS_snd_dtq */
503
504/*
505 * データキューへの送信（ポーリング）
506 */
507#ifdef TOPPERS_psnd_dtq
508
509ER
510psnd_dtq(ID dtqid, intptr_t data)
511{
512 DTQCB *p_dtqcb;
513 ER ercd;
514
515 LOG_PSND_DTQ_ENTER(dtqid, data);
516 CHECK_UNL();
517 CHECK_ID(VALID_DTQID(dtqid));
518 p_dtqcb = get_dtqcb(dtqid);
519
520 lock_cpu();
521 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
522 ercd = E_NOEXS;
523 }
524 else if (send_data(p_dtqcb, data)) {
525 if (p_runtsk != p_schedtsk) {
526 if (!sense_context()) {
527 dispatch();
528 }
529 else {
530 request_dispatch();
531 }
532 }
533 ercd = E_OK;
534 }
535 else {
536 ercd = E_TMOUT;
537 }
538 unlock_cpu();
539
540 error_exit:
541 LOG_PSND_DTQ_LEAVE(ercd);
542 return(ercd);
543}
544
545#endif /* TOPPERS_psnd_dtq */
546
547/*
548 * データキューへの送信（タイムアウトあり）
549 */
550#ifdef TOPPERS_tsnd_dtq
551
552ER
553tsnd_dtq(ID dtqid, intptr_t data, TMO tmout)
554{
555 DTQCB *p_dtqcb;
556 WINFO_SDTQ winfo_sdtq;
557 TMEVTB tmevtb;
558 ER ercd;
559
560 LOG_TSND_DTQ_ENTER(dtqid, data, tmout);
561 CHECK_DISPATCH();
562 CHECK_ID(VALID_DTQID(dtqid));
563 CHECK_PAR(VALID_TMOUT(tmout));
564 p_dtqcb = get_dtqcb(dtqid);
565
566 lock_cpu_dsp();
567 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
568 ercd = E_NOEXS;
569 }
570 else if (p_runtsk->raster) {
571 ercd = E_RASTER;
572 }
573 else if (send_data(p_dtqcb, data)) {
574 if (p_runtsk != p_schedtsk) {
575 dispatch();
576 }
577 ercd = E_OK;
578 }
579 else if (tmout == TMO_POL) {
580 ercd = E_TMOUT;
581 }
582 else {
583 winfo_sdtq.data = data;
584 p_runtsk->tstat = TS_WAITING_SDTQ;
585 wobj_make_wait_tmout((WOBJCB *) p_dtqcb, (WINFO_WOBJ *) &winfo_sdtq,
586 &tmevtb, tmout);
587 dispatch();
588 ercd = winfo_sdtq.winfo.wercd;
589 }
590 unlock_cpu_dsp();
591
592 error_exit:
593 LOG_TSND_DTQ_LEAVE(ercd);
594 return(ercd);
595}
596
597#endif /* TOPPERS_tsnd_dtq */
598
599/*
600 * データキューへの強制送信
601 */
602#ifdef TOPPERS_fsnd_dtq
603
604ER
605fsnd_dtq(ID dtqid, intptr_t data)
606{
607 DTQCB *p_dtqcb;
608 ER ercd;
609
610 LOG_FSND_DTQ_ENTER(dtqid, data);
611 CHECK_UNL();
612 CHECK_ID(VALID_DTQID(dtqid));
613 p_dtqcb = get_dtqcb(dtqid);
614
615 lock_cpu();
616 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
617 ercd = E_NOEXS;
618 }
619 else if (!(p_dtqcb->p_dtqinib->dtqcnt > 0U)) {
620 ercd = E_ILUSE;
621 }
622 else {
623 force_send_data(p_dtqcb, data);
624 if (p_runtsk != p_schedtsk) {
625 if (!sense_context()) {
626 dispatch();
627 }
628 else {
629 request_dispatch();
630 }
631 }
632 ercd = E_OK;
633 }
634 unlock_cpu();
635
636 error_exit:
637 LOG_FSND_DTQ_LEAVE(ercd);
638 return(ercd);
639}
640
641#endif /* TOPPERS_fsnd_dtq */
642
643/*
644 * データキューからの受信
645 */
646#ifdef TOPPERS_rcv_dtq
647
648ER
649rcv_dtq(ID dtqid, intptr_t *p_data)
650{
651 DTQCB *p_dtqcb;
652 WINFO_RDTQ winfo_rdtq;
653 ER ercd;
654
655 LOG_RCV_DTQ_ENTER(dtqid, p_data);
656 CHECK_DISPATCH();
657 CHECK_ID(VALID_DTQID(dtqid));
658 p_dtqcb = get_dtqcb(dtqid);
659
660 lock_cpu_dsp();
661 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
662 ercd = E_NOEXS;
663 }
664 else if (p_runtsk->raster) {
665 ercd = E_RASTER;
666 }
667 else if (receive_data(p_dtqcb, p_data)) {
668 if (p_runtsk != p_schedtsk) {
669 dispatch();
670 }
671 ercd = E_OK;
672 }
673 else {
674 p_runtsk->tstat = TS_WAITING_RDTQ;
675 make_wait(&(winfo_rdtq.winfo));
676 queue_insert_prev(&(p_dtqcb->rwait_queue), &(p_runtsk->task_queue));
677 winfo_rdtq.p_dtqcb = p_dtqcb;
678 LOG_TSKSTAT(p_runtsk);
679 dispatch();
680 ercd = winfo_rdtq.winfo.wercd;
681 if (ercd == E_OK) {
682 *p_data = winfo_rdtq.data;
683 }
684 }
685 unlock_cpu_dsp();
686
687 error_exit:
688 LOG_RCV_DTQ_LEAVE(ercd, p_data);
689 return(ercd);
690}
691
692#endif /* TOPPERS_rcv_dtq */
693
694/*
695 * データキューからの受信（ポーリング）
696 */
697#ifdef TOPPERS_prcv_dtq
698
699ER
700prcv_dtq(ID dtqid, intptr_t *p_data)
701{
702 DTQCB *p_dtqcb;
703 ER ercd;
704
705 LOG_PRCV_DTQ_ENTER(dtqid, p_data);
706 CHECK_TSKCTX_UNL();
707 CHECK_ID(VALID_DTQID(dtqid));
708 p_dtqcb = get_dtqcb(dtqid);
709
710 lock_cpu();
711 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
712 ercd = E_NOEXS;
713 }
714 else if (receive_data(p_dtqcb, p_data)) {
715 if (p_runtsk != p_schedtsk) {
716 dispatch();
717 }
718 ercd = E_OK;
719 }
720 else {
721 ercd = E_TMOUT;
722 }
723 unlock_cpu();
724
725 error_exit:
726 LOG_PRCV_DTQ_LEAVE(ercd, p_data);
727 return(ercd);
728}
729
730#endif /* TOPPERS_prcv_dtq */
731
732/*
733 * データキューからの受信（タイムアウトあり）
734 */
735#ifdef TOPPERS_trcv_dtq
736
737ER
738trcv_dtq(ID dtqid, intptr_t *p_data, TMO tmout)
739{
740 DTQCB *p_dtqcb;
741 WINFO_RDTQ winfo_rdtq;
742 TMEVTB tmevtb;
743 ER ercd;
744
745 LOG_TRCV_DTQ_ENTER(dtqid, p_data, tmout);
746 CHECK_DISPATCH();
747 CHECK_ID(VALID_DTQID(dtqid));
748 CHECK_PAR(VALID_TMOUT(tmout));
749 p_dtqcb = get_dtqcb(dtqid);
750
751 lock_cpu_dsp();
752 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
753 ercd = E_NOEXS;
754 }
755 else if (p_runtsk->raster) {
756 ercd = E_RASTER;
757 }
758 else if (receive_data(p_dtqcb, p_data)) {
759 if (p_runtsk != p_schedtsk) {
760 dispatch();
761 }
762 ercd = E_OK;
763 }
764 else if (tmout == TMO_POL) {
765 ercd = E_TMOUT;
766 }
767 else {
768 p_runtsk->tstat = TS_WAITING_RDTQ;
769 make_wait_tmout(&(winfo_rdtq.winfo), &tmevtb, tmout);
770 queue_insert_prev(&(p_dtqcb->rwait_queue), &(p_runtsk->task_queue));
771 winfo_rdtq.p_dtqcb = p_dtqcb;
772 LOG_TSKSTAT(p_runtsk);
773 dispatch();
774 ercd = winfo_rdtq.winfo.wercd;
775 if (ercd == E_OK) {
776 *p_data = winfo_rdtq.data;
777 }
778 }
779 unlock_cpu_dsp();
780
781 error_exit:
782 LOG_TRCV_DTQ_LEAVE(ercd, p_data);
783 return(ercd);
784}
785
786#endif /* TOPPERS_trcv_dtq */
787
788/*
789 * データキューの再初期化
790 */
791#ifdef TOPPERS_ini_dtq
792
793ER
794ini_dtq(ID dtqid)
795{
796 DTQCB *p_dtqcb;
797 ER ercd;
798
799 LOG_INI_DTQ_ENTER(dtqid);
800 CHECK_TSKCTX_UNL();
801 CHECK_ID(VALID_DTQID(dtqid));
802 p_dtqcb = get_dtqcb(dtqid);
803
804 lock_cpu();
805 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
806 ercd = E_NOEXS;
807 }
808 else {
809 init_wait_queue(&(p_dtqcb->swait_queue));
810 init_wait_queue(&(p_dtqcb->rwait_queue));
811 p_dtqcb->count = 0U;
812 p_dtqcb->head = 0U;
813 p_dtqcb->tail = 0U;
814 if (p_runtsk != p_schedtsk) {
815 dispatch();
816 }
817 ercd = E_OK;
818 }
819 unlock_cpu();
820
821 error_exit:
822 LOG_INI_DTQ_LEAVE(ercd);
823 return(ercd);
824}
825
826#endif /* TOPPERS_ini_dtq */
827
828/*
829 * データキューの状æ…
830‹å‚ç…
831§
832 */
833#ifdef TOPPERS_ref_dtq
834
835ER
836ref_dtq(ID dtqid, T_RDTQ *pk_rdtq)
837{
838 DTQCB *p_dtqcb;
839 ER ercd;
840
841 LOG_REF_DTQ_ENTER(dtqid, pk_rdtq);
842 CHECK_TSKCTX_UNL();
843 CHECK_ID(VALID_DTQID(dtqid));
844 p_dtqcb = get_dtqcb(dtqid);
845
846 lock_cpu();
847 if (p_dtqcb->p_dtqinib->dtqatr == TA_NOEXS) {
848 ercd = E_NOEXS;
849 }
850 else {
851 pk_rdtq->stskid = wait_tskid(&(p_dtqcb->swait_queue));
852 pk_rdtq->rtskid = wait_tskid(&(p_dtqcb->rwait_queue));
853 pk_rdtq->sdtqcnt = p_dtqcb->count;
854 ercd = E_OK;
855 }
856 unlock_cpu();
857
858 error_exit:
859 LOG_REF_DTQ_LEAVE(ercd, pk_rdtq);
860 return(ercd);
861}
862
863#endif /* TOPPERS_ref_dtq */
Note: See TracBrowser for help on using the repository browser.