source: atk2-sc3-1.4.0-ntisr/kernel/ioc_manage.c

Last change on this file was 172, checked in by ertl-ishikawa, 8 years ago

ATK2-SC3 1.4.0 RH850依存部 非信頼C2ISR対応を追加
  • Property svn:executable set to *
File size: 11.6 KB
Line 
1/*
2 * TOPPERS ATK2
3 * Toyohashi Open Platform for Embedded Real-Time Systems
4 * Automotive Kernel Version 2
5 *
6 * Copyright (C) 2012-2015 by Center for Embedded Computing Systems
7 * Graduate School of Information Science, Nagoya Univ., JAPAN
8 * Copyright (C) 2012-2015 by FUJI SOFT INCORPORATED, JAPAN
9 * Copyright (C) 2012-2013 by Spansion LLC, USA
10 * Copyright (C) 2012-2015 by NEC Communication Systems, Ltd., JAPAN
11 * Copyright (C) 2012-2015 by Panasonic Advanced Technology Development Co., Ltd., JAPAN
12 * Copyright (C) 2012-2014 by Renesas Electronics Corporation, JAPAN
13 * Copyright (C) 2012-2015 by Sunny Giken Inc., JAPAN
14 * Copyright (C) 2012-2015 by TOSHIBA CORPORATION, JAPAN
15 * Copyright (C) 2012-2015 by Witz Corporation
16 * Copyright (C) 2014-2015 by AISIN COMCRUISE Co., Ltd., JAPAN
17 * Copyright (C) 2014-2015 by eSOL Co.,Ltd., JAPAN
18 * Copyright (C) 2014-2015 by SCSK Corporation, JAPAN
19 * Copyright (C) 2015 by SUZUKI MOTOR CORPORATION
20 *
21 * 上記著作権者
22は，以下の(1)〜(4)の条件を満たす場合に限り，本ソフトウェ
23 * ア（本ソフトウェアを改変したものを含む．以下同じ）を使用・複製・改
24 * 変・再é…
25å¸ƒï¼ˆä»¥ä¸‹ï¼Œåˆ©ç”¨ã¨å‘¼ã¶ï¼‰ã™ã‚‹ã“とを無償で許諾する．
26 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
27 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
28 * スコード中に含まれていること．
29 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
30 * 用できる形で再é…
31å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
32å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
33 * 者
34マニュアルなど）に，上記の著作権表示，この利用条件および下記
35 * の無保証規定を掲載すること．
36 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
37 * 用できない形で再é…
38å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®ã„ずれかの条件を満たすこ
39 * と．
40 * (a) 再é…
41å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
42マニュアルなど）に，上記の著
43 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
44 * (b) 再é…
45å¸ƒã®å½¢æ…
46‹ã‚’，別に定める方法によって，TOPPERSプロジェクトに
47 * 報告すること．
48 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
49 * 害からも，上記著作権者
50およびTOPPERSプロジェクトをå…
51è²¬ã™ã‚‹ã“と．
52 * また，本ソフトウェアのユーザまたはエンドユーザからのいかなる理
53 * 由に基づく請求からも，上記著作権者
54およびTOPPERSプロジェクトを
55 * å…
56è²¬ã™ã‚‹ã“と．
57 *
58 * 本ソフトウェアは，AUTOSAR（AUTomotive Open System ARchitecture）仕
59 * 様に基づいている．上記の許諾は，AUTOSARの知的財産権を許諾するもので
60 * はない．AUTOSARは，AUTOSAR仕様に基づいたソフトウェアを商用目的で利
61 * 用する者
62に対して，AUTOSARパートナーになることを求めている．
63 *
64 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
65お
66 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，特定の使用目的
67 * に対する適合性も含めて，いかなる保証も行わない．また，本ソフトウェ
68 * アの利用により直接的または間接的に生じたいかなる損害に関しても，そ
69 * の責任を負わない．
70 *
71 * $Id: ioc_manage.c 453 2015-12-10 08:31:20Z nces-hibino $
72 */
73
74/*
75 * IOCモジュール
76 */
77#include "ioc_impl.h"
78#include "check.h"
79
80/*
81 * トレースログマクロのデフォルト定義
82 */
83#ifndef LOG_IOCSEND_ENTER
84#define LOG_IOCSEND_ENTER(senderid)
85#endif /* LOG_IOCSEND_ENTER */
86
87#ifndef LOG_IOCSEND_LEAVE
88#define LOG_IOCSEND_LEAVE(ercd)
89#endif /* LOG_IOCSEND_LEAVE */
90
91#ifndef LOG_IOCWRITE_ENTER
92#define LOG_IOCWRITE_ENTER(senderid)
93#endif /* LOG_IOCWRITE_ENTER */
94
95#ifndef LOG_IOCWRITE_LEAVE
96#define LOG_IOCWRITE_LEAVE(ercd)
97#endif /* LOG_IOCWRITE_LEAVE */
98
99#ifndef LOG_IOCRECEIVE_ENTER
100#define LOG_IOCRECEIVE_ENTER(iocid)
101#endif /* LOG_IOCRECEIVE_ENTER */
102
103#ifndef LOG_IOCRECEIVE_LEAVE
104#define LOG_IOCRECEIVE_LEAVE(ercd)
105#endif /* LOG_IOCRECEIVE_LEAVE */
106
107#ifndef LOG_IOCREAD_ENTER
108#define LOG_IOCREAD_ENTER(iocid)
109#endif /* LOG_IOCREAD_ENTER */
110
111#ifndef LOG_IOCREAD_LEAVE
112#define LOG_IOCREAD_LEAVE(ercd)
113#endif /* LOG_IOCREAD_LEAVE */
114
115#ifndef LOG_IOCEMPTYQUEUE_ENTER
116#define LOG_IOCEMPTYQUEUE_ENTER(iocid)
117#endif /* LOG_IOCEMPTYQUEUE_ENTER */
118
119#ifndef LOG_IOCEMPTUQUEUE_LEAVE
120#define LOG_IOCEMPTUQUEUE_LEAVE(ercd)
121#endif /* LOG_IOCEMPTUQUEUE_LEAVE */
122
123
124/* 内
125部関数のプロトタイプ宣言 */
126LOCAL_INLINE void ioc_memcpy(void *p_dst, const void *p_src, uint32 sz);
127
128
129/*
130 * 初期化関数
131 */
132void
133ioc_initialize(void)
134{
135 IocType i;
136 IOCCB *p_ioccb;
137 const IOCINIB *p_iocinib;
138
139 /* キューの初期化 */
140 for (i = 0U; i < tnum_queueioc; i++) {
141 p_ioccb = &ioccb_table[i];
142 p_ioccb->quecnt = 0U;
143 p_ioccb->head = 0U;
144 p_ioccb->tail = 0U;
145 p_ioccb->lostflg = FALSE;
146 }
147
148 /* 各IOCのバッファ初期化 */
149 for (i = 0U; i < tnum_ioc; i++) {
150 if (ioc_inival_table[i] != NULL) {
151 p_iocinib = &iocinib_table[i];
152 ioc_memcpy((void *) (p_iocinib->p_iocmb), ioc_inival_table[i], p_iocinib->datasz);
153 }
154 }
155}
156
157
158
159LOCAL_INLINE void
160ioc_memcpy(void *p_dst, const void *p_src, uint32 sz)
161{
162 uint8 *p_tmp_dst = (uint8 *) p_dst;
163 const uint8 *p_tmp_src = (const uint8 *) p_src;
164 CounterType i;
165
166 for (i = 0U; i < sz; i++) {
167 p_tmp_dst[i] = p_tmp_src[i];
168 }
169}
170
171
172Std_ReturnType
173ioc_send_generic(IocType IocWrapperId, const void *in)
174{
175 const IOCWRPINIB *p_iocwrpinib;
176 const IOCINIB *p_iocinib;
177 IOCCB *p_ioccb;
178 Std_ReturnType ercd = IOC_E_OK;
179
180 p_iocwrpinib = get_iocwrpinib(IocWrapperId);
181 p_iocinib = get_iocinib(IOCID(p_iocwrpinib));
182 p_ioccb = get_ioccb(IOCID(p_iocwrpinib));
183
184 LOG_IOCSEND_ENTER(p_iocwrpinib->senderid);
185
186 CHECK_IOC_CALLEVEL_DISABLEDINT(CALLEVEL_IOCSEND);
187 CHECK_IOC_ACCESS(p_iocwrpinib->p_sndosapcb == p_runosap);
188 CHECK_IOC_MEM_READ((const MemoryStartAddressType) in, p_iocinib->datasz, p_iocinib->alignsz);
189
190 x_nested_lock_os_int();
191
192 S_D_CHECK_IOC_LIMIT(p_ioccb->quecnt < p_iocinib->maxque);
193 ioc_memcpy((void *) ((uint32) p_iocinib->p_iocmb + ((p_iocinib->datasz) * (p_ioccb->tail))), in, p_iocinib->datasz);
194 p_ioccb->quecnt++;
195 p_ioccb->tail++;
196 if (p_ioccb->tail >= p_iocinib->maxque) {
197 p_ioccb->tail = 0U;
198 }
199
200 d_exit_no_errorhook:
201 x_nested_unlock_os_int();
202 exit_no_errorhook:
203 LOG_IOCSEND_LEAVE(ercd);
204 return(ercd);
205
206#ifdef CFG_USE_ERRORHOOK
207 d_exit_errorhook:
208 goto errorhook_start;
209
210 exit_errorhook:
211 x_nested_lock_os_int();
212 errorhook_start:
213#ifdef CFG_USE_PARAMETERACCESS
214 _errorhook_par1.iocid = IOCID(p_iocwrpinib);
215 _errorhook_par2.senderid = p_iocwrpinib->senderid;
216#endif /* CFG_USE_PARAMETERACCESS */
217 if (p_iocinib->groupflg != FALSE) {
218 call_errorhook(ercd, IOCServiceId_IOC_SendGroup);
219 }
220 else {
221 call_errorhook(ercd, IOCServiceId_IOC_Send);
222 }
223 x_nested_unlock_os_int();
224 goto exit_no_errorhook;
225#endif /* CFG_USE_ERRORHOOK */
226}
227
228
229Std_ReturnType
230ioc_write_generic(IocType IocWrapperId, const void *in)
231{
232 const IOCWRPINIB *p_iocwrpinib;
233 const IOCINIB *p_iocinib;
234 Std_ReturnType ercd = IOC_E_OK;
235
236 p_iocwrpinib = get_iocwrpinib(IocWrapperId);
237 p_iocinib = get_iocinib(IOCID(p_iocwrpinib));
238
239 LOG_IOCWRITE_ENTER(p_iocwrpinib->senderid);
240
241 CHECK_IOC_CALLEVEL_DISABLEDINT(CALLEVEL_IOCWRITE);
242 CHECK_IOC_ACCESS(p_iocwrpinib->p_sndosapcb == p_runosap);
243 CHECK_IOC_MEM_READ((const MemoryStartAddressType) in, p_iocinib->datasz, p_iocinib->alignsz);
244
245 x_nested_lock_os_int();
246
247 ioc_memcpy((void *) (p_iocinib->p_iocmb), in, p_iocinib->datasz);
248
249 d_exit_no_errorhook:
250 x_nested_unlock_os_int();
251 exit_no_errorhook:
252 LOG_IOCWRITE_LEAVE(ercd);
253 return(ercd);
254
255#ifdef CFG_USE_ERRORHOOK
256 d_exit_errorhook:
257 goto errorhook_start;
258
259 exit_errorhook:
260 x_nested_lock_os_int();
261 errorhook_start:
262#ifdef CFG_USE_PARAMETERACCESS
263 _errorhook_par1.iocid = IOCID(p_iocwrpinib);
264 _errorhook_par2.senderid = p_iocwrpinib->senderid;
265#endif /* CFG_USE_PARAMETERACCESS */
266 if (p_iocinib->groupflg != FALSE) {
267 call_errorhook(ercd, IOCServiceId_IOC_WriteGroup);
268 }
269 else {
270 call_errorhook(ercd, IOCServiceId_IOC_Write);
271 }
272 x_nested_unlock_os_int();
273 goto exit_no_errorhook;
274#endif /* CFG_USE_ERRORHOOK */
275}
276
277
278Std_ReturnType
279ioc_receive_generic(IocType IocId, void *out)
280{
281 const IOCINIB *p_iocinib;
282 IOCCB *p_ioccb;
283 Std_ReturnType ercd = IOC_E_OK;
284
285 LOG_IOCRECEIVE_ENTER(IocId);
286
287 p_iocinib = get_iocinib(IocId);
288 p_ioccb = get_ioccb(IocId);
289
290 CHECK_IOC_CALLEVEL_DISABLEDINT(CALLEVEL_IOCRECEIVE);
291 CHECK_IOC_ACCESS(p_iocinib->p_rcvosapcb == p_runosap);
292 CHECK_IOC_MEM_WRITE(out, p_iocinib->datasz, p_iocinib->alignsz);
293
294 x_nested_lock_os_int();
295
296 S_D_CHECK_IOC_NO_DATA(p_ioccb->quecnt > 0U);
297 ioc_memcpy(out, (void *) ((uint32) p_iocinib->p_iocmb + ((p_iocinib->datasz) * (p_ioccb->head))), p_iocinib->datasz);
298
299 p_ioccb->quecnt--;
300 p_ioccb->head++;
301 if (p_ioccb->head >= p_iocinib->maxque) {
302 p_ioccb->head = 0U;
303 }
304
305 S_D_CHECK_IOC_LOST(p_ioccb->lostflg == FALSE);
306
307 d_exit_no_errorhook:
308 x_nested_unlock_os_int();
309 exit_no_errorhook:
310 LOG_IOCRECEIVE_LEAVE(ercd);
311 return(ercd);
312
313#ifdef CFG_USE_ERRORHOOK
314 d_exit_errorhook:
315 goto errorhook_start;
316
317 exit_errorhook:
318 x_nested_lock_os_int();
319 errorhook_start:
320#ifdef CFG_USE_PARAMETERACCESS
321 _errorhook_par1.iocid = IocId;
322#endif /* CFG_USE_PARAMETERACCESS */
323 if (p_iocinib->groupflg != FALSE) {
324 call_errorhook(ercd, IOCServiceId_IOC_ReceiveGroup);
325 }
326 else {
327 call_errorhook(ercd, IOCServiceId_IOC_Receive);
328 }
329 x_nested_unlock_os_int();
330 goto exit_no_errorhook;
331#endif /* CFG_USE_ERRORHOOK */
332}
333
334
335Std_ReturnType
336ioc_read_generic(IocType IocId, void *out)
337{
338 const IOCINIB *p_iocinib;
339 Std_ReturnType ercd = IOC_E_OK;
340
341 LOG_IOCREAD_ENTER(IocId);
342
343 p_iocinib = get_iocinib(IocId);
344
345 CHECK_IOC_CALLEVEL_DISABLEDINT(CALLEVEL_IOCREAD);
346 CHECK_IOC_ACCESS(p_iocinib->p_rcvosapcb == p_runosap);
347 CHECK_IOC_MEM_WRITE(out, p_iocinib->datasz, p_iocinib->alignsz);
348
349 x_nested_lock_os_int();
350
351 ioc_memcpy(out, (void *) (p_iocinib->p_iocmb), p_iocinib->datasz);
352
353 d_exit_no_errorhook:
354 x_nested_unlock_os_int();
355 exit_no_errorhook:
356 LOG_IOCREAD_LEAVE(ercd);
357 return(ercd);
358
359#ifdef CFG_USE_ERRORHOOK
360 d_exit_errorhook:
361 goto errorhook_start;
362
363 exit_errorhook:
364 x_nested_lock_os_int();
365 errorhook_start:
366#ifdef CFG_USE_PARAMETERACCESS
367 _errorhook_par1.iocid = IocId;
368#endif /* CFG_USE_PARAMETERACCESS */
369 if (p_iocinib->groupflg != FALSE) {
370 call_errorhook(ercd, IOCServiceId_IOC_ReadGroup);
371 }
372 else {
373 call_errorhook(ercd, IOCServiceId_IOC_Read);
374 }
375 x_nested_unlock_os_int();
376 goto exit_no_errorhook;
377#endif /* CFG_USE_ERRORHOOK */
378}
379
380
381Std_ReturnType
382ioc_empty_queue_generic(IocType IocId)
383{
384 IOCCB *p_ioccb;
385 const IOCINIB *p_iocinib;
386 Std_ReturnType ercd = IOC_E_OK;
387
388 p_ioccb = get_ioccb(IocId);
389 p_iocinib = get_iocinib(IocId);
390
391 CHECK_IOC_CALLEVEL_DISABLEDINT(CALLEVEL_IOCEMPTYQUEUE);
392 CHECK_IOC_ACCESS(p_iocinib->p_rcvosapcb == p_runosap);
393
394 x_nested_lock_os_int();
395
396 p_ioccb->quecnt = 0U;
397 p_ioccb->head = 0U;
398 p_ioccb->tail = 0U;
399 p_ioccb->lostflg = FALSE;
400
401 d_exit_no_errorhook:
402 x_nested_unlock_os_int();
403 exit_no_errorhook:
404 LOG_IOCREAD_LEAVE(ercd);
405 return(ercd);
406
407#ifdef CFG_USE_ERRORHOOK
408 d_exit_errorhook:
409 goto errorhook_start;
410
411 exit_errorhook:
412 x_nested_lock_os_int();
413 errorhook_start:
414#ifdef CFG_USE_PARAMETERACCESS
415 _errorhook_par1.iocid = IocId;
416#endif /* CFG_USE_PARAMETERACCESS */
417 call_errorhook(ercd, IOCServiceId_IOC_EmptyQueue);
418 x_nested_unlock_os_int();
419 goto exit_no_errorhook;
420#endif /* CFG_USE_ERRORHOOK */
421}
Note: See TracBrowser for help on using the repository browser.