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 55 do_cmd(if_ctx *ctx, u_long op, void *arg, size_t argsize, int set) 56 { 57 struct ifdrv ifd; 58 59 memset(&ifd, 0, sizeof(ifd)); 60 61 strlcpy(ifd.ifd_name, ifr.ifr_name, sizeof(ifd.ifd_name)); 62 ifd.ifd_cmd = op; 63 ifd.ifd_len = argsize; 64 ifd.ifd_data = arg; 65 66 return (ioctl_ctx(ctx, set ? SIOCSDRVSPEC : SIOCGDRVSPEC, &ifd)); 67 } 68 69 static void 70 stf_status(if_ctx *ctx) 71 { 72 struct stfv4args param; 73 74 if (do_cmd(ctx, STF6RD_GV4NET, ¶m, sizeof(param), 0) < 0) 75 return; 76 77 printf("\tv4net %s/%d -> ", inet_ntoa(param.srcv4_addr), 78 param.v4_prefixlen ? param.v4_prefixlen : 32); 79 printf("tv4br %s\n", inet_ntoa(param.braddr)); 80 } 81 82 static void 83 setstf_br(if_ctx *ctx, const char *val, int d __unused) 84 { 85 struct stfv4args req; 86 struct sockaddr_in sin; 87 88 memset(&req, 0, sizeof(req)); 89 90 sin.sin_len = sizeof(sin); 91 sin.sin_family = AF_INET; 92 93 if (!inet_aton(val, &sin.sin_addr)) 94 errx(1, "%s: bad value", val); 95 96 req.braddr = sin.sin_addr; 97 if (do_cmd(ctx, STF6RD_SBR, &req, sizeof(req), 1) < 0) 98 err(1, "STF6RD_SBR%s", val); 99 } 100 101 static void 102 setstf_set(if_ctx *ctx, const char *val, int d __unused) 103 { 104 struct stfv4args req; 105 struct sockaddr_in sin; 106 const char *errstr; 107 char *p = NULL; 108 109 memset(&req, 0, sizeof(req)); 110 111 sin.sin_len = sizeof(sin); 112 sin.sin_family = AF_INET; 113 114 p = strrchr(val, '/'); 115 if (p == NULL) 116 errx(2, "Wrong argument given"); 117 118 *p = '\0'; 119 req.v4_prefixlen = (int)strtonum(p + 1, 0, 32, &errstr); 120 if (errstr != NULL || req.v4_prefixlen == 0) { 121 *p = '/'; 122 errx(1, "%s: bad value (prefix length %s)", val, errstr); 123 } 124 125 if (!inet_aton(val, &sin.sin_addr)) 126 errx(1, "%s: bad value", val); 127 128 memcpy(&req.srcv4_addr, &sin.sin_addr, sizeof(req.srcv4_addr)); 129 if (do_cmd(ctx, STF6RD_SV4NET, &req, sizeof(req), 1) < 0) 130 err(1, "STF6RD_SV4NET %s", val); 131 } 132 133 static struct cmd stf_cmds[] = { 134 DEF_CMD_ARG("stfv4net", setstf_set), 135 DEF_CMD_ARG("stfv4br", setstf_br), 136 }; 137 138 static struct afswtch af_stf = { 139 .af_name = "af_stf", 140 .af_af = AF_UNSPEC, 141 .af_other_status = stf_status, 142 }; 143 144 static __constructor void 145 stf_ctor(void) 146 { 147 for (size_t i = 0; i < nitems(stf_cmds); i++) 148 cmd_register(&stf_cmds[i]); 149 af_register(&af_stf); 150 } 151