source: asp3_wo_tecs/trunk/extension/dcre/kernel/mempfix.c@ 306

Last change on this file since 306 was 306, checked in by ertl-honda, 7 years ago

3.1.0を反映
File size: 13.8 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-2016 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: mempfix.c 717 2016-03-31 07:03:53Z ertl-hiro $
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 "mempfix.h"
67
68/*
69 * トレースログマクロのデフォルト定義
70 */
71#ifndef LOG_ACRE_MPF_ENTER
72#define LOG_ACRE_MPF_ENTER(pk_cmpf)
73#endif /* LOG_ACRE_MPF_ENTER */
74
75#ifndef LOG_ACRE_MPF_LEAVE
76#define LOG_ACRE_MPF_LEAVE(ercd)
77#endif /* LOG_ACRE_MPF_LEAVE */
78
79#ifndef LOG_DEL_MPF_ENTER
80#define LOG_DEL_MPF_ENTER(mpfid)
81#endif /* LOG_DEL_MPF_ENTER */
82
83#ifndef LOG_DEL_MPF_LEAVE
84#define LOG_DEL_MPF_LEAVE(ercd)
85#endif /* LOG_DEL_MPF_LEAVE */
86
87#ifndef LOG_GET_MPF_ENTER
88#define LOG_GET_MPF_ENTER(mpfid, p_blk)
89#endif /* LOG_GET_MPF_ENTER */
90
91#ifndef LOG_GET_MPF_LEAVE
92#define LOG_GET_MPF_LEAVE(ercd, p_blk)
93#endif /* LOG_GET_MPF_LEAVE */
94
95#ifndef LOG_PGET_MPF_ENTER
96#define LOG_PGET_MPF_ENTER(mpfid, p_blk)
97#endif /* LOG_PGET_MPF_ENTER */
98
99#ifndef LOG_PGET_MPF_LEAVE
100#define LOG_PGET_MPF_LEAVE(ercd, p_blk)
101#endif /* LOG_PGET_MPF_LEAVE */
102
103#ifndef LOG_TGET_MPF_ENTER
104#define LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout)
105#endif /* LOG_TGET_MPF_ENTER */
106
107#ifndef LOG_TGET_MPF_LEAVE
108#define LOG_TGET_MPF_LEAVE(ercd, p_blk)
109#endif /* LOG_TGET_MPF_LEAVE */
110
111#ifndef LOG_REL_MPF_ENTER
112#define LOG_REL_MPF_ENTER(mpfid, blk)
113#endif /* LOG_REL_MPF_ENTER */
114
115#ifndef LOG_REL_MPF_LEAVE
116#define LOG_REL_MPF_LEAVE(ercd)
117#endif /* LOG_REL_MPF_LEAVE */
118
119#ifndef LOG_INI_MPF_ENTER
120#define LOG_INI_MPF_ENTER(mpfid)
121#endif /* LOG_INI_MPF_ENTER */
122
123#ifndef LOG_INI_MPF_LEAVE
124#define LOG_INI_MPF_LEAVE(ercd)
125#endif /* LOG_INI_MPF_LEAVE */
126
127#ifndef LOG_REF_MPF_ENTER
128#define LOG_REF_MPF_ENTER(mpfid, pk_rmpf)
129#endif /* LOG_REF_MPF_ENTER */
130
131#ifndef LOG_REF_MPF_LEAVE
132#define LOG_REF_MPF_LEAVE(ercd, pk_rmpf)
133#endif /* LOG_REF_MPF_LEAVE */
134
135/*
136 * 固定長メモリプールの数
137 */
138#define tnum_mpf ((uint_t)(tmax_mpfid - TMIN_MPFID + 1))
139#define tnum_smpf ((uint_t)(tmax_smpfid - TMIN_MPFID + 1))
140
141/*
142 * 固定長メモリプールIDから固定長メモリプール管理ブロックを取り出すた
143 * めのマクロ
144 */
145#define INDEX_MPF(mpfid) ((uint_t)((mpfid) - TMIN_MPFID))
146#define get_mpfcb(mpfid) (&(mpfcb_table[INDEX_MPF(mpfid)]))
147
148/*
149 * 特殊なインデックス値の定義
150 */
151#define INDEX_NULL (~0U) /* 空きブロックリストの最後 */
152#define INDEX_ALLOC (~1U) /* 割当て済みのブロック */
153
154#ifdef TOPPERS_mpfini
155
156/*
157 * 使用していない固定長メモリプール管理ブロックのリスト
158 */
159QUEUE free_mpfcb;
160
161/*
162 * 固定長メモリプール機能の初期化
163 */
164void
165initialize_mempfix(void)
166{
167 uint_t i, j;
168 MPFCB *p_mpfcb;
169 MPFINIB *p_mpfinib;
170
171 for (i = 0; i < tnum_smpf; i++) {
172 p_mpfcb = &(mpfcb_table[i]);
173 queue_initialize(&(p_mpfcb->wait_queue));
174 p_mpfcb->p_mpfinib = &(mpfinib_table[i]);
175 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
176 p_mpfcb->unused = 0U;
177 p_mpfcb->freelist = INDEX_NULL;
178 }
179 queue_initialize(&free_mpfcb);
180 for (j = 0; i < tnum_mpf; i++, j++) {
181 p_mpfcb = &(mpfcb_table[i]);
182 p_mpfinib = &(ampfinib_table[j]);
183 p_mpfinib->mpfatr = TA_NOEXS;
184 p_mpfcb->p_mpfinib = ((const MPFINIB *) p_mpfinib);
185 queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
186 }
187}
188
189#endif /* TOPPERS_mpfini */
190
191/*
192 * 固定長メモリプールからブロックを獲得
193 */
194#ifdef TOPPERS_mpfget
195
196void
197get_mpf_block(MPFCB *p_mpfcb, void **p_blk)
198{
199 uint_t blkidx;
200
201 if (p_mpfcb->freelist != INDEX_NULL) {
202 blkidx = p_mpfcb->freelist;
203 p_mpfcb->freelist = (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next;
204 }
205 else {
206 blkidx = p_mpfcb->unused;
207 p_mpfcb->unused++;
208 }
209 *p_blk = (void *)((char *)(p_mpfcb->p_mpfinib->mpf)
210 + p_mpfcb->p_mpfinib->blksz * blkidx);
211 p_mpfcb->fblkcnt--;
212 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = INDEX_ALLOC;
213}
214
215#endif /* TOPPERS_mpfget */
216
217/*
218 * 固定長メモリプールの生成
219 */
220#ifdef TOPPERS_acre_mpf
221
222ER_UINT
223acre_mpf(const T_CMPF *pk_cmpf)
224{
225 MPFCB *p_mpfcb;
226 MPFINIB *p_mpfinib;
227 ATR mpfatr;
228 uint_t blkcnt;
229 uint_t blksz;
230 MPF_T *mpf;
231 MPFMB *p_mpfmb;
232 ER ercd;
233
234 LOG_ACRE_MPF_ENTER(pk_cmpf);
235 CHECK_TSKCTX_UNL();
236
237 mpfatr = pk_cmpf->mpfatr;
238 blkcnt = pk_cmpf->blkcnt;
239 blksz = pk_cmpf->blksz;
240 mpf = pk_cmpf->mpf;
241 p_mpfmb = pk_cmpf->mpfmb;
242
243 CHECK_RSATR(mpfatr, TA_TPRI);
244 CHECK_PAR(blkcnt != 0);
245 CHECK_PAR(blksz != 0);
246 if (mpf != NULL) {
247 CHECK_PAR(MPF_ALIGN(mpf));
248 }
249 if (p_mpfmb != NULL) {
250 CHECK_PAR(MB_ALIGN(p_mpfmb));
251 }
252
253 lock_cpu();
254 if (tnum_mpf == 0 || queue_empty(&free_mpfcb)) {
255 ercd = E_NOID;
256 }
257 else {
258 if (mpf == NULL) {
259 mpf = kernel_malloc(ROUND_MPF_T(blksz) * blkcnt);
260 mpfatr |= TA_MEMALLOC;
261 }
262 if (mpf == NULL) {
263 ercd = E_NOMEM;
264 }
265 else {
266 if (p_mpfmb == NULL) {
267 p_mpfmb = kernel_malloc(sizeof(MPFMB) * blkcnt);
268 mpfatr |= TA_MBALLOC;
269 }
270 if (p_mpfmb == NULL) {
271 if (mpf == NULL) {
272 kernel_free(mpf);
273 }
274 ercd = E_NOMEM;
275 }
276 else {
277 p_mpfcb = ((MPFCB *) queue_delete_next(&free_mpfcb));
278 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
279 p_mpfinib->mpfatr = mpfatr;
280 p_mpfinib->blkcnt = blkcnt;
281 p_mpfinib->blksz = ROUND_MPF_T(blksz);
282 p_mpfinib->mpf = mpf;
283 p_mpfinib->p_mpfmb = p_mpfmb;
284
285 queue_initialize(&(p_mpfcb->wait_queue));
286 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
287 p_mpfcb->unused = 0U;
288 p_mpfcb->freelist = INDEX_NULL;
289 ercd = MPFID(p_mpfcb);
290 }
291 }
292 }
293 unlock_cpu();
294
295 error_exit:
296 LOG_ACRE_MPF_LEAVE(ercd);
297 return(ercd);
298}
299
300#endif /* TOPPERS_acre_mpf */
301
302/*
303 * 固定長メモリプールの削除
304 */
305#ifdef TOPPERS_del_mpf
306
307ER
308del_mpf(ID mpfid)
309{
310 MPFCB *p_mpfcb;
311 MPFINIB *p_mpfinib;
312 ER ercd;
313
314 LOG_DEL_MPF_ENTER(mpfid);
315 CHECK_TSKCTX_UNL();
316 CHECK_ID(VALID_MPFID(mpfid));
317 p_mpfcb = get_mpfcb(mpfid);
318
319 lock_cpu();
320 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
321 ercd = E_NOEXS;
322 }
323 else if (mpfid <= tmax_smpfid) {
324 ercd = E_OBJ;
325 }
326 else {
327 init_wait_queue(&(p_mpfcb->wait_queue));
328 p_mpfinib = (MPFINIB *)(p_mpfcb->p_mpfinib);
329 if ((p_mpfinib->mpfatr & TA_MEMALLOC) != 0U) {
330 kernel_free(p_mpfinib->mpf);
331 }
332 if ((p_mpfinib->mpfatr & TA_MBALLOC) != 0U) {
333 kernel_free(p_mpfinib->p_mpfmb);
334 }
335 p_mpfinib->mpfatr = TA_NOEXS;
336 queue_insert_prev(&free_mpfcb, &(p_mpfcb->wait_queue));
337 if (p_runtsk != p_schedtsk) {
338 dispatch();
339 }
340 ercd = E_OK;
341 }
342 unlock_cpu();
343
344 error_exit:
345 LOG_DEL_MPF_LEAVE(ercd);
346 return(ercd);
347}
348
349#endif /* TOPPERS_del_mpf */
350
351/*
352 * 固定長メモリブロックの獲得
353 */
354#ifdef TOPPERS_get_mpf
355
356ER
357get_mpf(ID mpfid, void **p_blk)
358{
359 MPFCB *p_mpfcb;
360 WINFO_MPF winfo_mpf;
361 ER ercd;
362
363 LOG_GET_MPF_ENTER(mpfid, p_blk);
364 CHECK_DISPATCH();
365 CHECK_ID(VALID_MPFID(mpfid));
366 p_mpfcb = get_mpfcb(mpfid);
367
368 lock_cpu_dsp();
369 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
370 ercd = E_NOEXS;
371 }
372 else if (p_runtsk->raster) {
373 ercd = E_RASTER;
374 }
375 else if (p_mpfcb->fblkcnt > 0) {
376 get_mpf_block(p_mpfcb, p_blk);
377 ercd = E_OK;
378 }
379 else {
380 p_runtsk->tstat = TS_WAITING_MPF;
381 wobj_make_wait((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf);
382 dispatch();
383 ercd = winfo_mpf.winfo.wercd;
384 if (ercd == E_OK) {
385 *p_blk = winfo_mpf.blk;
386 }
387 }
388 unlock_cpu_dsp();
389
390 error_exit:
391 LOG_GET_MPF_LEAVE(ercd, p_blk);
392 return(ercd);
393}
394
395#endif /* TOPPERS_get_mpf */
396
397/*
398 * 固定長メモリブロックの獲得（ポーリング）
399 */
400#ifdef TOPPERS_pget_mpf
401
402ER
403pget_mpf(ID mpfid, void **p_blk)
404{
405 MPFCB *p_mpfcb;
406 ER ercd;
407
408 LOG_PGET_MPF_ENTER(mpfid, p_blk);
409 CHECK_TSKCTX_UNL();
410 CHECK_ID(VALID_MPFID(mpfid));
411 p_mpfcb = get_mpfcb(mpfid);
412
413 lock_cpu();
414 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
415 ercd = E_NOEXS;
416 }
417 else if (p_mpfcb->fblkcnt > 0) {
418 get_mpf_block(p_mpfcb, p_blk);
419 ercd = E_OK;
420 }
421 else {
422 ercd = E_TMOUT;
423 }
424 unlock_cpu();
425
426 error_exit:
427 LOG_PGET_MPF_LEAVE(ercd, p_blk);
428 return(ercd);
429}
430
431#endif /* TOPPERS_pget_mpf */
432
433/*
434 * 固定長メモリブロックの獲得（タイムアウトあり）
435 */
436#ifdef TOPPERS_tget_mpf
437
438ER
439tget_mpf(ID mpfid, void **p_blk, TMO tmout)
440{
441 MPFCB *p_mpfcb;
442 WINFO_MPF winfo_mpf;
443 TMEVTB tmevtb;
444 ER ercd;
445
446 LOG_TGET_MPF_ENTER(mpfid, p_blk, tmout);
447 CHECK_DISPATCH();
448 CHECK_ID(VALID_MPFID(mpfid));
449 CHECK_PAR(VALID_TMOUT(tmout));
450 p_mpfcb = get_mpfcb(mpfid);
451
452 lock_cpu_dsp();
453 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
454 ercd = E_NOEXS;
455 }
456 else if (p_runtsk->raster) {
457 ercd = E_RASTER;
458 }
459 else if (p_mpfcb->fblkcnt > 0) {
460 get_mpf_block(p_mpfcb, p_blk);
461 ercd = E_OK;
462 }
463 else if (tmout == TMO_POL) {
464 ercd = E_TMOUT;
465 }
466 else {
467 p_runtsk->tstat = TS_WAITING_MPF;
468 wobj_make_wait_tmout((WOBJCB *) p_mpfcb, (WINFO_WOBJ *) &winfo_mpf,
469 &tmevtb, tmout);
470 dispatch();
471 ercd = winfo_mpf.winfo.wercd;
472 if (ercd == E_OK) {
473 *p_blk = winfo_mpf.blk;
474 }
475 }
476 unlock_cpu_dsp();
477
478 error_exit:
479 LOG_TGET_MPF_LEAVE(ercd, p_blk);
480 return(ercd);
481}
482
483#endif /* TOPPERS_tget_mpf */
484
485/*
486 * 固定長メモリブロックの返却
487 */
488#ifdef TOPPERS_rel_mpf
489
490ER
491rel_mpf(ID mpfid, void *blk)
492{
493 MPFCB *p_mpfcb;
494 size_t blkoffset;
495 uint_t blkidx;
496 TCB *p_tcb;
497 ER ercd;
498
499 LOG_REL_MPF_ENTER(mpfid, blk);
500 CHECK_TSKCTX_UNL();
501 CHECK_ID(VALID_MPFID(mpfid));
502 p_mpfcb = get_mpfcb(mpfid);
503
504 lock_cpu();
505 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
506 ercd = E_NOEXS;
507 }
508 else {
509 blkoffset = ((char *) blk) - (char *)(p_mpfcb->p_mpfinib->mpf);
510 blkidx = (uint_t)(blkoffset / p_mpfcb->p_mpfinib->blksz);
511 if (!(p_mpfcb->p_mpfinib->mpf <= blk)
512 || !(blkoffset % p_mpfcb->p_mpfinib->blksz == 0U)
513 || !(blkoffset / p_mpfcb->p_mpfinib->blksz < p_mpfcb->unused)
514 || !((p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next
515 == INDEX_ALLOC)) {
516 ercd = E_PAR;
517 }
518 else if (!queue_empty(&(p_mpfcb->wait_queue))) {
519 p_tcb = (TCB *) queue_delete_next(&(p_mpfcb->wait_queue));
520 ((WINFO_MPF *)(p_tcb->p_winfo))->blk = blk;
521 wait_complete(p_tcb);
522 if (p_runtsk != p_schedtsk) {
523 dispatch();
524 }
525 ercd = E_OK;
526 }
527 else {
528 p_mpfcb->fblkcnt++;
529 (p_mpfcb->p_mpfinib->p_mpfmb + blkidx)->next = p_mpfcb->freelist;
530 p_mpfcb->freelist = blkidx;
531 ercd = E_OK;
532 }
533 }
534 unlock_cpu();
535
536 error_exit:
537 LOG_REL_MPF_LEAVE(ercd);
538 return(ercd);
539}
540
541#endif /* TOPPERS_rel_mpf */
542
543/*
544 * 固定長メモリプールの再初期化
545 */
546#ifdef TOPPERS_ini_mpf
547
548ER
549ini_mpf(ID mpfid)
550{
551 MPFCB *p_mpfcb;
552 ER ercd;
553
554 LOG_INI_MPF_ENTER(mpfid);
555 CHECK_TSKCTX_UNL();
556 CHECK_ID(VALID_MPFID(mpfid));
557 p_mpfcb = get_mpfcb(mpfid);
558
559 lock_cpu();
560 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
561 ercd = E_NOEXS;
562 }
563 else {
564 init_wait_queue(&(p_mpfcb->wait_queue));
565 p_mpfcb->fblkcnt = p_mpfcb->p_mpfinib->blkcnt;
566 p_mpfcb->unused = 0U;
567 p_mpfcb->freelist = INDEX_NULL;
568 if (p_runtsk != p_schedtsk) {
569 dispatch();
570 }
571 ercd = E_OK;
572 }
573 unlock_cpu();
574
575 error_exit:
576 LOG_INI_MPF_LEAVE(ercd);
577 return(ercd);
578}
579
580#endif /* TOPPERS_ini_mpf */
581
582/*
583 * 固定長メモリプールの状æ…
584‹å‚ç…
585§
586 */
587#ifdef TOPPERS_ref_mpf
588
589ER
590ref_mpf(ID mpfid, T_RMPF *pk_rmpf)
591{
592 MPFCB *p_mpfcb;
593 ER ercd;
594
595 LOG_REF_MPF_ENTER(mpfid, pk_rmpf);
596 CHECK_TSKCTX_UNL();
597 CHECK_ID(VALID_MPFID(mpfid));
598 p_mpfcb = get_mpfcb(mpfid);
599
600 lock_cpu();
601 if (p_mpfcb->p_mpfinib->mpfatr == TA_NOEXS) {
602 ercd = E_NOEXS;
603 }
604 else {
605 pk_rmpf->wtskid = wait_tskid(&(p_mpfcb->wait_queue));
606 pk_rmpf->fblkcnt = p_mpfcb->fblkcnt;
607 ercd = E_OK;
608 }
609 unlock_cpu();
610
611 error_exit:
612 LOG_REF_MPF_LEAVE(ercd, pk_rmpf);
613 return(ercd);
614}
615
616#endif /* TOPPERS_ref_mpf */
Note: See TracBrowser for help on using the repository browser.