1 /*-
2 * Copyright 2013 Ermal Luci
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 * notice, this list of conditions and the following disclaimer in the
12 * documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
16 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
17 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
18 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
19 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
20 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
21 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
22 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
23 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
24 * POSSIBILITY OF SUCH DAMAGE.
25 */
26
27 #include <sys/param.h>
28 #include <sys/ioctl.h>
29 #include <sys/socket.h>
30 #include <sys/sockio.h>
31
32 #include <stdlib.h>
33 #include <unistd.h>
34
35 #include <net/ethernet.h>
36 #include <net/if.h>
37 #include <net/route.h>
38
39 #include <netinet/in.h>
40 #include <sys/mbuf.h>
41 #include <net/if_stf.h>
42 #include <arpa/inet.h>
43
44 #include <ctype.h>
45 #include <stdio.h>
46 #include <string.h>
47 #include <stdlib.h>
48 #include <unistd.h>
49 #include <err.h>
50 #include <errno.h>
51
52 #include "ifconfig.h"
53
54 static int
do_cmd(if_ctx * ctx,u_long op,void * arg,size_t argsize,int set)55 do_cmd(if_ctx *ctx, u_long op, void *arg, size_t argsize, int set)
56 {
57 struct ifdrv ifd = {};
58
59 strlcpy(ifd.ifd_name, ctx->ifname, sizeof(ifd.ifd_name));
60 ifd.ifd_cmd = op;
61 ifd.ifd_len = argsize;
62 ifd.ifd_data = arg;
63
64 return (ioctl_ctx(ctx, set ? SIOCSDRVSPEC : SIOCGDRVSPEC, &ifd));
65 }
66
67 static void
stf_status(if_ctx * ctx)68 stf_status(if_ctx *ctx)
69 {
70 struct stfv4args param;
71
72 if (do_cmd(ctx, STF6RD_GV4NET, ¶m, sizeof(param), 0) < 0)
73 return;
74
75 printf("\tv4net %s/%d -> ", inet_ntoa(param.srcv4_addr),
76 param.v4_prefixlen ? param.v4_prefixlen : 32);
77 printf("tv4br %s\n", inet_ntoa(param.braddr));
78 }
79
80 static void
setstf_br(if_ctx * ctx,const char * val,int d __unused)81 setstf_br(if_ctx *ctx, const char *val, int d __unused)
82 {
83 struct stfv4args req;
84 struct sockaddr_in sin;
85
86 memset(&req, 0, sizeof(req));
87
88 sin.sin_len = sizeof(sin);
89 sin.sin_family = AF_INET;
90
91 if (!inet_aton(val, &sin.sin_addr))
92 errx(1, "%s: bad value", val);
93
94 req.braddr = sin.sin_addr;
95 if (do_cmd(ctx, STF6RD_SBR, &req, sizeof(req), 1) < 0)
96 err(1, "STF6RD_SBR%s", val);
97 }
98
99 static void
setstf_set(if_ctx * ctx,const char * val,int d __unused)100 setstf_set(if_ctx *ctx, const char *val, int d __unused)
101 {
102 struct stfv4args req;
103 struct sockaddr_in sin;
104 const char *errstr;
105 char *p = NULL;
106
107 memset(&req, 0, sizeof(req));
108
109 sin.sin_len = sizeof(sin);
110 sin.sin_family = AF_INET;
111
112 p = strrchr(val, '/');
113 if (p == NULL)
114 errx(2, "Wrong argument given");
115
116 *p = '\0';
117 req.v4_prefixlen = (int)strtonum(p + 1, 0, 32, &errstr);
118 if (errstr != NULL || req.v4_prefixlen == 0) {
119 *p = '/';
120 errx(1, "%s: bad value (prefix length %s)", val, errstr);
121 }
122
123 if (!inet_aton(val, &sin.sin_addr))
124 errx(1, "%s: bad value", val);
125
126 memcpy(&req.srcv4_addr, &sin.sin_addr, sizeof(req.srcv4_addr));
127 if (do_cmd(ctx, STF6RD_SV4NET, &req, sizeof(req), 1) < 0)
128 err(1, "STF6RD_SV4NET %s", val);
129 }
130
131 static struct cmd stf_cmds[] = {
132 DEF_CMD_ARG("stfv4net", setstf_set),
133 DEF_CMD_ARG("stfv4br", setstf_br),
134 };
135
136 static struct afswtch af_stf = {
137 .af_name = "af_stf",
138 .af_af = AF_UNSPEC,
139 .af_other_status = stf_status,
140 };
141
142 static __constructor void
stf_ctor(void)143 stf_ctor(void)
144 {
145 for (size_t i = 0; i < nitems(stf_cmds); i++)
146 cmd_register(&stf_cmds[i]);
147 af_register(&af_stf);
148 }
149