Annotation of libaitio/src/sock.c, revision 1.4.4.12
1.2 misho 1: /*************************************************************************
2: * (C) 2013 AITNET ltd - Sofia/Bulgaria - <misho@aitnet.org>
3: * by Michael Pounov <misho@elwix.org>
4: *
5: * $Author: misho $
1.4.4.12! misho 6: * $Id: sock.c,v 1.4.4.11 2013/11/22 10:05:17 misho Exp $
1.2 misho 7: *
8: **************************************************************************
9: The ELWIX and AITNET software is distributed under the following
10: terms:
11:
12: All of the documentation and software included in the ELWIX and AITNET
13: Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org>
14:
15: Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013
16: by Michael Pounov <misho@elwix.org>. All rights reserved.
17:
18: Redistribution and use in source and binary forms, with or without
19: modification, are permitted provided that the following conditions
20: are met:
21: 1. Redistributions of source code must retain the above copyright
22: notice, this list of conditions and the following disclaimer.
23: 2. Redistributions in binary form must reproduce the above copyright
24: notice, this list of conditions and the following disclaimer in the
25: documentation and/or other materials provided with the distribution.
26: 3. All advertising materials mentioning features or use of this software
27: must display the following acknowledgement:
28: This product includes software developed by Michael Pounov <misho@elwix.org>
29: ELWIX - Embedded LightWeight unIX and its contributors.
30: 4. Neither the name of AITNET nor the names of its contributors
31: may be used to endorse or promote products derived from this software
32: without specific prior written permission.
33:
34: THIS SOFTWARE IS PROVIDED BY AITNET AND CONTRIBUTORS ``AS IS'' AND
35: ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
36: IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
37: ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
38: FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
39: DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
40: OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
41: HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
42: LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
43: OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
44: SUCH DAMAGE.
45: */
46: #include "global.h"
47:
48:
1.4.4.4 misho 49: static void *
50: io_closeClient(sched_task_t *task)
51: {
52: sock_cli_t *cli = (sock_cli_t*) TASK_ARG(task);
53: sock_t *s = (sock_t*) cli->cli_parent;
1.4.4.12! misho 54: int stat, sock = (int) TASK_DATLEN(task);
1.4.4.4 misho 55:
56: pthread_mutex_lock(&s->sock_mtx);
57: TAILQ_REMOVE(&s->sock_cli, cli, cli_node);
58: pthread_mutex_unlock(&s->sock_mtx);
59:
1.4.4.7 misho 60: schedCancelby(s->sock_root, taskTIMER, CRITERIA_DATLEN,
61: (void*) cli->cli_fd, NULL);
62: schedCancelby(s->sock_root, taskMAX, CRITERIA_ARG, cli, NULL);
63:
1.4.4.4 misho 64: if (s->sock_type == SOCK_STREAM) {
65: shutdown(sock, SHUT_RDWR);
66: close(sock);
67: }
1.4.4.5 misho 68: AIT_FREE_VAL(&cli->cli_buf[1]);
69: AIT_FREE_VAL(&cli->cli_buf[0]);
1.4.4.4 misho 70:
1.4.4.12! misho 71: /* if optional argument have pid */
! 72: if (TASK_DATA(task)) {
! 73: kill((pid_t) TASK_DATA(task), SIGTERM);
! 74: while (waitpid((pid_t) TASK_DATA(task), &stat, WNOHANG) > 0) {
! 75: usleep(1000);
! 76: kill((pid_t) TASK_DATA(task), SIGTERM);
! 77: }
! 78: }
! 79:
1.4.4.4 misho 80: e_free(cli);
81: taskExit(task, NULL);
82: }
83:
84: static void *
85: io_acceptClient(sched_task_t *task)
86: {
87: int c, rlen;
88: sockaddr_t sa;
89: socklen_t salen = sizeof sa.ss;
90: sock_cli_t *cli = NULL;
91: sock_t *s = (sock_t*) TASK_ARG(task);
92:
93: if (s->sock_type == SOCK_STREAM) {
94: if ((c = accept(TASK_FD(task), &sa.sa, &salen)) == -1) {
95: LOGERR;
96: goto end;
97: }
98: } else {
99: if ((rlen = recvfrom(TASK_FD(task),
100: AIT_GET_BUF(&s->sock_buf), AIT_LEN(&s->sock_buf),
101: MSG_PEEK, &sa.sa, &salen)) == -1) {
102: LOGERR;
103: goto end;
104: } else
105: c = TASK_FD(task);
106: }
107:
108: cli = e_malloc(sizeof(sock_cli_t));
109: if (!cli) {
110: io_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
111: if (s->sock_type == SOCK_STREAM)
112: close(c);
113: goto end;
114: } else {
115: memset(cli, 0, sizeof(sock_cli_t));
116: pthread_mutex_lock(&s->sock_mtx);
117: TAILQ_INSERT_TAIL(&s->sock_cli, cli, cli_node);
118: pthread_mutex_unlock(&s->sock_mtx);
119: }
120:
121: cli->cli_parent = TASK_ARG(task);
122: cli->cli_fd = c;
123: cli->cli_func = TASK_DATA(task);
124: memcpy(&cli->cli_addr, &sa, sizeof cli->cli_addr);
1.4.4.5 misho 125: AIT_SET_BUFSIZ(&cli->cli_buf[0], 0, AIT_LEN(&s->sock_buf));
126: AIT_SET_BUFSIZ(&cli->cli_buf[1], 0, AIT_LEN(&s->sock_buf));
1.4.4.4 misho 127:
128: schedRead(TASK_ROOT(task), cli->cli_func, cli, cli->cli_fd, TASK_ARG(task), 0);
1.4.4.12! misho 129: ioUpdTimerSocket(cli, NULL);
1.4.4.4 misho 130: end:
131: schedReadSelf(task);
132: taskExit(task, NULL);
133: }
134:
1.4.4.7 misho 135: static void *
1.4.4.9 misho 136: io_txNet(sched_task_t *task)
137: {
1.4.4.12! misho 138: int wlen;
1.4.4.9 misho 139: sock_cli_t *cli = TASK_ARG(task);
140: sock_t *s = (sock_t*) cli->cli_parent;
141:
142: if (s->sock_type == SOCK_STREAM)
143: wlen = send(TASK_FD(task), TASK_DATA(task), TASK_DATLEN(task), 0);
144: else
145: wlen = sendto(TASK_FD(task), TASK_DATA(task), TASK_DATLEN(task), 0,
146: &cli->cli_addr.sa, cli->cli_addr.sa.sa_len);
1.4.4.12! misho 147: if (wlen < 1)
! 148: schedEvent(TASK_ROOT(task), io_closeClient, cli, 0,
! 149: (void*) cli->cli_func, cli->cli_fd);
1.4.4.9 misho 150:
151: taskExit(task, NULL);
152: }
153:
154: static void *
155: io_txPty(sched_task_t *task)
156: {
1.4.4.12! misho 157: int wlen;
1.4.4.9 misho 158: sock_cli_t *cli = TASK_ARG(task);
159:
160: wlen = write(TASK_FD(task), TASK_DATA(task), TASK_DATLEN(task));
1.4.4.12! misho 161: if (wlen < 1)
! 162: schedEvent(TASK_ROOT(task), io_closeClient, cli, 0,
! 163: (void*) cli->cli_func, cli->cli_fd);
1.4.4.9 misho 164:
165: taskExit(task, NULL);
166: }
167:
168: static void *
169: io_rxNet(sched_task_t *task)
170: {
1.4.4.12! misho 171: int rlen;
1.4.4.9 misho 172: sock_cli_t *cli = TASK_ARG(task);
173: sock_t *s = (sock_t*) cli->cli_parent;
174: sockaddr_t sa;
175: socklen_t salen = sizeof sa.ss;
176:
177: if (s->sock_type == SOCK_STREAM)
178: rlen = recv(TASK_FD(task), AIT_GET_BUF(&cli->cli_buf[0]),
179: AIT_LEN(&cli->cli_buf[0]), 0);
180: else {
181: rlen = recvfrom(TASK_FD(task), AIT_GET_BUF(&cli->cli_buf[0]),
182: AIT_LEN(&cli->cli_buf[0]), 0, &sa.sa, &salen);
183: if (e_addrcmp(&cli->cli_addr, &sa, 42))
184: goto end;
185: }
1.4.4.12! misho 186: if (rlen < 1)
! 187: schedEvent(TASK_ROOT(task), io_closeClient, cli, 0,
! 188: (void*) cli->cli_func, cli->cli_fd);
! 189: else
1.4.4.9 misho 190: schedWrite(TASK_ROOT(task), io_txPty, cli, cli->cli_pty,
191: AIT_GET_BUF(&cli->cli_buf[0]), rlen);
192: end:
193: schedReadSelf(task);
194: taskExit(task, NULL);
195: }
196:
197: static void *
198: io_rxPty(sched_task_t *task)
199: {
1.4.4.12! misho 200: int rlen;
1.4.4.9 misho 201: sock_cli_t *cli = TASK_ARG(task);
202:
203: rlen = read(TASK_FD(task), AIT_GET_BUF(&cli->cli_buf[1]), AIT_LEN(&cli->cli_buf[1]));
1.4.4.12! misho 204: if (rlen < 1)
! 205: schedEvent(TASK_ROOT(task), io_closeClient, cli, 0,
! 206: (void*) cli->cli_func, cli->cli_fd);
! 207: else
1.4.4.9 misho 208: schedWrite(TASK_ROOT(task), io_txNet, cli, cli->cli_fd,
209: AIT_GET_BUF(&cli->cli_buf[1]), rlen);
210:
211: schedReadSelf(task);
212: taskExit(task, NULL);
213: }
214:
215: static void *
1.4.4.8 misho 216: io_bridgeClient(sched_task_t *task)
1.4.4.7 misho 217: {
1.4.4.8 misho 218: int c, rlen;
219: pid_t pid;
220: sockaddr_t sa;
221: socklen_t salen = sizeof sa.ss;
222: sock_cli_t *cli = NULL;
223: sock_t *s = (sock_t*) TASK_ARG(task);
224: array_t *args = NULL;
225: char **argv = NULL;
226:
227: if (s->sock_type == SOCK_STREAM) {
228: if ((c = accept(TASK_FD(task), &sa.sa, &salen)) == -1) {
229: LOGERR;
230: goto end;
231: }
232: } else {
233: if ((rlen = recvfrom(TASK_FD(task),
234: AIT_GET_BUF(&s->sock_buf), AIT_LEN(&s->sock_buf),
235: MSG_PEEK, &sa.sa, &salen)) == -1) {
236: LOGERR;
237: goto end;
238: } else
239: c = TASK_FD(task);
240: }
241:
242: cli = e_malloc(sizeof(sock_cli_t));
243: if (!cli) {
244: io_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
245: if (s->sock_type == SOCK_STREAM)
246: close(c);
247: goto end;
248: } else {
249: memset(cli, 0, sizeof(sock_cli_t));
250: pthread_mutex_lock(&s->sock_mtx);
251: TAILQ_INSERT_TAIL(&s->sock_cli, cli, cli_node);
252: pthread_mutex_unlock(&s->sock_mtx);
253: }
254:
255: cli->cli_parent = TASK_ARG(task);
256: cli->cli_fd = c;
257: strlcpy(cli->cli_cmdline, TASK_DATA(task), sizeof cli->cli_cmdline);
258: memcpy(&cli->cli_addr, &sa, sizeof cli->cli_addr);
259: AIT_SET_BUFSIZ(&cli->cli_buf[0], 0, AIT_LEN(&s->sock_buf));
260: AIT_SET_BUFSIZ(&cli->cli_buf[1], 0, AIT_LEN(&s->sock_buf));
261:
262: switch ((pid = ioForkPTY(&cli->cli_pty, cli->cli_name, sizeof cli->cli_name,
263: NULL, NULL, NULL))) {
264: case -1:
265: ELIBERR(io);
266: break;
267: case 0:
268: array_Args(cli->cli_cmdline, 0, " \t", &args);
269: argv = array_To(args);
270: array_Destroy(&args);
271:
272: execv(*argv, argv);
273: break;
274: default:
1.4.4.10 misho 275: cli->cli_func = (sched_task_func_t) pid;
276:
1.4.4.9 misho 277: schedRead(TASK_ROOT(task), io_rxPty, cli, cli->cli_pty,
278: TASK_ARG(task), 0);
279: schedRead(TASK_ROOT(task), io_rxNet, cli, cli->cli_fd,
280: TASK_ARG(task), 0);
1.4.4.12! misho 281: ioUpdTimerSocket(cli, (void*) pid);
1.4.4.8 misho 282: break;
283: }
284: end:
285: schedReadSelf(task);
1.4.4.7 misho 286: taskExit(task, NULL);
287: }
288:
1.4.4.4 misho 289:
1.2 misho 290: /*
291: * ioInitSocket() - Init socket and allocate resources
292: *
293: * @role = Socket role
294: * @type = Socket type
295: * @proto = Socket protocol
296: * @addr = Bind to address
297: * @port = Bind to port
298: * @buflen = Socket buffer, optional if =0 == BUFSIZ
299: * return: NULL error or !=NULL created socket
300: */
301: sock_t *
302: ioInitSocket(int role, int type, int proto, const char *addr, u_short port, size_t buflen)
303: {
304: sock_t *s = NULL;
305: int n = 1;
306:
307: if (!addr)
308: return NULL;
309:
310: s = e_malloc(sizeof(sock_t));
311: if (!s) {
312: io_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
313: return NULL;
314: } else
315: memset(s, 0, sizeof(sock_t));
316:
1.3 misho 317: TAILQ_INIT(&s->sock_cli);
318:
1.2 misho 319: s->sock_role = role;
320: s->sock_type = type;
321: s->sock_proto = proto;
322: if (!e_gethostbyname(addr, port, &s->sock_addr)) {
323: io_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
324: e_free(s);
325: return NULL;
326: } else {
327: buflen = buflen ? buflen : BUFSIZ;
1.4.4.1 misho 328: buflen = E_ALIGN(buflen, 2); /* align buflen length */
1.2 misho 329: AIT_SET_BUFSIZ(&s->sock_buf, 0, buflen);
330: }
331:
332: s->sock_fd = socket(s->sock_addr.sa.sa_family, s->sock_type, s->sock_proto);
333: if (s->sock_fd == -1) {
334: LOGERR;
335: AIT_FREE_VAL(&s->sock_buf);
336: e_free(s);
337: return NULL;
338: }
339: if (setsockopt(s->sock_fd, SOL_SOCKET, SO_SNDBUF, &buflen, sizeof buflen) == -1) {
340: LOGERR;
341: AIT_FREE_VAL(&s->sock_buf);
342: e_free(s);
343: return NULL;
344: }
345: if (setsockopt(s->sock_fd, SOL_SOCKET, SO_RCVBUF, &buflen, sizeof buflen) == -1) {
346: LOGERR;
347: AIT_FREE_VAL(&s->sock_buf);
348: e_free(s);
349: return NULL;
350: }
351: if (setsockopt(s->sock_fd, SOL_SOCKET, SO_REUSEADDR, &n, sizeof n) == -1) {
352: LOGERR;
353: AIT_FREE_VAL(&s->sock_buf);
354: e_free(s);
355: return NULL;
356: }
357: if (bind(s->sock_fd, &s->sock_addr.sa, s->sock_addr.sa.sa_len) == -1) {
358: LOGERR;
359: AIT_FREE_VAL(&s->sock_buf);
360: e_free(s);
361: return NULL;
362: }
363:
1.4.4.1 misho 364: s->sock_root = schedBegin();
365: if (!s->sock_root) {
366: io_SetErr(sched_GetErrno(), "%s", sched_GetError());
367: AIT_FREE_VAL(&s->sock_buf);
368: e_free(s);
369: return NULL;
370: }
371:
1.3 misho 372: pthread_mutex_init(&s->sock_mtx, NULL);
1.2 misho 373: return s;
374: }
375:
376: /*
377: * ioCloseSocket() - Close socket and free resources
378: *
379: * @s = Socket
380: * return: none
381: */
382: void
383: ioCloseSocket(sock_t ** __restrict s)
384: {
1.4.4.4 misho 385: sock_cli_t *cli;
1.3 misho 386:
1.2 misho 387: if (s && *s) {
1.3 misho 388: pthread_mutex_lock(&(*s)->sock_mtx);
389: while ((cli = TAILQ_FIRST(&(*s)->sock_cli))) {
390: TAILQ_REMOVE(&(*s)->sock_cli, cli, cli_node);
1.4.4.4 misho 391:
392: schedCancelby((*s)->sock_root, taskTIMER, CRITERIA_DATLEN,
393: (void*) cli->cli_fd, NULL);
1.4.4.7 misho 394: schedCancelby((*s)->sock_root, taskMAX, CRITERIA_ARG, cli, NULL);
1.4.4.4 misho 395:
396: if ((*s)->sock_type == SOCK_STREAM) {
397: shutdown(cli->cli_fd, SHUT_RDWR);
398: close(cli->cli_fd);
399: }
1.4.4.5 misho 400: AIT_FREE_VAL(&cli->cli_buf[1]);
401: AIT_FREE_VAL(&cli->cli_buf[0]);
1.3 misho 402: e_free(cli);
403: }
404: pthread_mutex_unlock(&(*s)->sock_mtx);
405:
1.2 misho 406: shutdown((*s)->sock_fd, SHUT_RDWR);
407: close((*s)->sock_fd);
408:
409: AIT_FREE_VAL(&(*s)->sock_buf);
1.3 misho 410:
1.4.4.1 misho 411: schedEnd(&(*s)->sock_root);
412:
1.3 misho 413: pthread_mutex_destroy(&(*s)->sock_mtx);
1.2 misho 414: e_free(*s);
415: *s = NULL;
416: }
417: }
418:
419: /*
420: * ioUpSocket() - Setup socket for use
421: *
422: * @s = Socket
423: * @arg = Server role = listen backlog queue and Client role = peer address
1.4.4.1 misho 424: * @timeout = Socket timeout in sec (default -1 infinit)
1.2 misho 425: * return: -1 error or 0 ok
426: */
427: int
1.4.4.1 misho 428: ioUpSocket(sock_t * __restrict s, void *arg, int timeout)
1.2 misho 429: {
430: int ret = 0;
431: sockaddr_t *peer = (sockaddr_t*) arg;
432: uintptr_t backlog = (uintptr_t) arg;
433:
434: if (!s || !arg)
435: return -1;
1.4.4.1 misho 436: else {
437: s->sock_timeout.tv_sec = timeout;
438: s->sock_timeout.tv_nsec = (timeout < 1) ? timeout : 0;
439: schedPolling(s->sock_root, &s->sock_timeout, NULL);
440: }
1.2 misho 441:
442: switch (s->sock_role) {
443: case IO_SOCK_ROLE_CLIENT:
444: memcpy(&s->sock_peer, peer, sizeof s->sock_peer);
445:
446: if (connect(s->sock_fd, &s->sock_peer.sa,
447: s->sock_peer.sa.sa_len) == -1) {
448: LOGERR;
449: return -1;
450: }
451: break;
452: case IO_SOCK_ROLE_SERVER:
453: if (s->sock_type == SOCK_STREAM) {
454: s->sock_backq = backlog;
455:
456: if (listen(s->sock_fd, s->sock_backq) == -1) {
457: LOGERR;
458: return -1;
459: }
460: }
461: break;
462: default:
463: io_SetErr(EINVAL, "Unsupported socket type");
464: return -1;
465: }
466:
467: fcntl(s->sock_fd, F_SETFL, fcntl(s->sock_fd, F_GETFL) | O_NONBLOCK);
468: return ret;
469: }
1.3 misho 470:
471: /*
1.4.4.2 misho 472: * ioUpdTimerSocket() - Update timeout of socket
1.3 misho 473: *
1.4.4.2 misho 474: * @c = Client socket
1.4.4.12! misho 475: * @arg = Optional data argument
1.4.4.2 misho 476: * return: none
1.3 misho 477: */
1.4.4.2 misho 478: void
1.4.4.12! misho 479: ioUpdTimerSocket(sock_cli_t * __restrict c, void *arg)
1.3 misho 480: {
1.4.4.2 misho 481: sock_t *s;
1.3 misho 482:
1.4.4.2 misho 483: if (!c)
484: return;
485: else
486: s = c->cli_parent;
1.3 misho 487:
1.4.4.2 misho 488: schedCancelby(s->sock_root, taskTIMER, CRITERIA_DATLEN, (void*) c->cli_fd, NULL);
1.4.4.12! misho 489: schedTimer(s->sock_root, io_closeClient, c, s->sock_timeout, arg, c->cli_fd);
1.4.4.2 misho 490: }
1.3 misho 491:
1.4.4.2 misho 492: /*
1.4.4.6 misho 493: * ioCloseClient() - Close client socket
494: *
495: * @c = Client socket
496: * return: 0 ok or !=0 error
497: */
498: int
499: ioCloseClient(sock_cli_t * __restrict c)
500: {
501: sock_t *s;
502:
503: if (!c)
504: return -1;
505: else
506: s = c->cli_parent;
507:
508: return !schedEvent(s->sock_root, io_closeClient, c, 0, NULL, c->cli_fd);
509: }
510:
511: /*
1.4.4.2 misho 512: * ioLoopSocket() - Start socket scheduler
513: *
514: * @s = Socket
515: * @rcb = Read callback
516: * return: -1 error or return result from scheduler
517: */
518: int
519: ioLoopSocket(sock_t * __restrict s, sched_task_func_t rcb)
520: {
1.4.4.6 misho 521: if (!s || !rcb || s->sock_kill)
522: return -1;
523:
1.4.4.2 misho 524: schedRead(s->sock_root, io_acceptClient, s, s->sock_fd, rcb, 0);
525: return schedRun(s->sock_root, &s->sock_kill);
1.3 misho 526: }
1.4.4.3 misho 527:
528: /*
1.4.4.6 misho 529: * ioBridgeProg2Socket() - Start socket scheduler and bridge program to socket
1.4.4.3 misho 530: *
1.4.4.6 misho 531: * @s = Socket
532: * @prgname = Program name
1.4.4.3 misho 533: * return: 0 ok or !=0 error
534: */
535: int
1.4.4.6 misho 536: ioBridgeProg2Socket(sock_t * __restrict s, const char *prgname)
1.4.4.3 misho 537: {
1.4.4.6 misho 538: if (!s || !prgname || s->sock_kill)
1.4.4.3 misho 539: return -1;
540:
1.4.4.8 misho 541: schedRead(s->sock_root, io_bridgeClient, s, s->sock_fd, (void*) prgname, 0);
542: return schedRun(s->sock_root, &s->sock_kill);
1.4.4.3 misho 543: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/icons/cvsweb/back.gif){kind=icon}
Return to sock.c CVS log ![[TXT]](/icons/cvsweb/text.gif){kind=icon}
![[DIR]](/icons/cvsweb/dir.gif){kind=icon}
Up to [ELWIX - Embedded LightWeight unIX -] / libaitio / src