version 1.21, 2013/11/14 21:44:14
|
version 1.25, 2015/01/21 21:17:05
|
Line 12 terms:
|
Line 12 terms:
|
All of the documentation and software included in the ELWIX and AITNET |
All of the documentation and software included in the ELWIX and AITNET |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
Releases is copyrighted by ELWIX - Sofia/Bulgaria <info@elwix.org> |
|
|
Copyright 2004, 2005, 2006, 2007, 2008, 2009, 2010, 2011, 2012, 2013 | Copyright 2004 - 2015 |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
by Michael Pounov <misho@elwix.org>. All rights reserved. |
|
|
Redistribution and use in source and binary forms, with or without |
Redistribution and use in source and binary forms, with or without |
Line 59 static void *txUDPPacket(sched_task_t *);
|
Line 59 static void *txUDPPacket(sched_task_t *);
|
|
|
/* SOCK_RAW */ |
/* SOCK_RAW */ |
|
|
static sched_task_func_t cbProto[SOCK_RAW + 1][4] = { | /* SOCK_BPF */ |
| static void *rxBPFPacket(sched_task_t *); |
| static void *txBPFPacket(sched_task_t *); |
| |
| /* SOCK_EXT */ |
| static void *rxEXTPacket(sched_task_t *); |
| static void *txEXTPacket(sched_task_t *); |
| |
| static sched_task_func_t cbProto[SOCK_MAX_SUPPORT][4] = { |
{ acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ |
{ acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ |
{ acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ |
{ acceptClients, closeClient, rxPacket, txPacket }, /* SOCK_STREAM */ |
{ rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket }, /* SOCK_DGRAM */ |
{ rxUDPPacket, freeClient, rxUDPPacket, txUDPPacket }, /* SOCK_DGRAM */ |
{ NULL, NULL, NULL, NULL } /* SOCK_RAW */ | { NULL, NULL, NULL, NULL }, /* SOCK_RAW */ |
| { rxBPFPacket, freeClient, rxBPFPacket, txBPFPacket }, /* SOCK_BPF */ |
| { rxEXTPacket, freeClient, rxEXTPacket, txEXTPacket } /* SOCK_EXT */ |
}; |
}; |
|
|
|
/* Global Signal Argument when kqueue support disabled */ |
|
|
|
static volatile uintptr_t _glSigArg = 0; |
|
|
|
|
void |
void |
rpc_freeCli(rpc_cli_t * __restrict c) |
rpc_freeCli(rpc_cli_t * __restrict c) |
{ |
{ |
Line 107 _allocClient(rpc_srv_t * __restrict srv, sockaddr_t *
|
Line 121 _allocClient(rpc_srv_t * __restrict srv, sockaddr_t *
|
rpc_cli_t *c = NULL; |
rpc_cli_t *c = NULL; |
int n; |
int n; |
|
|
n = _check4freeslot(srv, sa); | if (srv->srv_proto != SOCK_EXT) |
| n = _check4freeslot(srv, sa); |
| else |
| n = 0; |
if (n == -1) |
if (n == -1) |
return NULL; |
return NULL; |
else |
else |
Line 189 txPacket(sched_task_t *task)
|
Line 206 txPacket(sched_task_t *task)
|
buf = AIT_GET_BUF(&c->cli_buf); |
buf = AIT_GET_BUF(&c->cli_buf); |
rpc = (struct tagRPCCall*) buf; |
rpc = (struct tagRPCCall*) buf; |
|
|
rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); | rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); |
/* Go Encapsulate variables */ |
/* Go Encapsulate variables */ |
ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
RPC_RETVARS(c)); |
RPC_RETVARS(c)); |
Line 207 txPacket(sched_task_t *task)
|
Line 224 txPacket(sched_task_t *task)
|
} |
} |
|
|
rpc->call_len = htonl(wlen); |
rpc->call_len = htonl(wlen); |
|
rpc->call_io = RPC_ACK; |
|
|
#if 0 |
#if 0 |
/* calculate CRC */ |
/* calculate CRC */ |
Line 223 txPacket(sched_task_t *task)
|
Line 241 txPacket(sched_task_t *task)
|
if (ret) |
if (ret) |
LOGERR; |
LOGERR; |
else |
else |
rpc_SetErr(ETIMEDOUT, "Timeout reached! Server not respond"); | rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond"); |
/* close connection */ |
/* close connection */ |
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
TASK_ARG(task), 0, NULL, 0); |
TASK_ARG(task), 0, NULL, 0); |
Line 250 execCall(sched_task_t *task)
|
Line 268 execCall(sched_task_t *task)
|
array_t *arr = NULL; |
array_t *arr = NULL; |
u_char *buf = AIT_GET_BUF(&c->cli_buf); |
u_char *buf = AIT_GET_BUF(&c->cli_buf); |
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
int argc = ntohs(rpc->call_argc); | int argc = rpc->call_argc; |
|
|
/* Go decapsulate variables ... */ |
/* Go decapsulate variables ... */ |
if (argc) { |
if (argc) { |
Line 291 execCall(sched_task_t *task)
|
Line 309 execCall(sched_task_t *task)
|
rpc->call_argc ^= rpc->call_argc; |
rpc->call_argc ^= rpc->call_argc; |
} else { |
} else { |
/* reply */ |
/* reply */ |
rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); | rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); |
} |
} |
} |
} |
} |
} |
Line 346 rxPacket(sched_task_t *task)
|
Line 364 rxPacket(sched_task_t *task)
|
if (rlen) |
if (rlen) |
LOGERR; |
LOGERR; |
else |
else |
rpc_SetErr(ETIMEDOUT, "Timeout reached! Server not respond"); | rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond"); |
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
TASK_ARG(task), 0, NULL, 0); |
TASK_ARG(task), 0, NULL, 0); |
return NULL; |
return NULL; |
Line 359 rxPacket(sched_task_t *task)
|
Line 377 rxPacket(sched_task_t *task)
|
return NULL; |
return NULL; |
} |
} |
} |
} |
|
len = estlen; |
|
|
|
/* skip loop packet */ |
|
if (rpc->call_io & RPC_ACK) { |
|
schedReadSelf(task); |
|
return NULL; |
|
} |
|
|
#if 0 |
#if 0 |
/* check integrity of packet */ |
/* check integrity of packet */ |
crc = ntohs(rpc->call_crc); |
crc = ntohs(rpc->call_crc); |
Line 447 txUDPPacket(sched_task_t *task)
|
Line 472 txUDPPacket(sched_task_t *task)
|
rpc_func_t *f = NULL; |
rpc_func_t *f = NULL; |
u_char *buf = AIT_GET_BUF(&c->cli_buf); |
u_char *buf = AIT_GET_BUF(&c->cli_buf); |
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
int ret, wlen = sizeof(struct tagRPCCall); | int ret, estlen, wlen = sizeof(struct tagRPCCall); |
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
|
struct pollfd pfd; |
|
|
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); |
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); |
schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
Line 462 txUDPPacket(sched_task_t *task)
|
Line 488 txUDPPacket(sched_task_t *task)
|
rpc->call_rep.ret = RPC_ERROR(-1); |
rpc->call_rep.ret = RPC_ERROR(-1); |
rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
} else { |
} else { |
rpc->call_argc = htons(array_Size(RPC_RETVARS(c))); | /* calc estimated length */ |
| estlen = ait_resideVars(RPC_RETVARS(c)) + wlen; |
| if (estlen > AIT_LEN(&c->cli_buf)) |
| AIT_RE_BUF(&c->cli_buf, estlen); |
| buf = AIT_GET_BUF(&c->cli_buf); |
| rpc = (struct tagRPCCall*) buf; |
| |
| rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); |
/* Go Encapsulate variables */ |
/* Go Encapsulate variables */ |
ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
RPC_RETVARS(c)); |
RPC_RETVARS(c)); |
Line 479 txUDPPacket(sched_task_t *task)
|
Line 512 txUDPPacket(sched_task_t *task)
|
} |
} |
|
|
rpc->call_len = htonl(wlen); |
rpc->call_len = htonl(wlen); |
|
rpc->call_io = RPC_ACK; |
|
|
/* calculate CRC */ |
/* calculate CRC */ |
rpc->call_crc ^= rpc->call_crc; |
rpc->call_crc ^= rpc->call_crc; |
rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2)); |
rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2)); |
|
|
/* send reply */ |
/* send reply */ |
ret = sendto(TASK_FD(task), buf, wlen, MSG_NOSIGNAL, | pfd.fd = TASK_FD(task); |
&c->cli_sa.sa, c->cli_sa.sa.sa_len); | pfd.events = POLLOUT; |
if (ret == -1 || ret != wlen) { | for (; wlen > 0; wlen -= ret, buf += ret) { |
/* close connection */ | if ((ret = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || |
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], | pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { |
TASK_ARG(task), 0, NULL, 0); | if (ret) |
| LOGERR; |
| else |
| rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond"); |
| /* close connection */ |
| schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
| TASK_ARG(task), 0, NULL, 0); |
| return NULL; |
| } |
| ret = sendto(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf), MSG_NOSIGNAL, |
| &c->cli_sa.sa, c->cli_sa.sa.sa_len); |
| if (ret == -1) { |
| /* close connection */ |
| schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
| TASK_ARG(task), 0, NULL, 0); |
| return NULL; |
| } |
} |
} |
|
|
return NULL; |
return NULL; |
Line 501 rxUDPPacket(sched_task_t *task)
|
Line 551 rxUDPPacket(sched_task_t *task)
|
{ |
{ |
rpc_srv_t *srv = TASK_ARG(task); |
rpc_srv_t *srv = TASK_ARG(task); |
rpc_cli_t *c = NULL; |
rpc_cli_t *c = NULL; |
int len, rlen, noreply; | int len, rlen, noreply, estlen; |
u_short crc, off = 0; | u_short crc; |
u_char buf[USHRT_MAX + 1]; | u_char *buf, b[sizeof(struct tagRPCCall)]; |
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; | struct tagRPCCall *rpc = (struct tagRPCCall*) b; |
sockaddr_t sa; |
sockaddr_t sa; |
socklen_t salen; |
socklen_t salen; |
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
|
struct pollfd pfd; |
|
|
/* receive connect packet */ |
/* receive connect packet */ |
salen = sa.ss.ss_len = sizeof(sockaddr_t); |
salen = sa.ss.ss_len = sizeof(sockaddr_t); |
rlen = recvfrom(TASK_FD(task), buf, sizeof buf, 0, &sa.sa, &salen); | rlen = recvfrom(TASK_FD(task), b, sizeof b, MSG_PEEK, &sa.sa, &salen); |
if (rlen < 1) | if (rlen < sizeof(struct tagRPCCall)) { |
| rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); |
goto end; |
goto end; |
|
} |
|
|
c = _allocClient(srv, &sa); |
c = _allocClient(srv, &sa); |
if (!c) | if (!c) { |
| EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); |
| usleep(2000); /* blocked client delay */ |
goto end; |
goto end; |
else { | } else { |
| estlen = ntohl(rpc->call_len); |
| if (estlen > AIT_LEN(&c->cli_buf)) |
| AIT_RE_BUF(&c->cli_buf, estlen); |
| rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); |
| buf = AIT_GET_BUF(&c->cli_buf); |
| len = estlen; |
| |
c->cli_sock = TASK_FD(task); |
c->cli_sock = TASK_FD(task); |
memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); |
memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); |
memcpy(AIT_GET_BUF(&c->cli_buf), buf, AIT_LEN(&c->cli_buf)); | |
/* armed timer for close stateless connection */ |
/* armed timer for close stateless connection */ |
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); |
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); |
schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
c, ts, c, 0); |
c, ts, c, 0); |
} |
} |
|
|
do { | /* get next part of packet */ |
/* check RPC packet */ | memset(buf, 0, len); |
if (rlen < sizeof(struct tagRPCCall)) { | pfd.fd = TASK_FD(task); |
rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); | pfd.events = POLLIN | POLLPRI; |
break; | for (; len > 0; len -= rlen, buf += rlen) { |
} else | if ((rlen = poll(&pfd, 1, DEF_RPC_TIMEOUT * 1000)) < 1 || |
rpc = (struct tagRPCCall*) (AIT_GET_BUF(&c->cli_buf) + off); | pfd.revents & (POLLERR | POLLHUP | POLLNVAL)) { |
| if (rlen) |
| LOGERR; |
| else |
| rpc_SetErr(ETIMEDOUT, "Timeout reached! Client not respond"); |
| schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
| c, 0, NULL, 0); |
| goto end; |
| } |
| salen = sa.ss.ss_len = sizeof(sockaddr_t); |
| rlen = recvfrom(TASK_FD(task), buf, len, 0, &sa.sa, &salen); |
| if (rlen == -1) { |
| /* close connection */ |
| schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
| c, 0, NULL, 0); |
| goto end; |
| } |
| if (e_addrcmp(&c->cli_sa, &sa, 42)) |
| rlen ^= rlen; /* skip if arrive from different address */ |
| } |
| len = estlen; |
|
|
len = ntohl(rpc->call_len); | /* skip loop packet */ |
rlen -= len; | if (rpc->call_io & RPC_ACK) |
| goto end; |
|
|
/* check RPC packet lengths */ | /* check integrity of packet */ |
if (rlen < 0 || len < sizeof(struct tagRPCCall)) { | crc = ntohs(rpc->call_crc); |
rpc_SetErr(ERPCMISMATCH, "Broken RPC packet length"); | rpc->call_crc ^= rpc->call_crc; |
/* skip entire packet */ | if (crc != crcFletcher16((u_short*) rpc, len / 2)) { |
break; | rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet"); |
} | /* close connection */ |
| schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
| c, 0, NULL, 0); |
| goto end; |
| } |
|
|
/* check integrity of packet */ | noreply = RPC_CHK_NOREPLY(rpc); |
crc = ntohs(rpc->call_crc); | |
rpc->call_crc ^= rpc->call_crc; | |
if (crc != crcFletcher16((u_short*) rpc, len / 2)) { | |
rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet"); | |
|
|
off += len; | /* check RPC packet session info */ |
/* try next packet remaining into buffer */ | if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) { |
continue; | rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session"); |
| |
| rpc->call_argc ^= rpc->call_argc; |
| rpc->call_rep.ret = RPC_ERROR(-1); |
| rpc->call_rep.eno = RPC_ERROR(errno); |
| } else { |
| /* execute RPC call */ |
| schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); |
| } |
| |
| /* send RPC reply */ |
| if (!noreply) |
| schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], |
| c, TASK_FD(task), rpc, len); |
| end: |
| schedReadSelf(task); |
| return NULL; |
| } |
| |
| |
| static void * |
| txBPFPacket(sched_task_t *task) |
| { |
| rpc_cli_t *c = TASK_ARG(task); |
| rpc_srv_t *s = c->cli_parent; |
| rpc_func_t *f = NULL; |
| u_char *buf = AIT_GET_BUF(&c->cli_buf); |
| struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
| int ret, len, wlen = sizeof(struct tagRPCCall); |
| struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
| struct ether_header *eh; |
| ait_val_t b = AIT_VAL_INIT; |
| |
| schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); |
| schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
| TASK_ARG(task), ts, TASK_ARG(task), 0); |
| |
| if (rpc->call_argc) { |
| f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); |
| if (!f) { |
| rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server"); |
| rpc->call_argc ^= rpc->call_argc; |
| rpc->call_rep.ret = RPC_ERROR(-1); |
| rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
| } else { |
| /* calc estimated length */ |
| len = ait_resideVars(RPC_RETVARS(c)) + wlen; |
| if (len > AIT_LEN(&c->cli_buf)) |
| AIT_RE_BUF(&c->cli_buf, len); |
| buf = AIT_GET_BUF(&c->cli_buf); |
| rpc = (struct tagRPCCall*) buf; |
| |
| rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); |
| /* Go Encapsulate variables */ |
| ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
| RPC_RETVARS(c)); |
| /* Free return values */ |
| ait_freeVars(&RPC_RETVARS(c)); |
| if (ret == -1) { |
| rpc_SetErr(EBADRPC, "Prepare RPC packet failed"); |
| rpc->call_argc ^= rpc->call_argc; |
| rpc->call_rep.ret = RPC_ERROR(-1); |
| rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
| } else |
| wlen += ret; |
} |
} |
|
} |
|
|
noreply = RPC_CHK_NOREPLY(rpc); | rpc->call_len = htonl(wlen); |
| rpc->call_io = RPC_ACK; |
|
|
/* check RPC packet session info */ | /* calculate CRC */ |
if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) { | rpc->call_crc ^= rpc->call_crc; |
rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session"); | rpc->call_crc = htons(crcFletcher16((u_short*) buf, wlen / 2)); |
|
|
|
/* send reply */ |
|
AIT_SET_BUF(&b, NULL, MIN(wlen, s->srv_netbuf) + ETHER_HDR_LEN); |
|
eh = (struct ether_header*) AIT_GET_BUF(&b); |
|
memcpy(eh->ether_dhost, LLADDR(&c->cli_sa.sdl), ETHER_ADDR_LEN); |
|
eh->ether_type = htons(RPC_DEFPORT); |
|
memcpy(eh + 1, buf, MIN(wlen, s->srv_netbuf)); |
|
|
|
ret = write(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); |
|
AIT_FREE_VAL(&b); |
|
if (ret == -1) { |
|
/* close connection */ |
|
schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
|
TASK_ARG(task), 0, NULL, 0); |
|
return NULL; |
|
} |
|
|
|
return NULL; |
|
} |
|
|
|
static void * |
|
rxBPFPacket(sched_task_t *task) |
|
{ |
|
rpc_srv_t *srv = TASK_ARG(task); |
|
rpc_cli_t *c = NULL; |
|
int len, rlen, noreply; |
|
u_short crc; |
|
struct tagRPCCall *rpc; |
|
sockaddr_t sa; |
|
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
|
struct bpf_hdr *h; |
|
struct ether_header *eh; |
|
ait_val_t b = AIT_VAL_INIT; |
|
|
|
/* receive connect packet */ |
|
AIT_SET_BUF(&b, NULL, srv->srv_netbuf); |
|
rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); |
|
h = (struct bpf_hdr*) AIT_GET_BUF(&b); |
|
rlen -= h->bh_hdrlen; |
|
if (rlen < h->bh_datalen || h->bh_caplen != h->bh_datalen || |
|
rlen < ETHER_HDR_LEN + sizeof(struct tagRPCCall)) { |
|
rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); |
|
goto end; |
|
} else { |
|
rlen = h->bh_caplen; |
|
eh = (struct ether_header*) (AIT_GET_BUF(&b) + h->bh_hdrlen); |
|
rlen -= ETHER_HDR_LEN; |
|
rpc = (struct tagRPCCall*) (eh + 1); |
|
|
|
#if 0 |
|
/* skip loop packet */ |
|
if (rpc->call_io & RPC_ACK) |
|
goto end; |
|
#endif |
|
|
|
if (eh->ether_type != ntohs(RPC_DEFPORT)) |
|
goto end; |
|
else |
|
e_getlinkbymac((const ether_addr_t*) eh->ether_shost, &sa); |
|
} |
|
|
|
c = _allocClient(srv, &sa); |
|
if (!c) { |
|
EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); |
|
usleep(2000); /* blocked client delay */ |
|
goto end; |
|
} else { |
|
len = ntohl(rpc->call_len); |
|
if (len > AIT_LEN(&c->cli_buf)) |
|
AIT_RE_BUF(&c->cli_buf, len); |
|
memcpy(AIT_GET_BUF(&c->cli_buf), rpc, AIT_LEN(&c->cli_buf)); |
|
rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); |
|
|
|
c->cli_sock = TASK_FD(task); |
|
memcpy(&c->cli_sa, &sa, sizeof c->cli_sa); |
|
|
|
/* armed timer for close stateless connection */ |
|
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); |
|
schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
|
c, ts, c, 0); |
|
} |
|
|
|
/* check integrity of packet */ |
|
crc = ntohs(rpc->call_crc); |
|
rpc->call_crc ^= rpc->call_crc; |
|
if (crc != crcFletcher16((u_short*) rpc, len / 2)) { |
|
rpc_SetErr(ERPCMISMATCH, "Bad CRC RPC packet"); |
|
/* close connection */ |
|
schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
|
c, 0, NULL, 0); |
|
goto end; |
|
} |
|
|
|
noreply = RPC_CHK_NOREPLY(rpc); |
|
|
|
/* check RPC packet session info */ |
|
if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) { |
|
rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session"); |
|
|
|
rpc->call_argc ^= rpc->call_argc; |
|
rpc->call_rep.ret = RPC_ERROR(-1); |
|
rpc->call_rep.eno = RPC_ERROR(errno); |
|
} else { |
|
/* execute RPC call */ |
|
schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); |
|
} |
|
|
|
/* send RPC reply */ |
|
if (!noreply) |
|
schedEvent(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], |
|
c, TASK_FD(task), rpc, len); |
|
end: |
|
AIT_FREE_VAL(&b); |
|
schedReadSelf(task); |
|
return NULL; |
|
} |
|
|
|
|
|
static void * |
|
txEXTPacket(sched_task_t *task) |
|
{ |
|
rpc_cli_t *c = TASK_ARG(task); |
|
rpc_srv_t *s = c->cli_parent; |
|
rpc_func_t *f = NULL; |
|
u_char *buf = AIT_GET_BUF(&c->cli_buf); |
|
struct tagRPCCall *rpc = (struct tagRPCCall*) buf; |
|
int ret, len, wlen = sizeof(struct tagRPCCall); |
|
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
|
|
|
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, TASK_ARG(task), NULL); |
|
schedTimer(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
|
TASK_ARG(task), ts, TASK_ARG(task), 0); |
|
|
|
if (rpc->call_argc) { |
|
f = rpc_srv_getCall(s, ntohs(rpc->call_tag)); |
|
if (!f) { |
|
rpc_SetErr(EPROGUNAVAIL, "Function not found at RPC server"); |
rpc->call_argc ^= rpc->call_argc; |
rpc->call_argc ^= rpc->call_argc; |
rpc->call_rep.ret = RPC_ERROR(-1); |
rpc->call_rep.ret = RPC_ERROR(-1); |
rpc->call_rep.eno = RPC_ERROR(errno); | rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
} else { |
} else { |
/* execute RPC call */ | /* calc estimated length */ |
schedEvent(TASK_ROOT(task), execCall, c, | len = ait_resideVars(RPC_RETVARS(c)) + wlen; |
(int) noreply, rpc, len); | if (len > AIT_LEN(&c->cli_buf)) |
| AIT_RE_BUF(&c->cli_buf, len); |
| buf = AIT_GET_BUF(&c->cli_buf); |
| rpc = (struct tagRPCCall*) buf; |
| |
| rpc->call_argc = (u_char) array_Size(RPC_RETVARS(c)); |
| /* Go Encapsulate variables */ |
| ret = ait_vars2buffer(buf + wlen, AIT_LEN(&c->cli_buf) - wlen, |
| RPC_RETVARS(c)); |
| /* Free return values */ |
| ait_freeVars(&RPC_RETVARS(c)); |
| if (ret == -1) { |
| rpc_SetErr(EBADRPC, "Prepare RPC packet failed"); |
| rpc->call_argc ^= rpc->call_argc; |
| rpc->call_rep.ret = RPC_ERROR(-1); |
| rpc->call_rep.eno = RPC_ERROR(rpc_Errno); |
| } else |
| wlen += ret; |
} |
} |
|
} |
|
|
/* send RPC reply */ | rpc->call_len = htonl(wlen); |
if (!noreply) | rpc->call_io = RPC_ACK; |
schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], | |
c, TASK_FD(task), rpc, len); | |
|
|
off += len; | /* send reply */ |
} while (rlen > 0); | ret = write(TASK_FD(task), buf, MIN(wlen, s->srv_netbuf)); |
| if (ret == -1) { |
| /* close connection */ |
| schedEvent(TASK_ROOT(task), cbProto[s->srv_proto][CB_CLOSECLIENT], |
| TASK_ARG(task), 0, NULL, 0); |
| return NULL; |
| } |
|
|
|
return NULL; |
|
} |
|
|
|
static void * |
|
rxEXTPacket(sched_task_t *task) |
|
{ |
|
rpc_srv_t *srv = TASK_ARG(task); |
|
rpc_cli_t *c = NULL; |
|
int len, rlen, noreply; |
|
struct tagRPCCall *rpc; |
|
struct timespec ts = { DEF_RPC_TIMEOUT, 0 }; |
|
ait_val_t b = AIT_VAL_INIT; |
|
sockaddr_t sa; |
|
|
|
memset(&sa, 0, sizeof sa); |
|
/* receive connect packet */ |
|
AIT_SET_BUF(&b, NULL, srv->srv_netbuf); |
|
rlen = read(TASK_FD(task), AIT_GET_BUF(&b), AIT_LEN(&b)); |
|
if (rlen < sizeof(struct tagRPCCall)) { |
|
rpc_SetErr(ERPCMISMATCH, "Short RPC packet"); |
|
goto end; |
|
} else { |
|
rpc = (struct tagRPCCall*) AIT_GET_BUF(&b); |
|
|
|
/* skip loop packet */ |
|
if (rpc->call_io & RPC_ACK) |
|
goto end; |
|
} |
|
|
|
c = _allocClient(srv, &sa); |
|
if (!c) { |
|
EVERBOSE(1, "RPC client quota exceeded! Connection will be shutdown!\n"); |
|
usleep(2000); /* blocked client delay */ |
|
goto end; |
|
} else { |
|
len = ntohl(rpc->call_len); |
|
if (len > AIT_LEN(&c->cli_buf)) |
|
AIT_RE_BUF(&c->cli_buf, len); |
|
memcpy(AIT_GET_BUF(&c->cli_buf), rpc, AIT_LEN(&c->cli_buf)); |
|
rpc = (struct tagRPCCall*) AIT_GET_BUF(&c->cli_buf); |
|
|
|
c->cli_sock = TASK_FD(task); |
|
|
|
/* armed timer for close stateless connection */ |
|
schedCancelby(TASK_ROOT(task), taskTIMER, CRITERIA_DATA, c, NULL); |
|
schedTimer(TASK_ROOT(task), cbProto[srv->srv_proto][CB_CLOSECLIENT], |
|
c, ts, c, 0); |
|
} |
|
|
|
noreply = RPC_CHK_NOREPLY(rpc); |
|
|
|
/* check RPC packet session info */ |
|
if (rpc_chkPktSession(&rpc->call_session, &srv->srv_session)) { |
|
rpc_SetErr(ERPCMISMATCH, "Get invalid RPC session"); |
|
|
|
rpc->call_argc ^= rpc->call_argc; |
|
rpc->call_rep.ret = RPC_ERROR(-1); |
|
rpc->call_rep.eno = RPC_ERROR(errno); |
|
} else { |
|
/* execute RPC call */ |
|
schedEvent(TASK_ROOT(task), execCall, c, (int) noreply, rpc, len); |
|
} |
|
|
|
/* send RPC reply */ |
|
if (!noreply) |
|
schedWrite(TASK_ROOT(task), cbProto[srv->srv_proto][CB_TXPACKET], |
|
c, TASK_FD(task), rpc, len); |
end: |
end: |
|
AIT_FREE_VAL(&b); |
schedReadSelf(task); |
schedReadSelf(task); |
return NULL; |
return NULL; |
} |
} |
Line 721 end:
|
Line 1096 end:
|
static void * |
static void * |
flushBLOB(sched_task_t *task) |
flushBLOB(sched_task_t *task) |
{ |
{ |
rpc_srv_t *srv = TASK_ARG(task); | uintptr_t sigArg = atomic_load_acq_ptr(&_glSigArg); |
| rpc_srv_t *srv = sigArg ? (void*) sigArg : TASK_ARG(task); |
rpc_blob_t *b, *tmp; |
rpc_blob_t *b, *tmp; |
|
|
TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) { |
TAILQ_FOREACH_SAFE(b, &srv->srv_blob.blobs, blob_node, tmp) { |
Line 731 flushBLOB(sched_task_t *task)
|
Line 1107 flushBLOB(sched_task_t *task)
|
e_free(b); |
e_free(b); |
} |
} |
|
|
schedSignalSelf(task); | if (!schedSignalSelf(task)) { |
| /* disabled kqueue support in libaitsched */ |
| struct sigaction sa; |
| |
| memset(&sa, 0, sizeof sa); |
| sigemptyset(&sa.sa_mask); |
| sa.sa_handler = (void (*)(int)) flushBLOB; |
| sa.sa_flags = SA_RESTART | SA_RESETHAND; |
| sigaction(SIGFBLOB, &sa, NULL); |
| } |
| |
return NULL; |
return NULL; |
} |
} |
|
|
Line 945 rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv)
|
Line 1331 rpc_srv_loopBLOBServer(rpc_srv_t * __restrict srv)
|
return -1; |
return -1; |
} |
} |
|
|
schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0); | if (!schedSignal(srv->srv_blob.root, flushBLOB, srv, SIGFBLOB, NULL, 0)) { |
| /* disabled kqueue support in libaitsched */ |
| struct sigaction sa; |
| |
| atomic_store_rel_ptr(&_glSigArg, (uintptr_t) srv); |
| |
| memset(&sa, 0, sizeof sa); |
| sigemptyset(&sa.sa_mask); |
| sa.sa_handler = (void (*)(int)) flushBLOB; |
| sa.sa_flags = SA_RESTART | SA_RESETHAND; |
| sigaction(SIGFBLOB, &sa, NULL); |
| } |
| |
if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv, |
if (!schedRead(srv->srv_blob.root, acceptBLOBClients, srv, |
srv->srv_blob.server.cli_sock, NULL, 0)) { |
srv->srv_blob.server.cli_sock, NULL, 0)) { |
rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); |
rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); |
Line 1004 rpc_srv_initServer(u_char InstID, int concurentClients
|
Line 1402 rpc_srv_initServer(u_char InstID, int concurentClients
|
rpc_srv_t *srv = NULL; |
rpc_srv_t *srv = NULL; |
sockaddr_t sa = E_SOCKADDR_INIT; |
sockaddr_t sa = E_SOCKADDR_INIT; |
|
|
if (!concurentClients || (proto < 0 || proto > SOCK_DGRAM)) { | if (!concurentClients || (proto < 0 || proto > SOCK_RAW)) { |
rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server"); |
rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server"); |
return NULL; |
return NULL; |
} |
} |
Line 1173 rpc_srv_loopServer(rpc_srv_t * __restrict srv)
|
Line 1571 rpc_srv_loopServer(rpc_srv_t * __restrict srv)
|
for (i = 0; i < array_Size(srv->srv_clients); i++) { |
for (i = 0; i < array_Size(srv->srv_clients); i++) { |
c = array(srv->srv_clients, i, rpc_cli_t*); |
c = array(srv->srv_clients, i, rpc_cli_t*); |
if (c) { |
if (c) { |
shutdown(c->cli_sock, SHUT_RDWR); | if (srv->srv_proto == SOCK_STREAM) { |
close(c->cli_sock); | shutdown(c->cli_sock, SHUT_RDWR); |
| close(c->cli_sock); |
| } |
|
|
schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL); |
schedCancelby(srv->srv_root, taskMAX, CRITERIA_ARG, c, NULL); |
ait_freeVars(&RPC_RETVARS(c)); |
ait_freeVars(&RPC_RETVARS(c)); |
Line 1184 rpc_srv_loopServer(rpc_srv_t * __restrict srv)
|
Line 1584 rpc_srv_loopServer(rpc_srv_t * __restrict srv)
|
} |
} |
array_Destroy(&srv->srv_clients); |
array_Destroy(&srv->srv_clients); |
|
|
close(srv->srv_server.cli_sock); | if (srv->srv_proto != SOCK_EXT) |
| close(srv->srv_server.cli_sock); |
|
|
/* detach exported calls */ |
/* detach exported calls */ |
RPC_FUNCS_LOCK(&srv->srv_funcs); |
RPC_FUNCS_LOCK(&srv->srv_funcs); |
Line 1223 rpc_srv_execCall(rpc_cli_t * __restrict cli, struct ta
|
Line 1624 rpc_srv_execCall(rpc_cli_t * __restrict cli, struct ta
|
|
|
func = AIT_GET_LIKE(&funcname, rpc_callback_t); |
func = AIT_GET_LIKE(&funcname, rpc_callback_t); |
return func(cli, rpc, args); |
return func(cli, rpc, args); |
|
} |
|
|
|
|
|
/* |
|
* rpc_srv_initServer2() - Init & create layer2 RPC Server |
|
* |
|
* @InstID = Instance for authentication & recognition |
|
* @concurentClients = Concurent clients at same time to this server |
|
* @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet) |
|
* @csIface = Interface name for bind server, if NULL first interface on host |
|
* return: NULL == error or !=NULL bind and created RPC server instance |
|
*/ |
|
rpc_srv_t * |
|
rpc_srv_initServer2(u_char InstID, int concurentClients, int netBuf, const char *csIface) |
|
{ |
|
int n = 1; |
|
rpc_srv_t *srv = NULL; |
|
sockaddr_t sa = E_SOCKADDR_INIT; |
|
char szIface[64], szStr[STRSIZ]; |
|
register int i; |
|
struct ifreq ifr; |
|
struct bpf_insn insns[] = { |
|
BPF_STMT(BPF_LD + BPF_H + BPF_ABS, 12), |
|
BPF_JUMP(BPF_JMP + BPF_JEQ + BPF_K, RPC_DEFPORT, 0, 1), |
|
BPF_STMT(BPF_RET + BPF_K, -1), |
|
BPF_STMT(BPF_RET + BPF_K, 0), |
|
}; |
|
struct bpf_program fcode = { |
|
.bf_len = sizeof(insns) / sizeof(struct bpf_insn), |
|
.bf_insns = insns |
|
}; |
|
|
|
if (!concurentClients) { |
|
rpc_SetErr(EINVAL, "Invalid parameters can`t init RPC server"); |
|
return NULL; |
|
} |
|
if (!csIface) { |
|
if (e_get1stiface(szIface, sizeof szIface)) |
|
return NULL; |
|
} else |
|
strlcpy(szIface, csIface, sizeof szIface); |
|
if (!e_getifacebyname(szIface, &sa)) |
|
return NULL; |
|
|
|
#ifdef HAVE_SRANDOMDEV |
|
srandomdev(); |
|
#else |
|
time_t tim; |
|
|
|
srandom((time(&tim) ^ getpid())); |
|
#endif |
|
|
|
srv = e_malloc(sizeof(rpc_srv_t)); |
|
if (!srv) { |
|
LOGERR; |
|
return NULL; |
|
} else |
|
memset(srv, 0, sizeof(rpc_srv_t)); |
|
|
|
srv->srv_proto = SOCK_BPF; |
|
srv->srv_netbuf = netBuf; |
|
srv->srv_session.sess_version = RPC_VERSION; |
|
srv->srv_session.sess_instance = InstID; |
|
|
|
srv->srv_server.cli_parent = srv; |
|
memcpy(&srv->srv_server.cli_sa, &sa, sizeof srv->srv_server.cli_sa); |
|
|
|
/* init functions */ |
|
pthread_mutex_init(&srv->srv_funcs.mtx, NULL); |
|
SLIST_INIT(&srv->srv_funcs); |
|
AVL_INIT(&srv->srv_funcs); |
|
|
|
/* init scheduler */ |
|
srv->srv_root = schedBegin(); |
|
if (!srv->srv_root) { |
|
rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
/* init pool for clients */ |
|
srv->srv_clients = array_Init(concurentClients); |
|
if (!srv->srv_clients) { |
|
rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError()); |
|
schedEnd(&srv->srv_root); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
/* create server handler */ |
|
for (i = 0; i < 10; i++) { |
|
memset(szStr, 0, sizeof szStr); |
|
snprintf(szStr, sizeof szStr, "/dev/bpf%d", i); |
|
srv->srv_server.cli_sock = open(szStr, O_RDWR); |
|
if (srv->srv_server.cli_sock > STDERR_FILENO) |
|
break; |
|
} |
|
if (srv->srv_server.cli_sock < 3) { |
|
LOGERR; |
|
array_Destroy(&srv->srv_clients); |
|
schedEnd(&srv->srv_root); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
if (ioctl(srv->srv_server.cli_sock, BIOCIMMEDIATE, &n) == -1) { |
|
LOGERR; |
|
goto err; |
|
} |
|
if (ioctl(srv->srv_server.cli_sock, BIOCSETF, &fcode) == -1) { |
|
LOGERR; |
|
goto err; |
|
} |
|
n = (netBuf < RPC_MIN_BUFSIZ) ? getpagesize() : E_ALIGN(netBuf, 2); |
|
if (ioctl(srv->srv_server.cli_sock, BIOCSBLEN, &n) == -1) { |
|
LOGERR; |
|
goto err; |
|
} else |
|
srv->srv_netbuf = n; |
|
|
|
memset(&ifr, 0, sizeof ifr); |
|
strlcpy(ifr.ifr_name, szIface, sizeof ifr.ifr_name); |
|
if (ioctl(srv->srv_server.cli_sock, BIOCSETIF, &ifr) == -1) { |
|
LOGERR; |
|
goto err; |
|
} else |
|
fcntl(srv->srv_server.cli_sock, F_SETFL, |
|
fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK); |
|
|
|
rpc_register_srvPing(srv); |
|
|
|
return srv; |
|
err: /* error condition */ |
|
close(srv->srv_server.cli_sock); |
|
array_Destroy(&srv->srv_clients); |
|
schedEnd(&srv->srv_root); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
/* |
|
* rpc_srv_initServerExt() - Init & create pipe RPC Server |
|
* |
|
* @InstID = Instance for authentication & recognition |
|
* @netBuf = Network buffer length (min:512 bytes), if =0 == BUFSIZ (also meaning max RPC packet) |
|
* @fd = File descriptor |
|
* return: NULL == error or !=NULL bind and created RPC server instance |
|
*/ |
|
rpc_srv_t * |
|
rpc_srv_initServerExt(u_char InstID, int netBuf, int fd) |
|
{ |
|
rpc_srv_t *srv = NULL; |
|
|
|
#ifdef HAVE_SRANDOMDEV |
|
srandomdev(); |
|
#else |
|
time_t tim; |
|
|
|
srandom((time(&tim) ^ getpid())); |
|
#endif |
|
|
|
srv = e_malloc(sizeof(rpc_srv_t)); |
|
if (!srv) { |
|
LOGERR; |
|
return NULL; |
|
} else |
|
memset(srv, 0, sizeof(rpc_srv_t)); |
|
|
|
srv->srv_proto = SOCK_EXT; |
|
srv->srv_netbuf = (netBuf < RPC_MIN_BUFSIZ) ? |
|
getpagesize() : E_ALIGN(netBuf, 2); |
|
srv->srv_session.sess_version = RPC_VERSION; |
|
srv->srv_session.sess_instance = InstID; |
|
|
|
srv->srv_server.cli_parent = srv; |
|
srv->srv_server.cli_sock = fd; |
|
|
|
/* init functions */ |
|
pthread_mutex_init(&srv->srv_funcs.mtx, NULL); |
|
SLIST_INIT(&srv->srv_funcs); |
|
AVL_INIT(&srv->srv_funcs); |
|
|
|
/* init scheduler */ |
|
srv->srv_root = schedBegin(); |
|
if (!srv->srv_root) { |
|
rpc_SetErr(sched_GetErrno(), "%s", sched_GetError()); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
/* init pool for clients */ |
|
srv->srv_clients = array_Init(1); |
|
if (!srv->srv_clients) { |
|
rpc_SetErr(elwix_GetErrno(), "%s", elwix_GetError()); |
|
schedEnd(&srv->srv_root); |
|
pthread_mutex_destroy(&srv->srv_funcs.mtx); |
|
e_free(srv); |
|
return NULL; |
|
} |
|
|
|
fcntl(srv->srv_server.cli_sock, F_SETFL, |
|
fcntl(srv->srv_server.cli_sock, F_GETFL) | O_NONBLOCK); |
|
|
|
rpc_register_srvPing(srv); |
|
|
|
return srv; |
} |
} |