source: EcnlProtoTool/trunk/asp3_dcre/tinet/netapp/net_cons.c@ 270

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

mruby版ECNLプロトタイピング・ツールを追加
  • Property svn:eol-style set to native
  • Property svn:keywords set to Id
  • Property svn:mime-type set to text/x-csrc
File size: 14.0 KB
Line 
1/*
2 * TINET (TCP/IP Protocol Stack)
3 *
4 * Copyright (C) 2001-2009 by Dep. of Computer Science and Engineering
5 * Tomakomai National College of Technology, JAPAN
6 *
7 * 上記著作権者
8は，以下の (1)～(4) の条件か，Free Software Foundation
9 * によってå…
10¬è¡¨ã•ã‚Œã¦ã„ã‚‹ GNU General Public License の Version 2 に記
11 * 述されている条件を満たす場合に限り，本ソフトウェア（本ソフトウェア
12 * を改変したものを含む．以下同じ）を使用・複製・改変・再é…
13å¸ƒï¼ˆä»¥ä¸‹ï¼Œ
14 * 利用と呼ぶ）することを無償で許諾する．
15 * (1) 本ソフトウェアをソースコードの形で利用する場合には，上記の著作
16 * 権表示，この利用条件および下記の無保証規定が，そのままの形でソー
17 * スコード中に含まれていること．
18 * (2) 本ソフトウェアを，ライブラリ形式など，他のソフトウェア開発に使
19 * 用できる形で再é…
20å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œå†é…
21å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨
22 * 者
23マニュアルなど）に，上記の著作権表示，この利用条件および下記
24 * の無保証規定を掲載すること．
25 * (3) 本ソフトウェアを，機器に組み込むなど，他のソフトウェア開発に使
26 * 用できない形で再é…
27å¸ƒã™ã‚‹å ´åˆã«ã¯ï¼Œæ¬¡ã®æ¡ä»¶ã‚’満たすこと．
28 * (a) 再é…
29å¸ƒã«ä¼´ã†ãƒ‰ã‚­ãƒ¥ãƒ¡ãƒ³ãƒˆï¼ˆåˆ©ç”¨è€…
30マニュアルなど）に，上記の著
31 * 作権表示，この利用条件および下記の無保証規定を掲載すること．
32 * (4) 本ソフトウェアの利用により直接的または間接的に生じるいかなる損
33 * 害からも，上記著作権者
34およびTOPPERSプロジェクトをå…
35è²¬ã™ã‚‹ã“と．
36 *
37 * 本ソフトウェアは，無保証で提供されているものである．上記著作権者
38お
39 * よびTOPPERSプロジェクトは，本ソフトウェアに関して，その適用可能性も
40 * 含めて，いかなる保証も行わない．また，本ソフトウェアの利用により直
41 * 接的または間接的に生じたいかなる損害に関しても，その責任を負わない．
42 *
43 * @(#) $Id: net_cons.c 270 2017-02-09 04:03:47Z coas-nagasima $
44 */
45
46/*
47 * ネットワーク経由コンソールå…
48¥å‡ºåŠ›
49 */
50
51#include <stdarg.h>
52#include <string.h>
53
54#ifdef TARGET_KERNEL_ASP
55
56#include <kernel.h>
57#include <sil.h>
58#include <syssvc/serial.h>
59#include <syssvc/logtask.h>
60#include <t_syslog.h>
61#include "kernel_cfg.h"
62#include "tinet_cfg.h"
63
64#endif /* of #ifdef TARGET_KERNEL_ASP */
65
66#ifdef TARGET_KERNEL_JSP
67
68#include <s_services.h>
69#include <t_services.h>
70#include "kernel_id.h"
71#include "tinet_id.h"
72
73#endif /* of #ifdef TARGET_KERNEL_JSP */
74
75#include <tinet_defs.h>
76
77#include <net/if.h>
78#include <net/if_ppp.h>
79#include <net/if_loop.h>
80#include <net/ethernet.h>
81#include <net/net.h>
82#include <net/net_timer.h>
83
84#include <netinet/in.h>
85#include <netinet/in_itron.h>
86
87#include <netapp/netapp.h>
88#include <netapp/netapp_var.h>
89#include <netapp/net_cons.h>
90
91#ifdef USE_NET_CONS
92
93/*
94 * マクロ定義
95 */
96
97/* リネームの解除 */
98
99#undef syslog
100#undef serial_rea_dat
101#undef serial_ctl_por
102
103#define EOF (-1)
104
105/* TELNET オプション */
106
107#define TELNET_OPT_SE (240)
108#define TELNET_OPT_NOP (241)
109#define TELNET_OPT_DM (242)
110#define TELNET_OPT_BRK (243)
111#define TELNET_OPT_IP (244)
112#define TELNET_OPT_AO (245)
113#define TELNET_OPT_AYT (246)
114#define TELNET_OPT_EC (247)
115#define TELNET_OPT_EL (248)
116#define TELNET_OPT_GA (249)
117#define TELNET_OPT_SB (250)
118#define TELNET_OPT_WILL (251)
119#define TELNET_OPT_WONT (252)
120#define TELNET_OPT_DO (253)
121#define TELNET_OPT_DONT (254)
122#define TELNET_OPT_IAC (255)
123
124/*
125 * 変数
126 */
127
128/* TCP 送受信ウィンドバッファ */
129
130uint8_t net_cons_swbuf[NET_CONS_SWBUF_SIZE];
131uint8_t net_cons_rwbuf[NET_CONS_RWBUF_SIZE];
132
133bool_t connected = false; /* コネクションの状æ…
134‹ */
135bool_t wait_accept = false; /* 接続要求待
136ち中 */
137
138#if defined(SUPPORT_INET4)
139
140T_IPV4EP dst;
141
142#endif /* of #if defined(SUPPORT_INET4) */
143
144#if defined(SUPPORT_INET6)
145
146T_IPV6EP dst;
147
148#endif /* of #if defined(SUPPORT_INET6) */
149
150uint8_t *snd_buff = NULL;
151uint8_t *rcv_buff = NULL;
152uint_t snd_off = 0;
153uint_t rcv_off = 0;
154uint_t net_ioctl = IOCTL_NULL;
155ER_UINT snd_len = 0;
156ER_UINT rcv_len = 0;
157
158/*
159 * ノンブロッキングコールのコールバック関数
160 */
161
162ER
163callback_nblk_net_cons (ID cepid, FN fncd, void *p_parblk)
164{
165 ER error = E_OK;
166 SYSTIM now;
167
168 switch (fncd) {
169
170 case TFN_TCP_ACP_CEP:
171 get_tim(&now);
172 if (*(ER*)p_parblk == E_OK) {
173 syslog(LOG_NOTICE, "[NCS:%02u CBN] connected: %6lu, from: %s.%u",
174 cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
175 connected = true;
176 }
177 else
178 syslog(LOG_NOTICE, "[NCS:%02d CBN] error: %s", itron_strerror(*(ER*)p_parblk));
179 snd_len = snd_off = rcv_len = rcv_off = 0;
180 wait_accept = false;
181 break;
182
183 case TFN_TCP_CLS_CEP:
184 case TFN_TCP_RCV_BUF:
185 case TFN_TCP_GET_BUF:
186 case TFN_TCP_RCV_DAT:
187 case TFN_TCP_SND_DAT:
188 case TFN_TCP_CON_CEP:
189 case TFN_TCP_SND_OOB:
190 default:
191 error = E_PAR;
192 break;
193 }
194 return error;
195 }
196
197/*
198 * 送信バッファのフラッシュ
199 */
200
201void
202flush_snd_buff (void)
203{
204 ER_UINT error;
205
206 if (connected) {
207 syscall(wai_sem(SEM_NET_CONS_SEND));
208 if (snd_off > 0) {
209 if ((error = tcp_snd_buf(NET_CONS_CEPID, snd_off)) != E_OK && error != E_CLS)
210 syslog(LOG_NOTICE, "[NCS:%02d SND] flush send error: %s",
211 NET_CONS_CEPID, itron_strerror(error));
212 snd_len = snd_off = 0;
213 }
214 syscall(sig_sem(SEM_NET_CONS_SEND));
215 }
216 return;
217 }
218
219/*
220 * 文字送信
221 */
222
223void
224cons_putchar (ID portid, char ch)
225{
226 ER_UINT error;
227
228 if (connected) {
229 if (ch == '\n' && (net_ioctl & IOCTL_CRLF) != 0)
230 cons_putchar(portid, '\r');
231 syscall(wai_sem(SEM_NET_CONS_SEND));
232 if (snd_off >= snd_len) {
233 if ((error = tcp_snd_buf(NET_CONS_CEPID, snd_off)) != E_OK) {
234 if (error != E_CLS)
235 syslog(LOG_NOTICE, "[NCS:%02d SND] send buff error: %s",
236 NET_CONS_CEPID, itron_strerror(error));
237 syscall(sig_sem(SEM_NET_CONS_SEND));
238 return;
239 }
240 snd_off = 0;
241 if ((snd_len = tcp_get_buf(NET_CONS_CEPID, (void*)&snd_buff, TMO_FEVR)) <= 0) {
242 if (snd_len != E_CLS)
243 syslog(LOG_NOTICE, "[NCS:%02d SND] get buff error: %s",
244 NET_CONS_CEPID, itron_strerror(snd_len));
245 syscall(sig_sem(SEM_NET_CONS_SEND));
246 return;
247 }
248 }
249 snd_buff[snd_off ++] = ch;
250 syscall(sig_sem(SEM_NET_CONS_SEND));
251 }
252 else
253 serial_wri_dat(portid, &ch, sizeof(ch));
254 }
255
256/*
257 * 文字受信（変換なし）
258 */
259
260static int_t
261cons_getchar_raw (void)
262{
263 ER error = E_OK;
264
265 if (connected) {
266 if (rcv_off >= rcv_len) {
267 rcv_off = 0;
268 if ((error = tcp_rel_buf(NET_CONS_CEPID, rcv_len)) != E_OK) {
269 if (error != E_CLS)
270 syslog(LOG_NOTICE, "[NCS:%02d RCV] release buff error: %s",
271 NET_CONS_CEPID, itron_strerror(error));
272 discon_net_cons();
273 return EOF;
274 }
275 if ((rcv_len = tcp_rcv_buf(NET_CONS_CEPID, (void*)&rcv_buff, TMO_FEVR)) == 0) {
276 discon_net_cons();
277 return EOF;
278 }
279 else if (rcv_len < 0) {
280 if (rcv_len != E_CLS)
281 syslog(LOG_NOTICE, "[NCS:%02d RCV] recieve buff error: %s",
282 NET_CONS_CEPID, itron_strerror(rcv_len));
283 discon_net_cons();
284 return EOF;
285 }
286 }
287 return rcv_buff[rcv_off ++];
288 }
289 else
290 return EOF;
291 }
292
293/*
294 * 文字受信（TELNET オプションをスキップ）
295 */
296
297int_t
298cons_getchar (ID portid)
299{
300 T_SERIAL_RPOR rpor;
301 int_t ch, req;
302 char uch;
303 ER error;
304
305 if (!wait_accept && !connected) {
306 wait_accept = true;
307 error = TCP_ACP_CEP(NET_CONS_CEPID, NET_CONS_REPID, &dst, TMO_NBLK);
308#if 0
309 syslog(LOG_NOTICE, "[NCS:%02d ACP] status: %s",NET_CONS_CEPID, itron_strerror(error));
310#endif
311 if (error != E_WBLK)
312 return EOF;
313 }
314
315 while (true) {
316 if (connected) {
317 while ((ch = cons_getchar_raw()) == TELNET_OPT_IAC || ch == '\0') {
318 if (ch != '\0') {
319 switch (ch = cons_getchar_raw()) {
320 case TELNET_OPT_WILL:
321 case TELNET_OPT_WONT:
322 case TELNET_OPT_DO:
323 case TELNET_OPT_DONT:
324 req = cons_getchar_raw();
325 break;
326 case TELNET_OPT_SB:
327 while ((ch = cons_getchar_raw()) != EOF && ch != TELNET_OPT_IAC) {
328 if ((ch = cons_getchar_raw()) == EOF || ch == TELNET_OPT_SE)
329 break;
330 }
331 break;
332 default:
333 break;
334 }
335 }
336 }
337 if (ch != '\n') {
338 if ((net_ioctl & IOCTL_ECHO) != 0 && ch != EOF) {
339 cons_putchar(portid, ch);
340 flush_snd_buff();
341 }
342 return ch;
343 }
344 }
345
346 else if (serial_ref_por(portid, &rpor) == E_OK && rpor.reacnt > 0) {
347 if (serial_rea_dat(portid, &uch, sizeof(uch)) > 0)
348 return uch;
349 else
350 return EOF;
351 }
352 dly_tsk(100);
353 }
354 return EOF;
355 }
356
357/*
358 * コネクションを切断
359 */
360
361ER
362discon_net_cons (void)
363{
364 ER error = E_OK;
365 SYSTIM now;
366
367 if (connected) {
368 syscall(wai_sem(SEM_NET_CONS_SEND));
369 if (snd_off > 0) {
370 if ((error = tcp_snd_buf(NET_CONS_CEPID, snd_off)) != E_OK && error != E_CLS)
371 syslog(LOG_NOTICE, "[NCS:%02d SND] send buff error: %s",
372 NET_CONS_CEPID, itron_strerror(error));
373 }
374 if ((error = tcp_sht_cep(NET_CONS_CEPID)) != E_OK)
375 syslog(LOG_NOTICE, "[NCS:%02d SHT] shutdown error: %s",
376 NET_CONS_CEPID, itron_strerror(error));
377 if ((error = tcp_cls_cep(NET_CONS_CEPID, TMO_FEVR)) != E_OK)
378 syslog(LOG_NOTICE, "[NCS:%02d CLS] close error: %s",
379 NET_CONS_CEPID, itron_strerror(error));
380 connected = false;
381 syscall(sig_sem(SEM_NET_CONS_SEND));
382 get_tim(&now);
383 syslog(LOG_NOTICE, "[NCS:%02u SND] disconnected:%5lu, from: %s.%u",
384 NET_CONS_CEPID, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
385 }
386 return error;
387 }
388
389/*
390 * シリアルポートの制御
391 */
392
393ER
394net_serial_ctl_por (ID portid, uint_t ioctl)
395{
396 net_ioctl = ioctl;
397 return serial_ctl_por(portid, ioctl);
398 }
399
400/*
401 * ログ出力
402 */
403
404ER
405net_syslog (uint_t prio, const char *format, ...)
406{
407#if defined(SUPPORT_INET4)
408 T_IN4_ADDR *addr;
409#endif /* of #if defined(SUPPORT_INET4) */
410
411 ulong_t val;
412 SYSLOG log;
413 va_list ap;
414 char padchar, *str;
415 int_t ch, width, left, i;
416 bool_t longflag;
417
418 if (connected) {
419 syscall(wai_sem(SEM_NET_CONS_PRINTF));
420 va_start(ap, format);
421 while ((ch = *format ++) != '\0') {
422 if (ch != '%') { /* 書式指定以外 */
423 cons_putchar(CONSOLE_PORTID, (char)ch);
424 continue;
425 }
426
427 width = 0;
428 longflag = false;
429 padchar = ' ';
430
431 if (ch == '-') { /* 左詰め */
432 format ++;
433 left = -1;
434 }
435 else
436 left = 1;
437
438 if ((ch = *format ++) == '0') { /* 上位桁の 0 */
439 padchar = '0';
440 ch = *format ++;
441 }
442
443 while ('0' <= ch && ch <= '9') { /* 出力幅
444 */
445 width = width * 10 + ch - '0';
446 ch = *format ++;
447 }
448
449 while (ch == 'l') { /* long (long) の指定 */
450 longflag = true;
451 ch = *format ++;
452 }
453
454 switch (ch) {
455 case 'd':
456 val = longflag ? (ulong_t)va_arg(ap, long_t)
457 : (ulong_t)va_arg(ap, int_t);
458 if ((long_t)val >= 0)
459 cons_putnumber(CONSOLE_PORTID, val, 10, radhex, width * left, false, padchar);
460 else
461 cons_putnumber(CONSOLE_PORTID, -val, 10, radhex, width * left, true, padchar);
462 break;
463
464 case 'u':
465 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
466 : (ulong_t)va_arg(ap, uint_t);
467 cons_putnumber(CONSOLE_PORTID, val, 10, radhex, width * left, false, padchar);
468 break;
469
470 case 'x':
471 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
472 : (ulong_t)va_arg(ap, uint_t);
473 cons_putnumber(CONSOLE_PORTID, val, 16, radhex, width * left, false, padchar);
474 break;
475
476 case 'X':
477 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
478 : (ulong_t)va_arg(ap, uint_t);
479 cons_putnumber(CONSOLE_PORTID, val, 16, radHEX, width * left, false, padchar);
480 break;
481
482 case 'c':
483 ch = va_arg(ap, int_t);
484 cons_putchar(CONSOLE_PORTID, (char)ch);
485 break;
486
487 case 's':
488 str = va_arg(ap, char*);
489 while ((ch = *str ++) != '\0') {
490 cons_putchar(CONSOLE_PORTID, (char)ch);
491 width --;
492 }
493 while (width -- > 0)
494 cons_putchar(CONSOLE_PORTID, ' ');
495 break;
496
497 case 'I':
498
499#if defined(SUPPORT_INET4)
500
501 addr = va_arg(ap, T_IN4_ADDR*);
502 put_ipv4addr(CONSOLE_PORTID, addr, width);
503
504#endif /* of #if defined(SUPPORT_INET4) */
505
506#if defined(SUPPORT_INET6)
507
508 str = va_arg(ap, char*);
509 put_ipv6addr(CONSOLE_PORTID, (T_IN6_ADDR *)str, width);
510
511#endif /* of #if defined(SUPPORT_INET6) */
512
513 break;
514
515 case 'M':
516 str = va_arg(ap, char*);
517 put_macaddr(CONSOLE_PORTID, str, width);
518 break;
519
520 case '%':
521 cons_putchar(CONSOLE_PORTID, '%');
522 break;
523
524 case '0':
525 format --;
526 break;
527
528 default:
529 break;
530 }
531
532 }
533 va_end(ap);
534 cons_putchar(CONSOLE_PORTID, '\n');
535 flush_snd_buff();
536 syscall(sig_sem(SEM_NET_CONS_PRINTF));
537 return E_OK;
538 }
539 else {
540 log.logtype = LOG_TYPE_COMMENT;
541 log.loginfo[0] = (intptr_t)format;
542 i = 1;
543 va_start(ap, format);
544
545 while ((ch = *format++) != '\0' && i < TMAX_LOGINFO) {
546 if (ch != '%') {
547 continue;
548 }
549
550 longflag = false;
551
552 ch = *format++;
553 while ('0' <= ch && ch <= '9') {
554 ch = *format++;
555 }
556
557 while (ch == 'l') { /* long (long) の指定 */
558 longflag = true;
559 ch = *format ++;
560 }
561
562 switch (ch) {
563 case 'd':
564 log.loginfo[i++] = longflag
565 ? (intptr_t)va_arg(ap, long_t)
566 : (intptr_t)va_arg(ap, int_t);
567 break;
568 case 'u':
569 case 'x':
570 case 'X':
571 log.loginfo[i++] = longflag
572 ? (intptr_t)va_arg(ap, ulong_t)
573 : (intptr_t)va_arg(ap, uint_t);
574 break;
575 case 'p':
576 log.loginfo[i++] = (intptr_t)va_arg(ap, void *);
577 break;
578 case 'c':
579 log.loginfo[i++] = (intptr_t)va_arg(ap, int_t);
580 break;
581 case 's':
582 log.loginfo[i++] = (intptr_t)va_arg(ap, const char *);
583 break;
584 case '\0':
585 format--;
586 break;
587 default:
588 break;
589 }
590 }
591 va_end(ap);
592
593#ifdef TARGET_KERNEL_ASP
594
595 return(syslog_wri_log(prio, &log));
596
597#endif /* of #ifdef TARGET_KERNEL_ASP */
598
599#ifdef TARGET_KERNEL_JSP
600
601 return(vwri_log(prio, &log));
602
603#endif /* of #ifdef TARGET_KERNEL_JSP */
604
605 }
606 }
607
608#endif /* of #ifdef USE_NET_CONS */
Note: See TracBrowser for help on using the repository browser.