void
route(const char * gw)
{
int ret;
struct uinet_socket * so;
struct rt_msghdr * rtm;
struct uinet_sockaddr * sa;
struct uinet_sockaddr_in * sin;
char buf[4096];
errno = 0;
ret = uinet_socreate(uinet_instance_default(), UINET_PF_ROUTE, &so, UINET_SOCK_RAW, 0);
if (ret) {
errno = ret;
pfatal("uinet_socreate");
}
memset(buf, 0, sizeof(buf));
rtm = (struct rt_msghdr *)buf;
rtm->rtm_version = RTM_VERSION;
rtm->rtm_type = RTM_ADD;
rtm->rtm_flags = RTF_GATEWAY;
rtm->rtm_addrs = RTA_DST | RTA_GATEWAY | RTA_NETMASK;
rtm->rtm_pid = getpid();
rtm->rtm_seq = 1234;
sa = (struct uinet_sockaddr *)(rtm + 1);
sin = (struct uinet_sockaddr_in *)(sa);
sin->sin_len = sizeof(struct uinet_sockaddr_in);
sin->sin_family = AF_INET;
sin->sin_addr.s_addr = inet_addr("0.0.0.0");
sa = (struct uinet_sockaddr *)((unsigned char *)(sa) + ROUNDUP(sa->sa_len));
sin = (struct uinet_sockaddr_in *)(sa);
sin->sin_len = sizeof(struct uinet_sockaddr_in);
sin->sin_family = AF_INET;
sin->sin_addr.s_addr = inet_addr(gw);
sa = (struct uinet_sockaddr *)((unsigned char *)(sa) + ROUNDUP(sa->sa_len));
sin = (struct uinet_sockaddr_in *)(sa);
sin->sin_len = 0;
sin->sin_family = AF_INET;
sa = (struct uinet_sockaddr *)((unsigned char *)(sa) + ROUNDUP(sa->sa_len));
rtm->rtm_msglen = (char *)sa - buf;
errno = socket_write(so, buf, rtm->rtm_msglen);
if (errno) pfatal("socket_write");
/* probably should loop through reply messages and see whether
the setting of the route succeeded; right now we just assume
it worked. */
return;
}
static int
echo_start(struct uinet_demo_config *cfg, uinet_instance_t uinst, struct ev_loop *loop)
{
struct uinet_demo_echo *echo = (struct uinet_demo_echo *)cfg;
struct uinet_socket *listen_socket = NULL;
struct ev_uinet_ctx *soctx = NULL;
struct uinet_in_addr addr;
int optlen, optval;
int error;
struct uinet_sockaddr_in sin;
if (uinet_inet_pton(UINET_AF_INET, echo->listen_addr, &addr) <= 0) {
printf("%s: Malformed address %s\n", echo->cfg.name, echo->listen_addr);
error = UINET_EINVAL;
goto fail;
}
error = uinet_socreate(echo->cfg.uinst, UINET_PF_INET, &listen_socket, UINET_SOCK_STREAM, 0);
if (0 != error) {
printf("%s: Listen socket creation failed (%d)\n", echo->cfg.name, error);
goto fail;
}
soctx = ev_uinet_attach(listen_socket);
if (NULL == soctx) {
printf("%s: Failed to alloc libev socket context\n", echo->cfg.name);
error = UINET_ENOMEM;
goto fail;
}
if (echo->promisc) {
if ((error = uinet_make_socket_promiscuous(listen_socket, NULL))) {
printf("%s: Failed to make listen socket promiscuous (%d)\n",
echo->cfg.name, error);
goto fail;
}
}
if (cfg->copy_mode) {
if ((error = uinet_sosetcopymode(listen_socket, cfg->copy_mode,
cfg->copy_limit, cfg->copy_uif))) {
printf("%s: Failed to set copy mode (%d)\n",
echo->cfg.name, error);
goto fail;
}
}
/*
* Socket needs to be non-blocking to work with the event system
*/
uinet_sosetnonblocking(listen_socket, 1);
/* Set NODELAY on the listen socket so it will be set on all
* accepted sockets via inheritance.
*/
optlen = sizeof(optval);
optval = 1;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_NODELAY,
&optval, optlen))) {
printf("%s: Failed to set TCP_NODELAY (%d)\n", echo->cfg.name, error);
goto fail;
}
/* Listen on all VLANs */
if ((error = uinet_setl2info2(listen_socket, NULL, NULL,
UINET_INL2I_TAG_ANY, NULL))) {
printf("%s: Listen socket L2 info set failed (%d)\n",
echo->cfg.name, error);
goto fail;
}
echo->listen_socket = listen_socket;
memset(&sin, 0, sizeof(struct uinet_sockaddr_in));
sin.sin_len = sizeof(struct uinet_sockaddr_in);
sin.sin_family = UINET_AF_INET;
sin.sin_addr = addr;
sin.sin_port = htons(echo->listen_port);
error = uinet_sobind(listen_socket, (struct uinet_sockaddr *)&sin);
if (0 != error) {
printf("%s: Bind to %s:%u failed\n", echo->cfg.name,
echo->listen_addr, echo->listen_port);
goto fail;
}
error = uinet_solisten(echo->listen_socket, -1);
if (0 != error) {
printf("%s: Listen on %s:%u failed\n", echo->cfg.name,
echo->listen_addr, echo->listen_port);
goto fail;
}
if (echo->cfg.verbose)
printf("%s: Listening on %s:%u\n", echo->cfg.name,
echo->listen_addr, echo->listen_port);
/*
* Set up a read watcher to accept new connections
*/
ev_init(&echo->listen_watcher, echo_accept_cb);
ev_uinet_set(&echo->listen_watcher, soctx, EV_READ);
echo->listen_watcher.data = echo;
ev_uinet_start(echo->cfg.loop, &echo->listen_watcher);
return (0);
fail:
if (soctx) ev_uinet_detach(soctx);
if (listen_socket) uinet_soclose(listen_socket);
return (error);
}
static struct passive_context *
create_passive(struct ev_loop *loop, struct server_config *cfg)
{
struct passive_context *passive = NULL;
struct uinet_socket *listener = NULL;
struct ev_uinet_ctx *soctx = NULL;
struct uinet_in_addr addr;
int optlen, optval;
int error;
struct uinet_sockaddr_in sin;
if (uinet_inet_pton(UINET_AF_INET, cfg->listen_addr, &addr) <= 0) {
printf("Malformed address %s\n", cfg->listen_addr);
goto fail;
}
error = uinet_socreate(UINET_PF_INET, &listener, UINET_SOCK_STREAM, 0);
if (0 != error) {
printf("Listen socket creation failed (%d)\n", error);
goto fail;
}
soctx = ev_uinet_attach(listener);
if (NULL == soctx) {
printf("Failed to alloc libev socket context\n");
goto fail;
}
if ((error = uinet_make_socket_passive(listener))) {
printf("Failed to make listen socket passive (%d)\n", error);
goto fail;
}
if (cfg->interface->promisc) {
if ((error = uinet_make_socket_promiscuous(listener, cfg->interface->cdom))) {
printf("Failed to make listen socket promiscuous (%d)\n", error);
goto fail;
}
}
/*
* The following settings will be inherited by all sockets created
* by this listen socket.
*/
/*
* Need to be non-blocking to work with the event system.
*/
uinet_sosetnonblocking(listener, 1);
/* Wait 5 seconds for connections to complete */
optlen = sizeof(optval);
optval = 5;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_KEEPINIT, &optval, optlen)))
goto fail;
/* Begin counting down to close after 10 seconds of idle */
optlen = sizeof(optval);
optval = 10;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_KEEPIDLE, &optval, optlen)))
goto fail;
/* Count down to close once per second */
optlen = sizeof(optval);
optval = 1;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_KEEPINTVL, &optval, optlen)))
goto fail;
/* Close after idle for 3 counts */
optlen = sizeof(optval);
optval = 3;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_KEEPCNT, &optval, optlen)))
goto fail;
/* Wait 100 milliseconds for missing TCP segments */
optlen = sizeof(optval);
optval = 100;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_REASSDL, &optval, optlen)))
goto fail;
passive = calloc(1, sizeof(struct passive_context));
if (NULL == passive) {
goto fail;
}
passive->loop = loop;
passive->listener = listener;
passive->verbose = cfg->verbose;
passive->interface = cfg->interface;
passive->extract = cfg->extract;
memcpy(passive->content_types, cfg->content_types, sizeof(passive->content_types));
memset(&sin, 0, sizeof(struct uinet_sockaddr_in));
sin.sin_len = sizeof(struct uinet_sockaddr_in);
sin.sin_family = UINET_AF_INET;
sin.sin_addr = addr;
sin.sin_port = htons(cfg->listen_port);
error = uinet_sobind(listener, (struct uinet_sockaddr *)&sin);
if (0 != error) {
printf("bind failed\n");
goto fail;
}
error = uinet_solisten(passive->listener, -1);
if (0 != error)
goto fail;
if (passive->verbose) {
char buf[32];
printf("Listening on %s:%u\n", uinet_inet_ntoa(addr, buf, sizeof(buf)), cfg->listen_port);
}
ev_init(&passive->listen_watcher, accept_cb);
ev_uinet_set(&passive->listen_watcher, soctx, EV_READ);
passive->listen_watcher.data = passive;
ev_uinet_start(loop, &passive->listen_watcher);
return (passive);
fail:
if (soctx) ev_uinet_detach(soctx);
if (listener) uinet_soclose(listener);
if (passive) free(passive);
return (NULL);
}
static int
passive_start(struct uinet_demo_config *cfg, uinet_instance_t uinst, struct ev_loop *loop)
{
struct uinet_demo_passive *passive = (struct uinet_demo_passive *)cfg;
struct uinet_socket *listen_socket = NULL;
struct ev_uinet_ctx *soctx = NULL;
struct uinet_in_addr addr;
int optlen, optval;
int error;
struct uinet_sockaddr_in sin;
if (uinet_inet_pton(UINET_AF_INET, passive->listen_addr, &addr) <= 0) {
printf("%s: Malformed address %s\n", passive->cfg.name, passive->listen_addr);
error = UINET_EINVAL;
goto fail;
}
error = uinet_socreate(passive->cfg.uinst, UINET_PF_INET, &listen_socket, UINET_SOCK_STREAM, 0);
if (0 != error) {
printf("%s: Listen socket creation failed (%d)\n", passive->cfg.name, error);
goto fail;
}
soctx = ev_uinet_attach(listen_socket);
if (NULL == soctx) {
printf("%s: Failed to alloc libev socket context\n", passive->cfg.name);
error = UINET_ENOMEM;
goto fail;
}
if ((error = uinet_make_socket_passive(listen_socket))) {
printf("%s: Failed to make listen socket passive (%d)\n", passive->cfg.name, error);
goto fail;
}
if (passive->promisc) {
if ((error = uinet_make_socket_promiscuous(listen_socket, NULL))) {
printf("%s: Failed to make listen socket promiscuous (%d)\n", passive->cfg.name, error);
goto fail;
}
}
/*
* The following settings will be inherited by all sockets created
* by this listen socket.
*/
/*
* Need to be non-blocking to work with the event system.
*/
uinet_sosetnonblocking(listen_socket, 1);
/* Wait 5 seconds for connections to complete */
optlen = sizeof(optval);
optval = 5;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_KEEPINIT, &optval, optlen))) {
printf("%s: Failed to set TCP_KEEPINIT (%d)\n", passive->cfg.name, error);
goto fail;
}
/* Begin counting down to close after 10 seconds of idle */
optlen = sizeof(optval);
optval = 10;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_KEEPIDLE, &optval, optlen))) {
printf("%s: Failed to set TCP_KEEPIDLE (%d)\n", passive->cfg.name, error);
goto fail;
}
/* Count down to close once per second */
optlen = sizeof(optval);
optval = 1;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_KEEPINTVL, &optval, optlen))) {
printf("%s: Failed to set TCP_KEEPINTVL (%d)\n", passive->cfg.name, error);
goto fail;
}
/* Close after idle for 3 counts */
optlen = sizeof(optval);
optval = 3;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_KEEPCNT, &optval, optlen))) {
printf("%s: Failed to set TCP_KEEPCNT (%d)\n", passive->cfg.name, error);
goto fail;
}
/* Wait 100 milliseconds for missing TCP segments */
optlen = sizeof(optval);
optval = 100;
if ((error = uinet_sosetsockopt(listen_socket, UINET_IPPROTO_TCP, UINET_TCP_REASSDL, &optval, optlen))) {
printf("%s: Failed to set TCP_REASSDL (%d)\n", passive->cfg.name, error);
goto fail;
}
passive->listen_socket = listen_socket;
memset(&sin, 0, sizeof(struct uinet_sockaddr_in));
sin.sin_len = sizeof(struct uinet_sockaddr_in);
sin.sin_family = UINET_AF_INET;
sin.sin_addr = addr;
sin.sin_port = htons(passive->listen_port);
error = uinet_sobind(listen_socket, (struct uinet_sockaddr *)&sin);
if (0 != error) {
printf("%s: Bind to %s:%u failed\n", passive->cfg.name,
passive->listen_addr, passive->listen_port);
goto fail;
}
error = uinet_solisten(passive->listen_socket, -1);
if (0 != error) {
printf("%s: Listen on %s:%u failed\n", passive->cfg.name,
passive->listen_addr, passive->listen_port);
goto fail;
}
if (passive->cfg.verbose)
printf("%s: Listening on %s:%u\n", passive->cfg.name,
passive->listen_addr, passive->listen_port);
ev_init(&passive->listen_watcher, passive_accept_cb);
ev_uinet_set(&passive->listen_watcher, soctx, EV_READ);
passive->listen_watcher.data = passive;
ev_uinet_start(loop, &passive->listen_watcher);
return (0);
fail:
if (soctx) ev_uinet_detach(soctx);
if (listen_socket) uinet_soclose(listen_socket);
return (error);
}
static struct echo_context *
create_echo(struct ev_loop *loop, struct server_config *cfg)
{
struct echo_context *echo = NULL;
struct uinet_socket *listener = NULL;
struct ev_uinet_ctx *soctx = NULL;
struct uinet_in_addr addr;
int optlen, optval;
int error;
struct uinet_sockaddr_in sin;
if (uinet_inet_pton(UINET_AF_INET, cfg->listen_addr, &addr) <= 0) {
printf("Malformed address %s\n", cfg->listen_addr);
goto fail;
}
error = uinet_socreate(UINET_PF_INET, &listener, UINET_SOCK_STREAM, 0);
if (0 != error) {
printf("Listen socket creation failed (%d)\n", error);
goto fail;
}
soctx = ev_uinet_attach(listener);
if (NULL == soctx) {
printf("Failed to alloc libev socket context\n");
goto fail;
}
if (cfg->interface->promisc) {
if ((error = uinet_make_socket_promiscuous(listener, cfg->interface->cdom))) {
printf("Failed to make listen socket promiscuous (%d)\n", error);
goto fail;
}
}
uinet_sosetnonblocking(listener, 1);
/* Set NODELAY on the listen socket so it will be set on all
* accepted sockets via inheritance.
*/
optlen = sizeof(optval);
optval = 1;
if ((error = uinet_sosetsockopt(listener, UINET_IPPROTO_TCP, UINET_TCP_NODELAY, &optval, optlen)))
goto fail;
echo = malloc(sizeof(struct echo_context));
if (NULL == echo) {
goto fail;
}
/* Listen on all VLANs */
if ((error = uinet_setl2info2(listener, NULL, NULL, UINET_INL2I_TAG_ANY, NULL))) {
printf("Listen socket L2 info set failed (%d)\n", error);
goto fail;
}
echo->loop = loop;
echo->listener = listener;
echo->verbose = cfg->verbose;
echo->listen_cdom = cfg->interface->cdom;
memset(&sin, 0, sizeof(struct uinet_sockaddr_in));
sin.sin_len = sizeof(struct uinet_sockaddr_in);
sin.sin_family = UINET_AF_INET;
sin.sin_addr = addr;
sin.sin_port = htons(cfg->listen_port);
error = uinet_sobind(listener, (struct uinet_sockaddr *)&sin);
if (0 != error) {
printf("bind failed\n");
goto fail;
}
error = uinet_solisten(echo->listener, -1);
if (0 != error)
goto fail;
if (echo->verbose) {
char buf[32];
printf("Listening on %s:%u\n", uinet_inet_ntoa(addr, buf, sizeof(buf)), cfg->listen_port);
}
ev_init(&echo->listen_watcher, accept_cb);
ev_uinet_set(&echo->listen_watcher, soctx, EV_READ);
echo->listen_watcher.data = echo;
ev_uinet_start(loop, &echo->listen_watcher);
return (echo);
fail:
if (soctx) ev_uinet_detach(soctx);
if (listener) uinet_soclose(listener);
if (echo) free(echo);
return (NULL);
}
static void
nproxy_inbound_connected_cb(struct ev_loop *loop, ev_uinet *w, int revents)
{
struct nproxy_splice *splice = w->data;
struct uinet_demo_nproxy *nproxy = splice->nproxy;
struct uinet_sockaddr_in *sin_local, *sin_foreign;
struct uinet_socket *outbound_socket = NULL;
struct ev_uinet_ctx *soctx = NULL;
struct uinet_in_l2info l2i;
char buf1[32], buf2[32];
int optlen, optval;
int error;
uinet_sogetsockaddr(w->so, (struct uinet_sockaddr **)&sin_local);
uinet_sogetpeeraddr(w->so, (struct uinet_sockaddr **)&sin_foreign);
if (splice->verbose)
printf("%s: splice %llu: inbound connection established (local=%s:%u foreign=%s:%u)\n",
nproxy->cfg.name, (unsigned long long)splice->id,
uinet_inet_ntoa(sin_local->sin_addr, buf1, sizeof(buf1)), ntohs(sin_local->sin_port),
uinet_inet_ntoa(sin_foreign->sin_addr, buf2, sizeof(buf2)), ntohs(sin_foreign->sin_port));
if ((nproxy->cfg.copy_mode & UINET_IP_COPY_MODE_MAYBE) &&
((uinet_sogetserialno(w->so) % nproxy->cfg.copy_every) == 0)){
if ((error =
uinet_sosetcopymode(w->so, UINET_IP_COPY_MODE_RX|UINET_IP_COPY_MODE_ON,
nproxy->cfg.copy_limit, nproxy->cfg.copy_uif)))
printf("%s: splice %llu: Failed to set copy mode (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
}
/* don't need this watcher anymore */
ev_uinet_stop(loop, w);
/* Create the outbound connection */
error = uinet_socreate(nproxy->cfg.uinst, UINET_PF_INET, &outbound_socket, UINET_SOCK_STREAM, 0);
if (error != 0) {
printf("%s: splice %llu: outbound socket creation failed (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
if ((error = uinet_make_socket_promiscuous(outbound_socket, nproxy->outbound_if))) {
printf("%s: splice %llu: failed to make outbound socket promiscuous (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
/*
* Socket needs to be non-blocking to work with the event system
*/
uinet_sosetnonblocking(outbound_socket, 1);
optlen = sizeof(optval);
optval = 1;
error = uinet_sosetsockopt(outbound_socket, UINET_IPPROTO_TCP, UINET_TCP_NODELAY,
&optval, optlen);
if (error != 0) {
printf("%s: splice %llu: failed to set TCP_NODELAY on outbound socket (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
/* Bind to the foreign address of the inbound connection */
error = uinet_sobind(outbound_socket, (struct uinet_sockaddr *)sin_foreign);
if (error != 0) {
printf("%s: splice %llu: outbound socket bind failed (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
/*
* Use the same MAC addrs and VLAN tag stack as the inbound
* connection, which requires swapping the local and foreign MAC
* addrs.
*/
error = uinet_getl2info(w->so, &l2i);
if (error != 0) {
printf("%s: splice %llu: unable to get l2info from inbound socket (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
error = uinet_setl2info2(outbound_socket,
l2i.inl2i_foreign_addr, l2i.inl2i_local_addr,
l2i.inl2i_flags, &l2i.inl2i_tagstack);
if (error != 0) {
printf("%s: splice %llu: unable to set l2info for outbound socket (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
soctx = ev_uinet_attach(outbound_socket);
if (NULL == soctx) {
printf("%s: splice %llu: failed to alloc libev context for outbound socket\n",
nproxy->cfg.name, (unsigned long long)splice->id);
goto fail;
}
/* The connection target is the local address of the inbound connection */
error = uinet_soconnect(outbound_socket, (struct uinet_sockaddr *)sin_local);
if ((error != 0) && (error != UINET_EINPROGRESS)) {
printf("%s: splice %llu: outbound socket connect failed (%d)\n",
nproxy->cfg.name, (unsigned long long)splice->id, error);
goto fail;
}
uinet_free_sockaddr((struct uinet_sockaddr *)sin_local);
uinet_free_sockaddr((struct uinet_sockaddr *)sin_foreign);
ev_init(&splice->outbound.connected_watcher, nproxy_outbound_connected_cb);
ev_uinet_set(&splice->outbound.connected_watcher, soctx, EV_WRITE);
splice->outbound.connected_watcher.data = splice;
ev_uinet_start(loop, &splice->outbound.connected_watcher);
ev_init(&splice->outbound.writable_watcher, nproxy_writable_cb);
ev_uinet_set(&splice->outbound.writable_watcher, soctx, EV_WRITE);
splice->outbound.writable_watcher.data = &splice->outbound;
/* will be started as necessary by the inbound copy watcher */
ev_init(&splice->outbound.copy_watcher, nproxy_copy_cb);
ev_uinet_set(&splice->outbound.copy_watcher, soctx, EV_READ);
splice->outbound.copy_watcher.data = &splice->outbound;
/* will be started when the outbound connection is established */
return;
fail:
uinet_free_sockaddr((struct uinet_sockaddr *)sin_local);
uinet_free_sockaddr((struct uinet_sockaddr *)sin_foreign);
if (soctx) ev_uinet_detach(soctx);
if (outbound_socket) uinet_soclose(outbound_socket);
free(splice);
}
