source: azure_iot_hub/trunk/asp3_dcre/tinet/netapp/net_cons.c@ 388

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

Azure IoT Hub Device C SDK を使ったサンプルの追加
  • 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.1 KB
Line 
1/*
2 * TINET (TCP/IP Protocol Stack)
3 *
4 * Copyright (C) 2001-2017 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 388 2019-05-22 11:25:18Z 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 <netinet/in.h>
76#include <netinet/in_itron.h>
77
78#include <netapp/netapp.h>
79#include <netapp/netapp_var.h>
80#include <netapp/net_cons.h>
81
82#ifdef USE_NET_CONS
83
84/*
85 * マクロ定義
86 */
87
88/* リネームの解除 */
89
90#undef syslog
91#undef serial_rea_dat
92#undef serial_ctl_por
93
94#define EOF (-1)
95
96/* TELNET オプション */
97
98#define TELNET_OPT_SE (240)
99#define TELNET_OPT_NOP (241)
100#define TELNET_OPT_DM (242)
101#define TELNET_OPT_BRK (243)
102#define TELNET_OPT_IP (244)
103#define TELNET_OPT_AO (245)
104#define TELNET_OPT_AYT (246)
105#define TELNET_OPT_EC (247)
106#define TELNET_OPT_EL (248)
107#define TELNET_OPT_GA (249)
108#define TELNET_OPT_SB (250)
109#define TELNET_OPT_WILL (251)
110#define TELNET_OPT_WONT (252)
111#define TELNET_OPT_DO (253)
112#define TELNET_OPT_DONT (254)
113#define TELNET_OPT_IAC (255)
114
115#if defined(SUPPORT_INET6)
116#define API_PROTO '6'
117#else
118#define API_PROTO '4'
119#endif
120
121/*
122 * 変数
123 */
124
125/* TCP 送受信ウィンドバッファ */
126
127uint8_t net_cons_swbuf[NET_CONS_SWBUF_SIZE];
128uint8_t net_cons_rwbuf[NET_CONS_RWBUF_SIZE];
129
130bool_t connected = false; /* コネクションの状æ…
131‹ */
132bool_t wait_accept = false; /* 接続要求待
133ち中 */
134
135#if defined(SUPPORT_INET6)
136
137T_IPV6EP dst;
138
139#else /* of #if defined(SUPPORT_INET6) */
140
141#if defined(SUPPORT_INET4)
142
143T_IPV4EP dst;
144
145#endif /* of #if defined(SUPPORT_INET4) */
146
147#endif /* of #if defined(SUPPORT_INET6) */
148
149uint8_t *snd_buff = NULL;
150uint8_t *rcv_buff = NULL;
151uint_t snd_off = 0;
152uint_t rcv_off = 0;
153uint_t net_ioctl = IOCTL_NULL;
154ER_UINT snd_len = 0;
155ER_UINT rcv_len = 0;
156
157/*
158 * ノンブロッキングコールのコールバック関数
159 */
160
161ER
162callback_nblk_net_cons (ID cepid, FN fncd, void *p_parblk)
163{
164 ER error = E_OK;
165 SYSTIM now;
166
167 switch (fncd) {
168
169 case TFN_TCP_ACP_CEP:
170 get_tim(&now);
171 if (*(ER*)p_parblk == E_OK) {
172 syslog(LOG_NOTICE, "[NCS%c:%02u CBN] conct: %7lu, from: %s.%u",
173 API_PROTO, cepid, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
174 connected = true;
175 }
176 else
177 syslog(LOG_NOTICE, "[NCS%c:%02d CBN] error: %s",
178 API_PROTO, 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%c:%02d SND] flush send error: %s",
211 API_PROTO, 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%c:%02d SND] send buff error: %s",
236 API_PROTO, 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%c:%02d SND] get buff error: %s",
244 API_PROTO, 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%c:%02d RCV] release buff error: %s",
271 API_PROTO, 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%c:%02d RCV] recieve buff error: %s",
282 API_PROTO, 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;
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%c:%02d ACP] status: %s",
310 API_PROTO, NET_CONS_CEPID, itron_strerror(error));
311#endif
312 if (error != E_WBLK)
313 return EOF;
314 }
315
316 while (true) {
317 if (connected) {
318 while ((ch = cons_getchar_raw()) == TELNET_OPT_IAC || ch == '\0') {
319 if (ch != '\0') {
320 switch (ch = cons_getchar_raw()) {
321 case TELNET_OPT_WILL:
322 case TELNET_OPT_WONT:
323 case TELNET_OPT_DO:
324 case TELNET_OPT_DONT:
325 cons_getchar_raw();
326 break;
327 case TELNET_OPT_SB:
328 while ((ch = cons_getchar_raw()) != EOF && ch != TELNET_OPT_IAC) {
329 if ((ch = cons_getchar_raw()) == EOF || ch == TELNET_OPT_SE)
330 break;
331 }
332 break;
333 default:
334 break;
335 }
336 }
337 }
338 if (ch != '\n') {
339 if ((net_ioctl & IOCTL_ECHO) != 0 && ch != EOF) {
340 cons_putchar(portid, ch);
341 flush_snd_buff();
342 }
343 return ch;
344 }
345 }
346
347 else if (serial_ref_por(portid, &rpor) == E_OK && rpor.reacnt > 0) {
348 if (serial_rea_dat(portid, &uch, sizeof(uch)) > 0)
349 return uch;
350 else
351 return EOF;
352 }
353 dly_tsk(100);
354 }
355 return EOF;
356 }
357
358/*
359 * コネクションを切断
360 */
361
362ER
363discon_net_cons (void)
364{
365 ER error = E_OK;
366 SYSTIM now;
367
368 if (connected) {
369 syscall(wai_sem(SEM_NET_CONS_SEND));
370 if (snd_off > 0) {
371 if ((error = tcp_snd_buf(NET_CONS_CEPID, snd_off)) != E_OK && error != E_CLS)
372 syslog(LOG_NOTICE, "[NCS%c:%02d SND] send buff error: %s",
373 API_PROTO, NET_CONS_CEPID, itron_strerror(error));
374 }
375 if ((error = tcp_sht_cep(NET_CONS_CEPID)) != E_OK)
376 syslog(LOG_NOTICE, "[NCS%c:%02d SHT] shutdown error: %s",
377 API_PROTO, NET_CONS_CEPID, itron_strerror(error));
378 if ((error = tcp_cls_cep(NET_CONS_CEPID, TMO_FEVR)) != E_OK)
379 syslog(LOG_NOTICE, "[NCS%c:%02d CLS] close error: %s",
380 API_PROTO, NET_CONS_CEPID, itron_strerror(error));
381 connected = false;
382 syscall(sig_sem(SEM_NET_CONS_SEND));
383 get_tim(&now);
384 syslog(LOG_NOTICE, "[NCS%c:%02u SND] discn: %7lu, from: %s.%u",
385 API_PROTO, NET_CONS_CEPID, now / SYSTIM_HZ, IP2STR(NULL, &dst.ipaddr), dst.portno);
386 }
387 return error;
388 }
389
390/*
391 * シリアルポートの制御
392 */
393
394ER
395net_serial_ctl_por (ID portid, uint_t ioctl)
396{
397 net_ioctl = ioctl;
398 return serial_ctl_por(portid, ioctl);
399 }
400
401/*
402 * ログ出力
403 */
404
405ER
406net_syslog (uint_t prio, const char *format, ...)
407{
408#if defined(SUPPORT_INET4)
409 T_IN4_ADDR *addr;
410#endif /* of #if defined(SUPPORT_INET4) */
411
412 ulong_t val;
413 SYSLOG log;
414 va_list ap;
415 char padchar, *str;
416 int_t ch, width, left, i;
417 bool_t longflag;
418
419 if (connected) {
420 syscall(wai_sem(SEM_NET_CONS_PRINTF));
421 va_start(ap, format);
422 while ((ch = *format ++) != '\0') {
423 if (ch != '%') { /* 書式指定以外 */
424 cons_putchar(CONSOLE_PORTID, (char)ch);
425 continue;
426 }
427
428 width = 0;
429 longflag = false;
430 padchar = ' ';
431
432 if (ch == '-') { /* 左詰め */
433 format ++;
434 left = -1;
435 }
436 else
437 left = 1;
438
439 if ((ch = *format ++) == '0') { /* 上位桁の 0 */
440 padchar = '0';
441 ch = *format ++;
442 }
443
444 while ('0' <= ch && ch <= '9') { /* 出力幅
445 */
446 width = width * 10 + ch - '0';
447 ch = *format ++;
448 }
449
450 while (ch == 'l') { /* long (long) の指定 */
451 longflag = true;
452 ch = *format ++;
453 }
454
455 switch (ch) {
456 case 'd':
457 val = longflag ? (ulong_t)va_arg(ap, long_t)
458 : (ulong_t)va_arg(ap, int_t);
459 if ((long_t)val >= 0)
460 cons_putnumber(CONSOLE_PORTID, val, 10, radhex, width * left, false, padchar);
461 else
462 cons_putnumber(CONSOLE_PORTID, -val, 10, radhex, width * left, true, padchar);
463 break;
464
465 case 'u':
466 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
467 : (ulong_t)va_arg(ap, uint_t);
468 cons_putnumber(CONSOLE_PORTID, val, 10, radhex, width * left, false, padchar);
469 break;
470
471 case 'x':
472 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
473 : (ulong_t)va_arg(ap, uint_t);
474 cons_putnumber(CONSOLE_PORTID, val, 16, radhex, width * left, false, padchar);
475 break;
476
477 case 'X':
478 val = longflag ? (ulong_t)va_arg(ap, ulong_t)
479 : (ulong_t)va_arg(ap, uint_t);
480 cons_putnumber(CONSOLE_PORTID, val, 16, radHEX, width * left, false, padchar);
481 break;
482
483 case 'c':
484 ch = va_arg(ap, int_t);
485 cons_putchar(CONSOLE_PORTID, (char)ch);
486 break;
487
488 case 's':
489 str = va_arg(ap, char*);
490 while ((ch = *str ++) != '\0') {
491 cons_putchar(CONSOLE_PORTID, (char)ch);
492 width --;
493 }
494 while (width -- > 0)
495 cons_putchar(CONSOLE_PORTID, ' ');
496 break;
497
498 case 'I':
499
500#if defined(SUPPORT_INET4)
501
502 addr = va_arg(ap, T_IN4_ADDR*);
503 put_ipv4addr(CONSOLE_PORTID, addr, width);
504
505#endif /* of #if defined(SUPPORT_INET4) */
506
507#if defined(SUPPORT_INET6)
508
509 str = va_arg(ap, char*);
510 put_ipv6addr(CONSOLE_PORTID, (T_IN6_ADDR *)str, width);
511
512#endif /* of #if defined(SUPPORT_INET6) */
513
514 break;
515
516 case 'M':
517 str = va_arg(ap, char*);
518 put_macaddr(CONSOLE_PORTID, (uint8_t *)str, width);
519 break;
520
521 case '%':
522 cons_putchar(CONSOLE_PORTID, '%');
523 break;
524
525 case '0':
526 format --;
527 break;
528
529 default:
530 break;
531 }
532
533 }
534 va_end(ap);
535 cons_putchar(CONSOLE_PORTID, '\n');
536 flush_snd_buff();
537 syscall(sig_sem(SEM_NET_CONS_PRINTF));
538 return E_OK;
539 }
540 else {
541 log.logtype = LOG_TYPE_COMMENT;
542 log.loginfo[0] = (intptr_t)format;
543 i = 1;
544 va_start(ap, format);
545
546 while ((ch = *format++) != '\0' && i < TMAX_LOGINFO) {
547 if (ch != '%') {
548 continue;
549 }
550
551 longflag = false;
552
553 ch = *format++;
554 while ('0' <= ch && ch <= '9') {
555 ch = *format++;
556 }
557
558 while (ch == 'l') { /* long (long) の指定 */
559 longflag = true;
560 ch = *format ++;
561 }
562
563 switch (ch) {
564 case 'd':
565 log.loginfo[i++] = longflag
566 ? (intptr_t)va_arg(ap, long_t)
567 : (intptr_t)va_arg(ap, int_t);
568 break;
569 case 'u':
570 case 'x':
571 case 'X':
572 log.loginfo[i++] = longflag
573 ? (intptr_t)va_arg(ap, ulong_t)
574 : (intptr_t)va_arg(ap, uint_t);
575 break;
576 case 'p':
577 log.loginfo[i++] = (intptr_t)va_arg(ap, void *);
578 break;
579 case 'c':
580 log.loginfo[i++] = (intptr_t)va_arg(ap, int_t);
581 break;
582 case 's':
583 log.loginfo[i++] = (intptr_t)va_arg(ap, const char *);
584 break;
585 case '\0':
586 format--;
587 break;
588 default:
589 break;
590 }
591 }
592 va_end(ap);
593
594#ifdef TARGET_KERNEL_ASP
595
596 return(syslog_wri_log(prio, &log));
597
598#endif /* of #ifdef TARGET_KERNEL_ASP */
599
600#ifdef TARGET_KERNEL_JSP
601
602 return(vwri_log(prio, &log));
603
604#endif /* of #ifdef TARGET_KERNEL_JSP */
605
606 }
607 }
608
609#endif /* of #ifdef USE_NET_CONS */
Note: See TracBrowser for help on using the repository browser.