![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to comdriver_tcp.cpp CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Isaki's NoNo m68k/m88k emulator] / nono / host|
Return to comdriver_tcp.cpp CVS log | Up to [Isaki's NoNo m68k/m88k emulator] / nono / host |
1.1 root 1: //
2: // nono
3: // Copyright (C) 2021 nono project
4: // Licensed under nono-license.txt
5: //
6:
7: //
8: // シリアルポートの TCP ドライバ
9: //
10:
11: #include "comdriver_tcp.h"
12: #include "config.h"
13: #include "hostcom.h"
14: #include <sys/socket.h>
15: #include <netdb.h>
16: #include <arpa/telnet.h>
17:
18: // コンストラクタ
19: COMDriverTCP::COMDriverTCP(HostDevice *hostdev_)
20: : inherited(hostdev_, "TCP")
21: {
22: }
23:
24: // デストラクタ
25: COMDriverTCP::~COMDriverTCP()
26: {
27: }
28:
29: // ドライバ初期化
30: bool
31: COMDriverTCP::InitDriver()
32: {
33: struct addrinfo hints;
34: struct addrinfo *res, *ai;
35: int r;
36:
37: // host, port を取得
38: const char *host = "::1";
39: std::string key = hostdev->GetConfigKey();
40: const ConfigItem& item = gConfig->Find(key + "-tcp-port");
41: std::string port = item.AsString();
42: int portnum = atoi(port.c_str());
43: if (portnum < 1 || portnum > 65535) {
44: item.Err();
45: return false;
46: }
47:
48: // hints を用意
49: memset(&hints, 0, sizeof(hints));
50: hints.ai_family = AF_UNSPEC;
51: hints.ai_socktype = SOCK_STREAM;
52: hints.ai_flags = AI_PASSIVE;
53:
54: r = getaddrinfo(host, port.c_str(), &hints, &res);
55: if (r != 0) {
56: const char *errmsg;
57: if (r == EAI_SYSTEM) {
58: errmsg = strerror(errno);
59: } else {
60: errmsg = gai_strerror(r);
61: }
62: putmsg(0, "getaddrinfo: %s: %s", host, errmsg);
63: return false;
64: }
65: if (res == NULL) {
66: putmsg(0, "getaddrinfo: %s: no address found", host);
67: return false;
68: }
69:
70: // res を順番に試して成功したらそれで待ち受ける
71: ls = -1;
72: for (ai = res; ai && ls == -1; ai = ai->ai_next) {
73: int on = 1;
74:
75: ls = socket(ai->ai_family, ai->ai_socktype, ai->ai_protocol);
76: if (ls == -1) {
77: putmsg(0, "socket(family=%d): %s", (int)ai->ai_family,
78: strerror(errno));
79: continue;
80: }
81:
82: if (setsockopt(ls, SOL_SOCKET, SO_REUSEADDR, &on, sizeof(on))) {
83: putmsg(0, "setsockopt(SO_REUSEADDR): %s", strerror(errno));
84: ls.Close();
85: continue;
86: }
87:
88: if (setsockopt(ls, SOL_SOCKET, SO_REUSEPORT, &on, sizeof(on))) {
89: putmsg(0, "setsockopt(SO_REUSEPORT): %s", strerror(errno));
90: ls.Close();
91: continue;
92: }
93:
94: if (bind(ls, ai->ai_addr, ai->ai_addrlen) == -1) {
95: putmsg(0, "bind: %s", strerror(errno));
96: ls.Close();
97: continue;
98: }
99:
100: if (listen(ls, 0) == -1) {
101: putmsg(0, "listen: %s", strerror(errno));
102: ls.Close();
103: continue;
104: }
105:
106: // ここまで来たら成功
107: break;
108: }
109:
110: freeaddrinfo(res);
111:
112: if (ls == -1) {
113: return false;
114: }
115: if (hostdev->AddListen(ls, EV_ADD) < 0) {
116: putmsg(0, "AddListen(ADD): %s", strerror(errno));
117: return false;
118: }
119:
120: return true;
121: }
122:
123: // Driver の Dispatch() は udata を返す。
124: int
125: COMDriverTCP::Dispatch(int udata)
126: {
127: if (udata == HostDevice::LISTEN_SOCKET) {
128: if (Accept()) {
129: // 呼び出し側に戻って通知を出したいので LISTEN_SOCKET のまま帰る
130: return udata;
131: } else {
132: // 失敗時は何もしない
133: return HostDevice::DONE;
134: }
135: }
136:
137: return udata;
138: }
139:
140: // 待ち受けソケットに着信した。
141: // 成功すれば true を返す。
142: bool
143: COMDriverTCP::Accept()
144: {
145: struct sockaddr addr;
146: socklen_t addrlen;
147:
148: for (;;) {
149: addrlen = sizeof(addr);
150: sock = accept(ls, &addr, &addrlen);
151: if (sock < 0) {
152: if (errno == EINTR) {
153: continue;
154: }
155: // XXX どうする?
156: putmsg(0, "accept: %s", strerror(errno));
157: return false;
158: }
159: break;
160: }
161:
162: // 待ち受けソケットのほうは一旦通知オフにする?
163: if (hostdev->AddListen(ls, EV_DISABLE) < 0) {
164: putmsg(0, "AddListen(DISABLE): %s", strerror(errno));
165: return false;
166: }
167:
168: putmsg(1, "Accept a connection");
169:
170: // エコーオフ
171: WriteCmd({ WILL, TELOPT_ECHO });
172: negotiation++;
173:
174: // 全二重を使用
175: WriteCmd({ WILL, TELOPT_SGA });
176: negotiation++;
177:
178: // コマンド送信中にエラーが起きたら終了
179: if (sock.Valid() == false) {
180: return false;
181: }
182:
183: // 新しいソケットを kevent に登録
184: if (hostdev->AddOuter(sock) < 0) {
185: putmsg(0, "AddOuter: %s", strerror(errno));
186: Close();
187: return false;
188: }
189:
190: return true;
191: }
192:
193: // 外部への1バイト送信
194: void
195: COMDriverTCP::Write(uint32 data)
196: {
197: uint8 buf[1];
198: int n;
199:
200: if (sock.Valid()) {
201: buf[0] = data;
202:
203: n = write(sock, buf, sizeof(buf));
204: if (n < 0) {
205: putmsg(0, "write: %s", strerror(errno));
206: // エラーならソケットをクローズ
207: Close();
208: return;
209: }
210: if (n < sizeof(buf)) {
211: putmsg(0, "write: short");
212: return;
213: }
214: }
215: }
216:
217: // TELNET コマンドを送信。
218: // cmd には IAC を除いたデータ列を指定する。
219: void
220: COMDriverTCP::WriteCmd(const std::vector<uint8>& cmd)
221: {
222: if (loglevel >= 1) {
223: std::string str;
224: for (auto data : cmd) {
225: str += ' ';
226: str += GetCommandName(data);
227: }
228: putmsgn("Send %s", str.c_str() + 1);
229: }
230:
231: Write(IAC);
232: for (auto data : cmd) {
233: Write(data);
234: }
235: }
236:
237: // 外部からの1バイト受信
238: int
239: COMDriverTCP::Read()
240: {
241: uint8 buf[1];
242: int r;
243:
244: r = read(sock, buf, sizeof(buf));
245: if (r < 0) {
246: putmsg(0, "read: %s", strerror(errno));
247: Close();
248: return NODATA;
249: }
250: if (r == 0) {
251: Close();
252: return NODATA;
253: }
254: uint8 data = buf[0];
255:
256: if (__predict_false(recvcmd.empty() == false || data == IAC)) {
257: // TELNET コマンド
258: return Command(data);
259: } else {
260: // 平文
261: return data;
262: }
263: }
264:
265: // データソケットをクローズして、待ち受けソケットの通知を再開する。
266: void
267: COMDriverTCP::Close()
268: {
269: putmsg(1, "Close the connection");
270:
271: // データソケットをクローズ
272: if (sock.Valid()) {
273: hostdev->DelOuter(sock);
274: sock.Close();
275: }
276:
277: // 待ち受けソケットを再開
278: if (hostdev->AddListen(ls, EV_ENABLE) < 0) {
279: putmsg(0, "AddListen(ENABLE): %s", strerror(errno));
280: return;
281: }
282: }
283:
284: // TELNET コマンド受信。
285: // VM 側に文字を渡す場合は 0..255 を返す。
286: // VM に文字を渡さない場合は NODATA を返す。
287: int
288: COMDriverTCP::Command(uint8 code)
289: {
290: recvcmd.push_back(code);
291: putmsg(2, "Read cmd $%02x %s", code, GetCommandName(code).c_str());
292:
293: if (cmdstate == WILL) {
294: // WILL: 送信側がこのオプション使用を宣言
295: // DONT: 送信側がこのオプション無効を宣言
296: // (今の所動作が同じなので同じ state を使う)
297:
298: if (negotiation > 0) {
299: // 送ったコマンドに対する応答を受信したのなら、何もしない
300: putmsg(1, "Recv response %s %s",
301: GetCommandName(recvcmd[1]).c_str(),
302: GetCommandName(recvcmd[2]).c_str());
303: negotiation--;
304: } else {
305: // 向こう発のコマンドを受信したのなら、応答する
306: putmsg(1, "Recv command %s %s",
307: GetCommandName(recvcmd[1]).c_str(),
308: GetCommandName(recvcmd[2]).c_str());
309:
310: // どのコマンドもサポートしていないので、
311: // WILL に対しては DONT で無視。
312: // DONT に対しては DONT で応答。
313: WriteCmd({ DONT, recvcmd[2] });
314: }
315:
316: recvcmd.clear();
317: cmdstate = 0;
318:
319: } else if (cmdstate == DO) {
320: // DO: 送信側がこちらにこのオプション使用を要求
321: // WONT: 送信側がこちらにこのオプション無効を要求
322: // (今の所動作が同じなので同じ state を使う)
323:
324: if (negotiation > 0) {
325: // 送ったコマンドに対する応答を受信したのなら、何もしない
326: putmsg(1, "Recv response %s %s",
327: GetCommandName(recvcmd[1]).c_str(),
328: GetCommandName(recvcmd[2]).c_str());
329: negotiation--;
330: } else {
331: // 向こう発のコマンドを受信したのなら、応答する
332: putmsg(1, "Recv command %s %s",
333: GetCommandName(recvcmd[1]).c_str(),
334: GetCommandName(recvcmd[2]).c_str());
335:
336: // DO に対しては WONT で拒否。
337: // WONT に対しては WONT で応答。
338: WriteCmd({ WONT, recvcmd[2] });
339: }
340:
341: recvcmd.clear();
342: cmdstate = 0;
343:
344: } else if (cmdstate == SB) {
345: // IAC, SE で終端
346: if (recvcmd[recvcmd.size() - 2] == IAC &&
347: recvcmd[recvcmd.size() - 1] == SE )
348: {
349: // 未知のシーケンスを読み飛ばすだけで、何もしない
350: recvcmd.clear();
351: cmdstate = 0;
352: }
353:
354: } else if (recvcmd.size() < 2) {
355: // 1バイト目は IAC のはず
356:
357: } else if (recvcmd.size() == 2) {
358: // 2バイト目がコマンド
359: cmdstate = 0;
360: switch (recvcmd[1]) {
361: case SE: // SE はここに来ないはずだが、来てもここで終了でいい。
362: case NOP: // NOP はたぶん何もしない。
363: FALLTHROUGH;
364: case DM:
365: // XXX 未確認
366: FALLTHROUGH;
367: case BREAK:
368: // XXX Break 文字を送る
369: FALLTHROUGH;
370: case IP:
371: case AO:
372: case AYT:
373: case EC:
374: case EL:
375: case GA:
376: // XXX 未実装、たぶん引数はない
377: putmsg(1, "Recv command %s", GetCommandName(recvcmd[1]).c_str());
378: recvcmd.clear();
379: break;
380:
381: case SB:
382: // この後 SE までがサブネゴシエーション
383: putmsg(1, "Recv command %s", GetCommandName(recvcmd[1]).c_str());
384: cmdstate = SB;
385: break;
386:
387: case WILL:
388: case DONT:
389: // 次の1文字がオプション
390: cmdstate = WILL;
391: break;
392: case DO:
393: case WONT:
394: // 次の1文字がオプション
395: cmdstate = DO;
396: break;
397:
398: default:
399: // それ以外なら、その文字
400: recvcmd.clear();
401: return code;
402: }
403: }
404:
405: return NODATA;
406: }
407:
408: // TELNET のコマンド、オプション名を返す
409: /*static*/ std::string
410: COMDriverTCP::GetCommandName(uint8 code)
411: {
412: switch (code) {
413: case 0x00: return "Transmit-Binary";
414: case 0x01: return "Echo";
415: case 0x03: return "Suppress-Go-Ahead";
416: case 0x05: return "Telnet-Status-Option";
417: case 0x06: return "Telnet-Timing-Mark";
418: case 0x18: return "Terminal-Type";
419: case 0x22: return "Telnet-Line-Mode";
420:
421: case 0xf0: return "SE";
422: case 0xf1: return "NOP";
423: case 0xf2: return "DataMark";
424: case 0xf3: return "Break";
425: case 0xf4: return "IP";
426: case 0xf5: return "AO"; // Abort Output
427: case 0xf6: return "AYT"; // Are You There
428: case 0xf7: return "EC"; // Erase Character
429: case 0xf8: return "EL"; // Erase Line
430: case 0xf9: return "GA"; // Go Ahead
431: case 0xfa: return "SB";
432: case 0xfb: return "WILL";
433: case 0xfc: return "WONT";
434: case 0xfd: return "DO";
435: case 0xfe: return "DONT";
436: case 0xff: return "IAC"; // Interpret As Command
437:
438: default:
439: return string_format("(unknown $%02x)", code);
440: }
441: }
442:
443: // モニタ (ドライバ依存情報のみ)
444: void
1.1.1.2 ! root 445: COMDriverTCP::MonitorUpdateMD(TextScreen& screen, int y)
1.1 root 446: {
447: // 何を表示したもんか
448: }
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.