1: /*************************************************************************
2: * (C) 2010 AITNET ltd - Sofia/Bulgaria - <misho@aitbg.com>
3: * by Michael Pounov <misho@openbsd-bg.org>
4: *
5: * $Author: misho $
6: * $Id: cli.c,v 1.23 2015/01/15 01:42:37 misho Exp $
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 - 2014
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:
49: /*
50: * rpc_cli_openBLOBClient() - Connect to BLOB Server
51: *
52: * @rpccli = RPC Client session
53: * @Port = Port for bind server, if Port == 0 default port is selected
54: * return: NULL == error or !=NULL connection to BLOB server established
55: */
56: rpc_cli_t *
57: rpc_cli_openBLOBClient(rpc_cli_t * __restrict rpccli, u_short Port)
58: {
59: rpc_cli_t *cli = NULL;
60: int n;
61:
62: if (!rpccli) {
63: rpc_SetErr(EINVAL, "Invalid parameters can`t connect to BLOB server");
64: return NULL;
65: }
66:
67: cli = e_malloc(sizeof(rpc_cli_t));
68: if (!cli) {
69: LOGERR;
70: return NULL;
71: } else
72: memcpy(cli, rpccli, sizeof(rpc_cli_t));
73:
74: memcpy(&cli->cli_sa, &rpccli->cli_sa, sizeof(sockaddr_t));
75: switch (cli->cli_sa.sa.sa_family) {
76: case AF_INET:
77: cli->cli_sa.sin.sin_port =
78: htons(Port ? Port : ntohs(cli->cli_sa.sin.sin_port) + 1);
79: break;
80: case AF_INET6:
81: cli->cli_sa.sin6.sin6_port =
82: htons(Port ? Port : ntohs(cli->cli_sa.sin6.sin6_port) + 1);
83: break;
84: case AF_LOCAL:
85: strlcat(cli->cli_sa.sun.sun_path, ".blob", sizeof cli->cli_sa.sun.sun_path);
86: break;
87: default:
88: rpc_SetErr(EINVAL, "Invalid socket type %d", cli->cli_sa.sa.sa_family);
89: return NULL;
90: }
91:
92: AIT_COPY_VAL(&cli->cli_buf, &rpccli->cli_buf);
93: n = AIT_LEN(&cli->cli_buf);
94:
95: /* connect to BLOB server */
96: cli->cli_sock = socket(cli->cli_sa.sa.sa_family, SOCK_STREAM, 0);
97: if (cli->cli_sock == -1) {
98: LOGERR;
99: e_free(cli);
100: return NULL;
101: }
102: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_SNDBUF, &n, sizeof n) == -1) {
103: LOGERR;
104: close(cli->cli_sock);
105: e_free(cli);
106: return NULL;
107: }
108: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_RCVBUF, &n, sizeof n) == -1) {
109: LOGERR;
110: close(cli->cli_sock);
111: e_free(cli);
112: return NULL;
113: }
114: if (connect(cli->cli_sock, &cli->cli_sa.sa, cli->cli_sa.sa.sa_len) == -1) {
115: LOGERR;
116: close(cli->cli_sock);
117: e_free(cli);
118: return NULL;
119: } else
120: fcntl(cli->cli_sock, F_SETFL, fcntl(cli->cli_sock, F_GETFL) | O_NONBLOCK);
121:
122: return cli;
123: }
124:
125: /*
126: * rpc_cli_closeBLOBClient() - Close connection to BLOB server and free resources
127: *
128: * @cli = BLOB Client session
129: * return: none
130: */
131: void
132: rpc_cli_closeBLOBClient(rpc_cli_t ** __restrict cli)
133: {
134: if (!cli || !*cli)
135: return;
136:
137: shutdown((*cli)->cli_sock, SHUT_RDWR);
138: close((*cli)->cli_sock);
139:
140: AIT_FREE_VAL(&(*cli)->cli_buf);
141:
142: e_free(*cli);
143: *cli = NULL;
144: }
145:
146: /* -------------------------------------------------------------- */
147:
148: /*
149: * rpc_cli_openClient() - Connect to RPC Server
150: *
151: * @InstID = InstID for RPC session request
152: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
153: * @csHost = Host name or IP address for bind server
154: * @Port = Port for bind server, if Port == 0 default port is selected
155: * @proto = Protocol, if == 0 choose SOCK_STREAM
156: * return: NULL == error or !=NULL connection to RPC server established
157: */
158: rpc_cli_t *
159: rpc_cli_openClient(u_char InstID, int netBuf, const char *csHost, u_short Port, int proto)
160: {
161: rpc_cli_t *cli = NULL;
162: sockaddr_t sa = E_SOCKADDR_INIT;
163:
164: if (!e_gethostbyname(csHost, Port, &sa))
165: return NULL;
166: if (!Port)
167: Port = RPC_DEFPORT;
168: if (!proto)
169: proto = SOCK_STREAM;
170: if (netBuf < RPC_MIN_BUFSIZ)
171: netBuf = BUFSIZ;
172: else
173: netBuf = E_ALIGN(netBuf, 2); /* align netBuf length */
174:
175: cli = e_malloc(sizeof(rpc_cli_t));
176: if (!cli) {
177: LOGERR;
178: return NULL;
179: } else
180: memset(cli, 0, sizeof(rpc_cli_t));
181:
182: /* build session */
183: cli->cli_parent = e_malloc(sizeof(rpc_sess_t));
184: if (!cli->cli_parent) {
185: LOGERR;
186: e_free(cli);
187: return NULL;
188: } else {
189: ((rpc_sess_t*) cli->cli_parent)->sess_version = RPC_VERSION;
190: ((rpc_sess_t*) cli->cli_parent)->sess_instance = InstID;
191: }
192:
193: cli->cli_id = proto;
194: memcpy(&cli->cli_sa, &sa, sizeof cli->cli_sa);
195: AIT_SET_BUFSIZ(&cli->cli_buf, 0, netBuf);
196:
197: /* connect to RPC server */
198: cli->cli_sock = socket(cli->cli_sa.sa.sa_family, cli->cli_id, 0);
199: if (cli->cli_sock == -1) {
200: LOGERR;
201: goto err;
202: }
203: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_SNDBUF,
204: &netBuf, sizeof netBuf) == -1) {
205: LOGERR;
206: goto err;
207: }
208: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_RCVBUF,
209: &netBuf, sizeof netBuf) == -1) {
210: LOGERR;
211: goto err;
212: }
213: if (cli->cli_id == SOCK_STREAM)
214: if (connect(cli->cli_sock, &cli->cli_sa.sa, cli->cli_sa.sa.sa_len) == -1) {
215: LOGERR;
216: goto err;
217: }
218:
219: fcntl(cli->cli_sock, F_SETFL, fcntl(cli->cli_sock, F_GETFL) | O_NONBLOCK);
220: return cli;
221: err:
222: AIT_FREE_VAL(&cli->cli_buf);
223: if (cli->cli_sock > 2)
224: close(cli->cli_sock);
225: e_free(cli->cli_parent);
226: e_free(cli);
227: return NULL;
228: }
229:
230: /*
231: * rpc_cli_reconnectClient() - Reconnecting client to RPC server
232: *
233: * @cli = RPC Client session
234: * return: -1 error or 0 ok
235: */
236: int
237: rpc_cli_reconnectClient(rpc_cli_t * __restrict cli)
238: {
239: int netBuf;
240:
241: if (!cli)
242: return -1;
243: else
244: netBuf = AIT_LEN(&cli->cli_buf);
245:
246: close(cli->cli_sock);
247:
248: cli->cli_sock = socket(cli->cli_sa.sa.sa_family, cli->cli_id, 0);
249: if (cli->cli_sock == -1) {
250: LOGERR;
251: return -1;
252: }
253: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_SNDBUF,
254: &netBuf, sizeof netBuf) == -1) {
255: LOGERR;
256: close(cli->cli_sock);
257: return -1;
258: }
259: if (setsockopt(cli->cli_sock, SOL_SOCKET, SO_RCVBUF,
260: &netBuf, sizeof netBuf) == -1) {
261: LOGERR;
262: close(cli->cli_sock);
263: return -1;
264: }
265: if (cli->cli_id == SOCK_STREAM)
266: if (connect(cli->cli_sock, &cli->cli_sa.sa, cli->cli_sa.sa.sa_len) == -1) {
267: LOGERR;
268: close(cli->cli_sock);
269: return -1;
270: }
271:
272: fcntl(cli->cli_sock, F_SETFL, fcntl(cli->cli_sock, F_GETFL) | O_NONBLOCK);
273: return 0;
274: }
275:
276: /*
277: * rpc_cli_closeClient() - Close connection to RPC server and free resources
278: *
279: * @cli = RPC Client session
280: * return: none
281: */
282: void
283: rpc_cli_closeClient(rpc_cli_t ** __restrict cli)
284: {
285: if (!cli || !*cli || (*cli)->cli_id == SOCK_BPF)
286: return;
287:
288: if ((*cli)->cli_id == SOCK_STREAM)
289: shutdown((*cli)->cli_sock, SHUT_RDWR);
290: close((*cli)->cli_sock);
291:
292: AIT_FREE_VAL(&(*cli)->cli_buf);
293:
294: if ((*cli)->cli_parent)
295: e_free((*cli)->cli_parent);
296:
297: e_free(*cli);
298: *cli = NULL;
299: }
300:
301: /*
302: * rpc_pkt_Send() - Send RPC packet
303: *
304: * @sock = Socket
305: * @type = Type of socket
306: * @sa = Server address
307: * @pkt = RPC packet
308: * @len = Length of packet
309: * return: -1 error, 0 EOF or >0 sended bytes
310: */
311: int
312: rpc_pkt_Send(int sock, int type, sockaddr_t * __restrict sa, ait_val_t * __restrict pkt, int len)
313: {
314: u_char *buf;
315:
316: if (!pkt) {
317: rpc_SetErr(EINVAL, "Invalid argument(s)!");
318: return -1;
319: } else
320: buf = AIT_GET_BUF(pkt);
321:
322: return rpc_Write(sock, type, MSG_NOSIGNAL, sa, buf, len);
323: }
324:
325: /*
326: * rpc_pkt_Receive() - Receive RPC packet
327: *
328: * @sock = Socket
329: * @type = Type of socket
330: * @sa = Server address
331: * @pkt = RPC packet
332: * return: -1 error, 0 EOF or >0 received bytes
333: */
334: int
335: rpc_pkt_Receive(int sock, int type, sockaddr_t * __restrict sa, ait_val_t * __restrict pkt)
336: {
337: int ret, estlen = 0, blen = sizeof(struct tagRPCCall);
338: u_char *buf;
339: struct tagRPCCall *rpc;
340:
341: if (!pkt) {
342: rpc_SetErr(EINVAL, "Invalid argument(s)!");
343: return -1;
344: } else {
345: buf = AIT_GET_BUF(pkt);
346: rpc = (struct tagRPCCall*) buf;
347: }
348:
349: /* reply from RPC server */
350: do {
351: if (type == SOCK_STREAM)
352: ret = rpc_Read(sock, type, !estlen ? MSG_PEEK : 0, NULL, buf, blen);
353: else if (type == SOCK_BPF) {
354: ret = rpc_Read(sock, type, 0, sa, AIT_GET_BUF(pkt), AIT_LEN(pkt));
355: if (ret > 0)
356: estlen = ret;
357: } else
358: ret = rpc_Read(sock, type, !estlen ? MSG_PEEK : 0, sa, buf, blen);
359: if (ret < 1)
360: return ret;
361:
362: /* check for response from known address */
363: if (!estlen) {
364: /* 1st read for RPC header */
365: if (ret < sizeof(struct tagRPCCall)) {
366: rpc_SetErr(ERPCMISMATCH, "Short RPC packet %d bytes", ret);
367: return -1;
368: }
369:
370: /* calc estimated length */
371: estlen = ntohl(rpc->call_len);
372: if (estlen > AIT_LEN(pkt))
373: AIT_RE_BUF(pkt, estlen);
374: buf = AIT_GET_BUF(pkt);
375: rpc = (struct tagRPCCall*) buf;
376: blen = estlen;
377: continue;
378: }
379:
380: /* compiler optimize loop if while(0) and stop working 'continue' on some platforms */
381: break;
382: } while (42);
383:
384: if (ret < sizeof(struct tagRPCCall) || estlen != ret) {
385: rpc_SetErr(ERPCMISMATCH, "RPC packet mismatch estimate %d bytes, but received %d\n",
386: estlen, ret);
387: return -1;
388: }
389:
390: return ret;
391: }
392:
393: /*
394: * rpc_pkt_Request() - Build RPC Request packet
395: *
396: * @pkt = Packet buffer
397: * @sess = RPC session info
398: * @tag = Function tag for execution
399: * @vars = Function argument array of values, may be NULL
400: * @noreply = We not want RPC reply
401: * @nocrc = Without CRC calculation
402: * return: -1 error or != -1 prepared bytes into packet
403: */
404: int
405: rpc_pkt_Request(ait_val_t * __restrict pkt, rpc_sess_t * __restrict sess, u_short tag,
406: array_t * __restrict vars, int noreply, int nocrc)
407: {
408: struct tagRPCCall *rpc;
409: int ret = 0, estlen, len = sizeof(struct tagRPCCall);
410: u_char *buf;
411:
412: if (!pkt || !sess) {
413: rpc_SetErr(EINVAL, "Invalid argument(s)!");
414: return -1;
415: }
416:
417: /* calc estimated length */
418: estlen = ait_resideVars(vars) + len;
419: if (estlen > AIT_LEN(pkt))
420: AIT_RE_BUF(pkt, estlen);
421: buf = AIT_GET_BUF(pkt);
422:
423: /* prepare RPC call */
424: rpc = (struct tagRPCCall*) buf;
425: rpc_addPktSession(&rpc->call_session, sess);
426: rpc->call_tag = htons(tag);
427: if (!vars)
428: rpc->call_argc = 0;
429: else
430: rpc->call_argc = htons(array_Size(vars));
431:
432: /* set reply */
433: rpc->call_req.flags = (uint64_t) htonl(noreply ? RPC_NOREPLY : RPC_REPLY);
434:
435: if (array_Size(vars)) {
436: /* marshaling variables */
437: ret = ait_vars2buffer(buf + len, AIT_LEN(pkt) - len, vars);
438: if (ret == -1) {
439: rpc_SetErr(EBADRPC, "Failed to prepare RPC packet values");
440: return -1;
441: } else
442: len += ret;
443: }
444:
445: /* total packet length */
446: rpc->call_len = htonl(len);
447:
448: if (!nocrc) {
449: /* calculate CRC */
450: rpc->call_crc ^= rpc->call_crc;
451: rpc->call_crc = htons(crcFletcher16((u_short*) buf, len / 2));
452: }
453:
454: return len;
455: }
456:
457: /*
458: * rpc_pkt_Replay() - Decode RPC Replay packet
459: *
460: * @pkt = Packet buffer
461: * @sess = RPC session info, if =NULL don't check session
462: * @tag = Function tag
463: * @vars = Function argument array of values, may be NULL
464: * @nocrc = Without CRC calculation
465: * return: -1 error or != -1 return value from function
466: */
467: int
468: rpc_pkt_Replay(ait_val_t * __restrict pkt, rpc_sess_t * __restrict sess, u_short tag,
469: array_t ** __restrict vars, int nocrc)
470: {
471: struct tagRPCCall *rpc;
472: int len;
473: u_char *buf;
474: uint16_t crc;
475:
476: if (!pkt) {
477: rpc_SetErr(EINVAL, "Invalid argument(s)!");
478: return -1;
479: } else
480: buf = AIT_GET_BUF(pkt);
481:
482: rpc = (struct tagRPCCall*) buf;
483: if (!nocrc) {
484: /* calculate CRC */
485: crc = ntohs(rpc->call_crc);
486: rpc->call_crc ^= rpc->call_crc;
487: if (crc != crcFletcher16((u_short*) buf, ntohl(rpc->call_len) / 2)) {
488: rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet");
489: return -1;
490: }
491: }
492:
493: /* check RPC packet session info */
494: if (sess && rpc_chkPktSession(&rpc->call_session, sess)) {
495: rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session");
496: return -1;
497: }
498: if (ntohs(rpc->call_tag) != tag) {
499: rpc_SetErr(ERPCMISMATCH, "Get wrong RPC reply");
500: return -1;
501: }
502: if (ntohl(rpc->call_rep.eno) && ntohl(rpc->call_rep.ret) == -1) {
503: rpc_SetErr(ntohl(rpc->call_rep.eno), "Server side: retcode=%d #%d %s",
504: ntohl(rpc->call_rep.ret), ntohl(rpc->call_rep.eno),
505: strerror(ntohl(rpc->call_rep.eno)));
506: return -1;
507: }
508: len = ntohs(rpc->call_argc) * sizeof(ait_val_t);
509: if (len > AIT_LEN(pkt) - sizeof(struct tagRPCCall)) {
510: rpc_SetErr(EMSGSIZE, "Reply RPC packet not enough buffer space ...");
511: return -1;
512: }
513: if (len > ntohl(rpc->call_len) - sizeof(struct tagRPCCall)) {
514: rpc_SetErr(EMSGSIZE, "Reply RPC packet is too short ...");
515: return -1;
516: }
517:
518: /* RPC is OK! Go de-marshaling variables ... */
519: if (vars && ntohs(rpc->call_argc)) {
520: #ifdef CLI_RES_ZCOPY
521: *vars = ait_buffer2vars(buf + sizeof(struct tagRPCCall), len,
522: ntohs(rpc->call_argc), 42);
523: #else
524: *vars = ait_buffer2vars(buf + sizeof(struct tagRPCCall), len,
525: ntohs(rpc->call_argc), 0);
526: #endif
527: if (!*vars) {
528: rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError());
529: return -1;
530: }
531: }
532:
533: return ntohl(rpc->call_rep.ret);
534: }
535:
536: /*
537: * rpc_cli_execCall() - Execute RPC call
538: *
539: * @cli = RPC Client session
540: * @noreply = We not want RPC reply
541: * @tag = Function tag for execution
542: * @in_vars = IN function argument array of values, may be NULL
543: * @out_vars = OUT returned array of rpc values, if !=NULL must be free after use with ait_freeVars()
544: * return: -1 error, 0 ok result or 1 closed rpc connection
545: */
546: int
547: rpc_cli_execCall(rpc_cli_t *cli, int noreply, u_short tag,
548: array_t * __restrict in_vars, array_t ** __restrict out_vars)
549: {
550: int type = 0, wlen;
551: u_char *buf;
552:
553: if (!cli) {
554: rpc_SetErr(EINVAL, "Can`t execute call because parameter is null or invalid!");
555: return -1;
556: } else {
557: if (cli->cli_id == SOCK_STREAM)
558: type = cli->cli_id;
559: buf = AIT_GET_BUF(&cli->cli_buf);
560: }
561: if (out_vars)
562: *out_vars = NULL;
563:
564: if ((wlen = rpc_pkt_Request(&cli->cli_buf, cli->cli_parent, tag, in_vars, noreply, type)) == -1)
565: return -1;
566:
567: if ((wlen = rpc_pkt_Send(cli->cli_sock, cli->cli_id, &cli->cli_sa, &cli->cli_buf, wlen)) == -1)
568: return -1;
569: if (!wlen) /* closed rpc connection */
570: return 1;
571:
572: if (noreply) /* we not want reply */
573: return 0;
574:
575: if ((wlen = rpc_pkt_Receive(cli->cli_sock, cli->cli_id, &cli->cli_sa, &cli->cli_buf)) == -1)
576: return -1;
577: if (!wlen) /* closed rpc connection */
578: return 1;
579:
580: if ((wlen = rpc_pkt_Replay(&cli->cli_buf, cli->cli_parent, tag, out_vars, type)) == -1)
581: return -1;
582:
583: return 0;
584: }
585:
586: /*
587: * rpc_cli_freeCall() - Free resouce allocated by RPC call
588: *
589: * @out_vars = Returned array with variables from RPC call
590: * return: none
591: */
592: void
593: rpc_cli_freeCall(array_t ** __restrict out_vars)
594: {
595: #ifdef CLI_RES_ZCOPY
596: array_Destroy(out_vars);
597: #else
598: ait_freeVars(out_vars);
599: #endif
600: }
601:
602: /*
603: * rpc_cli_ping() - Ping RPC server
604: *
605: * @cli = connected client
606: * return: -1 error or !=-1 ping seq id
607: */
608: int
609: rpc_cli_ping(rpc_cli_t *cli)
610: {
611: int ret = 0;
612: array_t *arr = NULL;
613:
614: if (!cli)
615: return -1;
616:
617: if (rpc_cli_execCall(cli, RPC_REPLY, CALL_SRVPING, NULL, &arr))
618: return -1;
619: else
620: ret = AIT_GET_U16(array(arr, 0, ait_val_t*));
621: rpc_cli_freeCall(&arr);
622:
623: return ret;
624: }
625:
626:
627: /*
628: * rpc_cli_openClient2() - Connect to layer2 RPC Server
629: *
630: * @InstID = InstID for RPC session request
631: * @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet)
632: * @csIface = Interface name for bind client, if NULL first interface on host
633: * @csHost = Host ethernet address
634: * return: NULL == error or !=NULL connection to RPC server established
635: */
636: rpc_cli_t *
637: rpc_cli_openClient2(u_char InstID, int netBuf, const char *csIface, const char *csHost)
638: {
639: rpc_cli_t *cli = NULL;
640: sockaddr_t sa = E_SOCKADDR_INIT, sal = E_SOCKADDR_INIT;
641: char szIface[64], szStr[STRSIZ];
642: register int i;
643: struct ifreq ifr;
644: int n = 1;
645: struct bpf_insn insns[] = {
646: BPF_STMT(BPF_LD + BPF_H + BPF_ABS, 12),
647: BPF_JUMP(BPF_JMP + BPF_JEQ + BPF_K, RPC_DEFPORT, 0, 1),
648: BPF_STMT(BPF_RET + BPF_K, -1),
649: BPF_STMT(BPF_RET + BPF_K, 0),
650: };
651: struct bpf_program fcode = {
652: .bf_len = sizeof(insns) / sizeof(struct bpf_insn),
653: .bf_insns = insns
654: };
655:
656: if (!csHost || !e_getlinkbyname(csHost, &sa))
657: return NULL;
658: if (!csIface) {
659: if (e_get1stiface(szIface, sizeof szIface))
660: return NULL;
661: } else
662: strlcpy(szIface, csIface, sizeof szIface);
663: if (!e_getifacebyname(szIface, &sal))
664: return NULL;
665:
666: cli = e_malloc(sizeof(rpc_cli_t));
667: if (!cli) {
668: LOGERR;
669: return NULL;
670: } else
671: memset(cli, 0, sizeof(rpc_cli_t));
672:
673: /* build session */
674: cli->cli_parent = e_malloc(sizeof(rpc_sess_t));
675: if (!cli->cli_parent) {
676: LOGERR;
677: e_free(cli);
678: return NULL;
679: } else {
680: ((rpc_sess_t*) cli->cli_parent)->sess_version = RPC_VERSION;
681: ((rpc_sess_t*) cli->cli_parent)->sess_instance = InstID;
682: }
683:
684: cli->cli_id = SOCK_BPF;
685: memcpy(&cli->cli_sa, &sa, sizeof cli->cli_sa);
686:
687: /* connect to RPC server */
688: for (i = 0; i < 10; i++) {
689: memset(szStr, 0, sizeof szStr);
690: snprintf(szStr, sizeof szStr, "/dev/bpf%d", i);
691: cli->cli_sock = open(szStr, O_RDWR);
692: if (cli->cli_sock > STDERR_FILENO)
693: break;
694: }
695: if (cli->cli_sock < 3) {
696: LOGERR;
697: e_free(cli->cli_parent);
698: e_free(cli);
699: return NULL;
700: }
701:
702: if (ioctl(cli->cli_sock, BIOCIMMEDIATE, &n) == -1) {
703: LOGERR;
704: goto err;
705: }
706: if (ioctl(cli->cli_sock, BIOCSETF, &fcode) == -1) {
707: LOGERR;
708: goto err;
709: }
710: n = (netBuf < RPC_MIN_BUFSIZ) ? getpagesize() : E_ALIGN(netBuf, 2);
711: if (ioctl(cli->cli_sock, BIOCSBLEN, &n) == -1) {
712: LOGERR;
713: goto err;
714: } else
715: AIT_SET_BUFSIZ(&cli->cli_buf, 0, n);
716:
717: memset(&ifr, 0, sizeof ifr);
718: strlcpy(ifr.ifr_name, szIface, sizeof ifr.ifr_name);
719: if (ioctl(cli->cli_sock, BIOCSETIF, &ifr) == -1) {
720: LOGERR;
721: goto err;
722: } else
723: fcntl(cli->cli_sock, F_SETFL,
724: fcntl(cli->cli_sock, F_GETFL) | O_NONBLOCK);
725:
726: return cli;
727: err:
728: AIT_FREE_VAL(&cli->cli_buf);
729: if (cli->cli_sock > 2)
730: close(cli->cli_sock);
731: e_free(cli->cli_parent);
732: e_free(cli);
733: return NULL;
734: }
735:
736: /*
737: * rpc_cli_closeClient2() - Close layer2 connection to RPC server and free resources
738: *
739: * @cli = RPC Client session
740: * return: none
741: */
742: void
743: rpc_cli_closeClient2(rpc_cli_t ** __restrict cli)
744: {
745: if (!cli || !*cli || (*cli)->cli_id != SOCK_BPF)
746: return;
747:
748: close((*cli)->cli_sock);
749:
750: AIT_FREE_VAL(&(*cli)->cli_buf);
751:
752: if ((*cli)->cli_parent)
753: e_free((*cli)->cli_parent);
754:
755: e_free(*cli);
756: *cli = NULL;
757: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>