1 /* UDP send/receive module for secnet */
3 /* This module enables sites to communicate by sending UDP
4 * packets. When an instance of the module is created we can
5 * optionally bind to a particular local IP address (not implemented
8 * Packets are offered to registered receivers in turn. Once one
9 * accepts it, it isn't offered to any more. */
17 #include <sys/socket.h>
19 #include <netinet/in.h>
20 #include <arpa/inet.h>
23 #include "unaligned.h"
27 static beforepoll_fn udp_beforepoll
;
28 static afterpoll_fn udp_afterpoll
;
29 static comm_request_notify_fn request_notify
;
30 static comm_release_notify_fn release_notify
;
31 static comm_sendmsg_fn udp_sendmsg
;
36 struct notify_list
*next
;
47 struct buffer_if
*rbuf
;
48 struct notify_list
*notify
;
50 struct sockaddr_in proxy
;
53 static const char *saddr_to_string(const struct sockaddr_in
*sin
) {
54 static char bufs
[2][100];
58 snprintf(bufs
[b
], sizeof(bufs
[b
]), "[%s]:%d",
59 inet_ntoa(sin
->sin_addr
),
60 ntohs(sin
->sin_port
));
64 static const char *addr_to_string(void *commst
, const struct comm_addr
*ca
) {
65 struct udp
*st
=commst
;
66 static char sbuf
[100];
68 struct sockaddr_in la
;
69 la
.sin_addr
.s_addr
=htonl(st
->addr
);
70 la
.sin_port
=htons(st
->port
);
72 snprintf(sbuf
, sizeof(sbuf
), "udp:%s-%s",
73 saddr_to_string(&la
), saddr_to_string(&ca
->sin
));
77 static int udp_beforepoll(void *state
, struct pollfd
*fds
, int *nfds_io
,
91 static void udp_afterpoll(void *state
, struct pollfd
*fds
, int nfds
)
94 struct sockaddr_in from
;
96 struct notify_list
*n
;
100 if (nfds
&& (fds
->revents
& POLLIN
)) {
103 fromlen
=sizeof(from
);
104 BUF_ASSERT_FREE(st
->rbuf
);
105 BUF_ALLOC(st
->rbuf
,"udp_afterpoll");
106 buffer_init(st
->rbuf
,calculate_max_start_pad());
107 rv
=recvfrom(st
->fd
, st
->rbuf
->start
, st
->rbuf
->len
, 0,
108 (struct sockaddr
*)&from
, &fromlen
);
112 /* Check that the packet came from our poxy server;
113 we shouldn't be contacted directly by anybody else
114 (since they can trivially forge source addresses) */
115 if (memcmp(&from
.sin_addr
,&st
->proxy
.sin_addr
,4)!=0 ||
116 memcmp(&from
.sin_port
,&st
->proxy
.sin_port
,2)!=0) {
117 Message(M_INFO
,"udp: received packet that's not "
122 memcpy(&from
.sin_addr
,buf_unprepend(st
->rbuf
,4),4);
123 buf_unprepend(st
->rbuf
,2);
124 memcpy(&from
.sin_port
,buf_unprepend(st
->rbuf
,2),2);
131 for (n
=st
->notify
; n
; n
=n
->next
) {
132 if (n
->fn(n
->state
, st
->rbuf
, &ca
)) {
139 if (st
->rbuf
->size
>12 /* prevents traffic amplification */
140 && ((msgtype
=get_uint32(st
->rbuf
->start
+8))
142 uint32_t source
,dest
;
143 /* Manufacture and send NAK packet */
144 source
=get_uint32(st
->rbuf
->start
); /* Us */
145 dest
=get_uint32(st
->rbuf
->start
+4); /* Them */
146 send_nak(&ca
,source
,dest
,msgtype
,st
->rbuf
,"unwanted");
150 BUF_ASSERT_FREE(st
->rbuf
);
158 static void request_notify(void *commst
, void *nst
, comm_notify_fn
*fn
)
160 struct udp
*st
=commst
;
161 struct notify_list
*n
;
163 n
=safe_malloc(sizeof(*n
),"request_notify");
170 static void release_notify(void *commst
, void *nst
, comm_notify_fn
*fn
)
172 struct udp
*st
=commst
;
173 struct notify_list
*n
, **p
, *t
;
177 for (n
=st
->notify
; n
; )
179 if (n
->state
==nst
&& n
->fn
==fn
) {
191 static bool_t
udp_sendmsg(void *commst
, struct buffer_if
*buf
,
192 const struct comm_addr
*dest
)
194 struct udp
*st
=commst
;
198 sa
=buf_prepend(buf
,8);
199 memcpy(sa
,&dest
->sin
.sin_addr
,4);
201 memcpy(sa
+6,&dest
->sin
.sin_port
,2);
202 sendto(st
->fd
,sa
,buf
->size
+8,0,(struct sockaddr
*)&st
->proxy
,
204 buf_unprepend(buf
,8);
206 sendto(st
->fd
, buf
->start
, buf
->size
, 0,
207 (struct sockaddr
*)&dest
->sin
, sizeof(dest
->sin
));
213 static void udp_phase_hook(void *sst
, uint32_t new_phase
)
216 struct sockaddr_in addr
;
218 st
->fd
=socket(PF_INET
, SOCK_DGRAM
, IPPROTO_UDP
);
220 fatal_perror("udp (%s:%d): socket",st
->loc
.file
,st
->loc
.line
);
222 if (fcntl(st
->fd
, F_SETFL
, fcntl(st
->fd
, F_GETFL
)|O_NONBLOCK
)==-1) {
223 fatal_perror("udp (%s:%d): fcntl(set O_NONBLOCK)",
224 st
->loc
.file
,st
->loc
.line
);
226 if (fcntl(st
->fd
, F_SETFD
, FD_CLOEXEC
)==-1) {
227 fatal_perror("udp (%s:%d): fcntl(set FD_CLOEXEC)",
228 st
->loc
.file
,st
->loc
.line
);
232 addr
.sin_family
=AF_INET
;
233 addr
.sin_addr
.s_addr
=htonl(st
->addr
);
234 addr
.sin_port
=htons(st
->port
);
239 /* XXX this fork() and waitpid() business needs to be hidden
240 in some system-specific library functions. */
243 fatal_perror("udp_phase_hook: fork() for authbind");
246 char *argv
[4], addrstr
[9], portstr
[5];
247 sprintf(addrstr
,"%08lX",(long)addr
.sin_addr
.s_addr
);
248 sprintf(portstr
,"%04X",addr
.sin_port
);
249 argv
[0]=st
->authbind
;
254 execvp(st
->authbind
,argv
);
257 while (waitpid(c
,&status
,0)==-1) {
258 if (errno
==EINTR
) continue;
259 fatal_perror("udp (%s:%d): authbind",st
->loc
.file
,st
->loc
.line
);
261 if (WIFSIGNALED(status
)) {
262 fatal("udp (%s:%d): authbind died on signal %d",st
->loc
.file
,
263 st
->loc
.line
, WTERMSIG(status
));
265 if (WIFEXITED(status
) && WEXITSTATUS(status
)!=0) {
266 fatal("udp (%s:%d): authbind died with status %d",st
->loc
.file
,
267 st
->loc
.line
, WEXITSTATUS(status
));
270 if (bind(st
->fd
, (struct sockaddr
*)&addr
, sizeof(addr
))!=0) {
271 fatal_perror("udp (%s:%d): bind",st
->loc
.file
,st
->loc
.line
);
275 register_for_poll(st
,udp_beforepoll
,udp_afterpoll
,1,"udp");
278 static list_t
*udp_apply(closure_t
*self
, struct cloc loc
, dict_t
*context
,
287 st
=safe_malloc(sizeof(*st
),"udp_apply(st)");
289 st
->cl
.description
="udp";
292 st
->cl
.interface
=&st
->ops
;
294 st
->ops
.request_notify
=request_notify
;
295 st
->ops
.release_notify
=release_notify
;
296 st
->ops
.sendmsg
=udp_sendmsg
;
297 st
->ops
.addr_to_string
=addr_to_string
;
302 if (!i
|| i
->type
!=t_dict
) {
303 cfgfatal(st
->loc
,"udp","first argument must be a dictionary\n");
307 j
=dict_find_item(d
,"address",False
,"udp",st
->loc
);
308 st
->addr
=j?
string_item_to_ipaddr(j
, "udp"):INADDR_ANY
;
309 st
->port
=dict_read_number(d
,"port",True
,"udp",st
->loc
,0);
310 st
->rbuf
=find_cl_if(d
,"buffer",CL_BUFFER
,True
,"udp",st
->loc
);
311 st
->authbind
=dict_read_string(d
,"authbind",False
,"udp",st
->loc
);
312 l
=dict_lookup(d
,"proxy");
316 st
->proxy
.sin_family
=AF_INET
;
318 if (!i
|| i
->type
!=t_string
) {
319 cfgfatal(st
->loc
,"udp","proxy must supply ""addr"",port\n");
321 a
=string_item_to_ipaddr(i
,"proxy");
322 st
->proxy
.sin_addr
.s_addr
=htonl(a
);
324 if (!i
|| i
->type
!=t_number
) {
325 cfgfatal(st
->loc
,"udp","proxy must supply ""addr"",port\n");
327 st
->proxy
.sin_port
=htons(i
->data
.number
);
330 update_max_start_pad(&comm_max_start_pad
, st
->use_proxy ?
8 : 0);
332 add_hook(PHASE_GETRESOURCES
,udp_phase_hook
,st
);
334 return new_closure(&st
->cl
);
337 void udp_module(dict_t
*dict
)
339 add_closure(dict
,"udp",udp_apply
);