forked from ev3rt-git/ev3rt-hrp2
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathlogtask.c
More file actions
208 lines (194 loc) · 6.17 KB
/
logtask.c
File metadata and controls
208 lines (194 loc) · 6.17 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
/*
* TOPPERS/HRP Kernel
* Toyohashi Open Platform for Embedded Real-Time Systems/
* High Reliable system Profile Kernel
*
* Copyright (C) 2000-2003 by Embedded and Real-Time Systems Laboratory
* Toyohashi Univ. of Technology, JAPAN
* Copyright (C) 2005-2014 by Embedded and Real-Time Systems Laboratory
* Graduate School of Information Science, Nagoya Univ., JAPAN
*
* 上記著作権者は,以下の(1)〜(4)の条件を満たす場合に限り,本ソフトウェ
* ア(本ソフトウェアを改変したものを含む.以下同じ)を使用・複製・改
* 変・再配布(以下,利用と呼ぶ)することを無償で許諾する.
* (1) 本ソフトウェアをソースコードの形で利用する場合には,上記の著作
* 権表示,この利用条件および下記の無保証規定が,そのままの形でソー
* スコード中に含まれていること.
* (2) 本ソフトウェアを,ライブラリ形式など,他のソフトウェア開発に使
* 用できる形で再配布する場合には,再配布に伴うドキュメント(利用
* 者マニュアルなど)に,上記の著作権表示,この利用条件および下記
* の無保証規定を掲載すること.
* (3) 本ソフトウェアを,機器に組み込むなど,他のソフトウェア開発に使
* 用できない形で再配布する場合には,次のいずれかの条件を満たすこ
* と.
* (a) 再配布に伴うドキュメント(利用者マニュアルなど)に,上記の著
* 作権表示,この利用条件および下記の無保証規定を掲載すること.
* (b) 再配布の形態を,別に定める方法によって,TOPPERSプロジェクトに
* 報告すること.
* (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
* 害からも,上記著作権者およびTOPPERSプロジェクトを免責すること.
* また,本ソフトウェアのユーザまたはエンドユーザからのいかなる理
* 由に基づく請求からも,上記著作権者およびTOPPERSプロジェクトを
* 免責すること.
*
* 本ソフトウェアは,無保証で提供されているものである.上記著作権者お
* よびTOPPERSプロジェクトは,本ソフトウェアに関して,特定の使用目的
* に対する適合性も含めて,いかなる保証も行わない.また,本ソフトウェ
* アの利用により直接的または間接的に生じたいかなる損害に関しても,そ
* の責任を負わない.
*
* $Id: logtask.c 968 2014-01-12 08:56:26Z ertl-hiro $
*/
/*
* システムログタスク
*/
#include <kernel.h>
#include <t_syslog.h>
#include <log_output.h>
#include "syssvc/serial.h"
#include "syssvc/syslog.h"
#include "logtask.h"
/*
* システムログタスクの出力先のポートID
*/
static ID logtask_portid;
/*
* シリアルインタフェースへの1文字出力
*/
static void
logtask_putc(char c)
{
(void) serial_wri_dat(logtask_portid, &c, 1);
}
/*
* システムログ出力の待ち合わせ
*/
ER
_logtask_flush(uint_t count, ID cdmid)
{
T_SYSLOG_RLOG rlog;
T_SERIAL_RPOR rpor;
ER ercd, rercd;
if (sns_dpn()) {
ercd = E_CTX;
}
else {
for (;;) {
if (syslog_ref_log(&rlog) < 0) {
ercd = E_SYS;
goto error_exit;
}
if (rlog.count <= count) {
if (count == 0U) {
/*
* countが0の場合には,シリアルバッファが空かを確
* 認する.
*/
if (serial_ref_por(logtask_portid, &rpor) < 0) {
ercd = E_SYS;
goto error_exit;
}
if (rpor.wricnt == 0U) {
ercd = E_OK;
goto error_exit;
}
}
else {
ercd = E_OK;
goto error_exit;
}
}
/*
* LOGTASK_FLUSH_WAITミリ秒待つ.
*/
rercd = dly_tsk(LOGTASK_FLUSH_WAIT);
if (rercd < 0) {
ercd = (rercd == E_RLWAI) ? rercd : E_SYS;
goto error_exit;
}
}
}
error_exit:
return(ercd);
}
/*
* システムログタスクの本体
*/
void
logtask_main(intptr_t exinf)
{
SYSLOG logbuf;
uint_t lostlog;
ER_UINT rercd;
logtask_portid = (ID) exinf;
(void) serial_opn_por(logtask_portid);
(void) syslog_msk_log(LOG_UPTO(LOG_NOTICE), LOG_UPTO(LOG_EMERG));
syslog_1(LOG_NOTICE, "System logging task is started on port %d.",
logtask_portid);
for (;;) {
lostlog = 0U;
while ((rercd = syslog_rea_log(&logbuf)) >= 0) {
lostlog += (uint_t) rercd;
if (logbuf.logtype >= LOG_TYPE_COMMENT) {
if (lostlog > 0U) {
syslog_lostmsg(lostlog, logtask_putc);
lostlog = 0U;
}
syslog_print(&logbuf, logtask_putc);
logtask_putc('\n');
}
}
if (lostlog > 0U) {
syslog_lostmsg(lostlog, logtask_putc);
}
(void) dly_tsk(LOGTASK_INTERVAL);
}
}
/*
* システムログタスクの終了処理
*/
void
logtask_terminate(intptr_t exinf)
{
char c;
SYSLOG logbuf;
bool_t msgflg = false;
ER_UINT rercd;
/*
* シリアルインタフェースドライバの送信バッファに蓄積されたデータ
* を,低レベル出力機能を用いて出力する.
*/
while (serial_get_chr(logtask_portid, &c)) {
target_fput_log(c);
}
/*
* ログバッファに記録されたログ情報を,低レベル出力機能を用いて出
* 力する.
*/
while ((rercd = syslog_rea_log(&logbuf)) >= 0) {
if (!msgflg) {
/*
* ログバッファに残ったログ情報であることを示す文字列を出
* 力する.
*/
syslog_printf("-- buffered messages --\n", NULL, target_fput_log);
msgflg = true;
}
if (rercd > 0) {
syslog_lostmsg((uint_t) rercd, target_fput_log);
}
if (logbuf.logtype >= LOG_TYPE_COMMENT) {
syslog_print(&logbuf, target_fput_log);
target_fput_log('\n');
}
}
}
/*
* システムログタスクを拡張サービスコールとして登録するための定義
*/
ER_UINT
extsvc_logtask_flush(intptr_t count, intptr_t par2, intptr_t par3,
intptr_t par4, intptr_t par5, ID cdmid)
{
return((ER_UINT) _logtask_flush((uint_t) count, cdmid));
}