X-Git-Url: http://www.chiark.greenend.org.uk/ucgi/~ian/git?p=secnet.git;a=blobdiff_plain;f=udp.c;h=bb82026c144d0df1f56f9f52e9401dd2fae91691;hp=9615a174224624ce8a58d173f5df68a2de2b3de8;hb=4fb0f88d53fc60395a4a87b7a9ca1245ba033ee7;hpb=3b83c93292fbf6c4e859ce513bdf54ad90733f96 diff --git a/udp.c b/udp.c index 9615a17..bb82026 100644 --- a/udp.c +++ b/udp.c @@ -16,9 +16,13 @@ #include #include #include +#include +#include #include "util.h" +#include "magic.h" #include "unaligned.h" #include "ipaddr.h" +#include "magic.h" static beforepoll_fn udp_beforepoll; static afterpoll_fn udp_afterpoll; @@ -46,9 +50,32 @@ struct udp { struct sockaddr_in proxy; }; +static const char *saddr_to_string(const struct sockaddr_in *sin) { + static char bufs[2][100]; + static int b; + + b ^= 1; + snprintf(bufs[b], sizeof(bufs[b]), "[%s]:%d", + inet_ntoa(sin->sin_addr), + ntohs(sin->sin_port)); + return bufs[b]; +} + +static const char *addr_to_string(void *commst, const struct comm_addr *ca) { + struct udp *st=commst; + static char sbuf[100]; + + struct sockaddr_in la; + la.sin_addr.s_addr=htonl(st->addr); + la.sin_port=htons(st->port); + + snprintf(sbuf, sizeof(sbuf), "udp:%s-%s", + saddr_to_string(&la), saddr_to_string(&ca->sin)); + return sbuf; +} + static int udp_beforepoll(void *state, struct pollfd *fds, int *nfds_io, - int *timeout_io, const struct timeval *tv, - uint64_t *now) + int *timeout_io) { struct udp *st=state; if (*nfds_io<1) { @@ -61,23 +88,25 @@ static int udp_beforepoll(void *state, struct pollfd *fds, int *nfds_io, return 0; } -static void udp_afterpoll(void *state, struct pollfd *fds, int nfds, - const struct timeval *tv, uint64_t *now) +static void udp_afterpoll(void *state, struct pollfd *fds, int nfds) { struct udp *st=state; struct sockaddr_in from; - int fromlen; + socklen_t fromlen; struct notify_list *n; bool_t done; int rv; if (nfds && (fds->revents & POLLIN)) { do { + FILLZERO(from); fromlen=sizeof(from); BUF_ASSERT_FREE(st->rbuf); BUF_ALLOC(st->rbuf,"udp_afterpoll"); - rv=recvfrom(st->fd, st->rbuf->start, st->rbuf->len, 0, - (struct sockaddr *)&from, &fromlen); + buffer_init(st->rbuf,calculate_max_start_pad()); + rv=recvfrom(st->fd, st->rbuf->start, + buf_remaining_space(st->rbuf), + 0, (struct sockaddr *)&from, &fromlen); if (rv>0) { st->rbuf->size=rv; if (st->use_proxy) { @@ -95,25 +124,28 @@ static void udp_afterpoll(void *state, struct pollfd *fds, int nfds, buf_unprepend(st->rbuf,2); memcpy(&from.sin_port,buf_unprepend(st->rbuf,2),2); } + struct comm_addr ca; + FILLZERO(ca); + ca.comm=&st->ops; + ca.sin=from; done=False; for (n=st->notify; n; n=n->next) { - if (n->fn(n->state, st->rbuf, &from)) { + if (n->fn(n->state, st->rbuf, &ca)) { done=True; break; } } if (!done) { - uint32_t source,dest; - /* Manufacture and send NAK packet */ - source=get_uint32(st->rbuf->start); /* Us */ - dest=get_uint32(st->rbuf->start+4); /* Them */ - Message(M_INFO,"udp (port %d): sending NAK\n",st->port); - buffer_init(st->rbuf,0); - buf_append_uint32(st->rbuf,dest); - buf_append_uint32(st->rbuf,source); - buf_append_uint32(st->rbuf,0); /* NAK is msg type 0 */ - sendto(st->fd, st->rbuf->start, st->rbuf->size, 0, - (struct sockaddr *)&from, sizeof(from)); + uint32_t msgtype; + if (st->rbuf->size>12 /* prevents traffic amplification */ + && ((msgtype=get_uint32(st->rbuf->start+8)) + != LABEL_NAK)) { + uint32_t source,dest; + /* Manufacture and send NAK packet */ + source=get_uint32(st->rbuf->start); /* Us */ + dest=get_uint32(st->rbuf->start+4); /* Them */ + send_nak(&ca,source,dest,msgtype,st->rbuf,"unwanted"); + } BUF_FREE(st->rbuf); } BUF_ASSERT_FREE(st->rbuf); @@ -158,21 +190,22 @@ static void release_notify(void *commst, void *nst, comm_notify_fn *fn) } static bool_t udp_sendmsg(void *commst, struct buffer_if *buf, - struct sockaddr_in *dest) + const struct comm_addr *dest) { struct udp *st=commst; uint8_t *sa; if (st->use_proxy) { - sa=buf->start-8; - memcpy(sa,&dest->sin_addr,4); + sa=buf_prepend(buf,8); + memcpy(sa,&dest->sin.sin_addr,4); memset(sa+4,0,4); - memcpy(sa+6,&dest->sin_port,2); + memcpy(sa+6,&dest->sin.sin_port,2); sendto(st->fd,sa,buf->size+8,0,(struct sockaddr *)&st->proxy, sizeof(st->proxy)); + buf_unprepend(buf,8); } else { sendto(st->fd, buf->start, buf->size, 0, - (struct sockaddr *)dest, sizeof(*dest)); + (struct sockaddr *)&dest->sin, sizeof(dest->sin)); } return True; @@ -191,12 +224,9 @@ static void udp_phase_hook(void *sst, uint32_t new_phase) fatal_perror("udp (%s:%d): fcntl(set O_NONBLOCK)", st->loc.file,st->loc.line); } - if (fcntl(st->fd, F_SETFD, FD_CLOEXEC)==-1) { - fatal_perror("udp (%s:%d): fcntl(set FD_CLOEXEC)", - st->loc.file,st->loc.line); - } + setcloexec(st->fd); - memset(&addr, 0, sizeof(addr)); + FILLZERO(addr); addr.sin_family=AF_INET; addr.sin_addr.s_addr=htonl(st->addr); addr.sin_port=htons(st->port); @@ -212,8 +242,8 @@ static void udp_phase_hook(void *sst, uint32_t new_phase) } if (c==0) { char *argv[4], addrstr[9], portstr[5]; - sprintf(addrstr,"%08lX",(long)st->addr); - sprintf(portstr,"%04X",st->port); + sprintf(addrstr,"%08lX",(long)addr.sin_addr.s_addr); + sprintf(portstr,"%04X",addr.sin_port); argv[0]=st->authbind; argv[1]=addrstr; argv[2]=portstr; @@ -259,11 +289,10 @@ static list_t *udp_apply(closure_t *self, struct cloc loc, dict_t *context, st->cl.apply=NULL; st->cl.interface=&st->ops; st->ops.st=st; - st->ops.min_start_pad=0; - st->ops.min_end_pad=0; st->ops.request_notify=request_notify; st->ops.release_notify=release_notify; st->ops.sendmsg=udp_sendmsg; + st->ops.addr_to_string=addr_to_string; st->port=0; st->use_proxy=False; @@ -274,14 +303,14 @@ static list_t *udp_apply(closure_t *self, struct cloc loc, dict_t *context, d=i->data.dict; j=dict_find_item(d,"address",False,"udp",st->loc); - st->addr=j?st->addr=string_item_to_ipaddr(j, "udp"):INADDR_ANY; + st->addr=j?string_item_to_ipaddr(j, "udp"):INADDR_ANY; st->port=dict_read_number(d,"port",True,"udp",st->loc,0); st->rbuf=find_cl_if(d,"buffer",CL_BUFFER,True,"udp",st->loc); st->authbind=dict_read_string(d,"authbind",False,"udp",st->loc); l=dict_lookup(d,"proxy"); if (l) { st->use_proxy=True; - memset(&st->proxy,0,sizeof(st->proxy)); + FILLZERO(st->proxy); st->proxy.sin_family=AF_INET; i=list_elem(l,0); if (!i || i->type!=t_string) { @@ -294,15 +323,15 @@ static list_t *udp_apply(closure_t *self, struct cloc loc, dict_t *context, cfgfatal(st->loc,"udp","proxy must supply ""addr"",port\n"); } st->proxy.sin_port=htons(i->data.number); - st->ops.min_start_pad=8; } + update_max_start_pad(&comm_max_start_pad, st->use_proxy ? 8 : 0); + add_hook(PHASE_GETRESOURCES,udp_phase_hook,st); return new_closure(&st->cl); } -init_module udp_module; void udp_module(dict_t *dict) { add_closure(dict,"udp",udp_apply);