1 /* $NetBSD: l2tp.c,v 1.2 2025/09/19 01:20:54 knakahara Exp $ */ 2 3 /* 4 * Copyright (c) 2017 Internet Initiative Japan Inc. 5 * All rights reserved. 6 * 7 * Redistribution and use in source and binary forms, with or without 8 * modification, are permitted provided that the following conditions 9 * are met: 10 * 1. Redistributions of source code must retain the above copyright 11 * notice, this list of conditions and the following disclaimer. 12 * 2. Redistributions in binary form must reproduce the above copyright 13 * notice, this list of conditions and the following disclaimer in the 14 * documentation and/or other materials provided with the distribution. 15 * 16 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 17 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 18 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 19 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 20 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 21 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 22 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 23 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 24 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 25 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 26 * POSSIBILITY OF SUCH DAMAGE. 27 */ 28 29 #include <sys/cdefs.h> 30 __RCSID("$NetBSD: l2tp.c,v 1.2 2025/09/19 01:20:54 knakahara Exp $"); 31 32 #include <sys/param.h> 33 #include <sys/ioctl.h> 34 35 #include <net/if.h> 36 #include <net/if_ether.h> 37 #include <net/if_l2tp.h> 38 39 #include <ctype.h> 40 #include <err.h> 41 #include <errno.h> 42 #include <string.h> 43 #include <stdlib.h> 44 #include <stdio.h> 45 #include <util.h> 46 47 #include "env.h" 48 #include "extern.h" 49 #include "util.h" 50 51 static status_func_t status; 52 static usage_func_t usage; 53 static cmdloop_branch_t branch; 54 55 static void l2tp_constructor(void) __attribute__((constructor)); 56 static void l2tp_status(prop_dictionary_t, prop_dictionary_t); 57 58 static int setl2tpsession(prop_dictionary_t, prop_dictionary_t); 59 static int deletel2tpsession(prop_dictionary_t, prop_dictionary_t); 60 static int setl2tpcookie(prop_dictionary_t, prop_dictionary_t); 61 static int deletel2tpcookie(prop_dictionary_t, prop_dictionary_t); 62 63 struct pinteger l2tpremotesession = PINTEGER_INITIALIZER1(&l2tpremotesession, 64 "remote session id", 0, UINT_MAX, 10, setl2tpsession, "l2tpremotesession", 65 &command_root.pb_parser); 66 67 struct pinteger l2tplocalsession = PINTEGER_INITIALIZER1(&l2tplocalsession, 68 "local session id", 0, UINT_MAX, 10, NULL, "l2tplocalsession", 69 &l2tpremotesession.pi_parser); 70 71 struct pinteger l2tpremotecookie = PINTEGER_INITIALIZER1(&l2tpremotecookie, 72 "remote cookie", INT64_MIN, INT64_MAX, 10, setl2tpcookie, "l2tpremotecookie", 73 &command_root.pb_parser); 74 75 struct pinteger l2tpremotecookielen = PINTEGER_INITIALIZER1(&l2tpremotecookielen, 76 "remote cookie length", 0, UINT16_MAX, 10, NULL, "l2tpremotecookielen", 77 &l2tpremotecookie.pi_parser); 78 79 struct pinteger l2tplocalcookie = PINTEGER_INITIALIZER1(&l2tplocalcookie, 80 "local cookie", INT64_MIN, INT64_MAX, 10, NULL, "l2tplocalcookie", 81 &l2tpremotecookielen.pi_parser); 82 83 struct pinteger l2tplocalcookielen = PINTEGER_INITIALIZER1(&l2tplocalcookielen, 84 "local cookie length", 0, UINT16_MAX, 10, NULL, "l2tplocalcookielen", 85 &l2tplocalcookie.pi_parser); 86 87 static const struct kwinst l2tpkw[] = { 88 {.k_word = "cookie", .k_nextparser = &l2tplocalcookielen.pi_parser} 89 ,{.k_word = "deletecookie", .k_exec = deletel2tpcookie, 90 .k_nextparser = &command_root.pb_parser} 91 ,{.k_word = "session", .k_nextparser = &l2tplocalsession.pi_parser} 92 ,{.k_word = "deletesession", .k_exec = deletel2tpsession, 93 .k_nextparser = &command_root.pb_parser} 94 }; 95 96 struct pkw l2tp = PKW_INITIALIZER(&l2tp, "l2tp", NULL, NULL, 97 l2tpkw, __arraycount(l2tpkw), NULL); 98 99 #define L2TP_COOKIE_LOCAL 0 100 #define L2TP_COOKIE_REMOTE 1 101 102 static int 103 checkifname(prop_dictionary_t env) 104 { 105 const char *ifname; 106 107 if ((ifname = getifname(env)) == NULL) 108 return 1; 109 110 return strncmp(ifname, "l2tp", 4) != 0 || 111 !isdigit((unsigned char)ifname[4]); 112 } 113 114 static int 115 getl2tp(prop_dictionary_t env, struct l2tp_req *l2tpr, bool quiet) 116 { 117 memset(l2tpr, 0, sizeof(*l2tpr)); 118 119 if (checkifname(env)) { 120 if (quiet) 121 return -1; 122 errx(EXIT_FAILURE, "valid only with l2tp(4) interfaces"); 123 } 124 125 if (indirect_ioctl(env, SIOCGL2TP, l2tpr) == -1) 126 return -1; 127 128 return 0; 129 } 130 131 int 132 deletel2tpsession(prop_dictionary_t env, prop_dictionary_t oenv) 133 { 134 struct l2tp_req l2tpr; 135 136 memset(&l2tpr, 0, sizeof(l2tpr)); 137 138 if (indirect_ioctl(env, SIOCDL2TPSESSION, &l2tpr) == -1) 139 return -1; 140 141 l2tpr.state = L2TP_STATE_DOWN; 142 143 if (indirect_ioctl(env, SIOCSL2TPSTATE, &l2tpr) == -1) 144 return -1; 145 146 147 return 0; 148 } 149 150 int 151 setl2tpsession(prop_dictionary_t env, prop_dictionary_t oenv) 152 { 153 struct l2tp_req l2tpr; 154 int64_t local_session; 155 int64_t remote_session; 156 157 memset(&l2tpr, 0, sizeof(l2tpr)); 158 159 if (!prop_dictionary_get_int64(env, "l2tplocalsession", 160 &local_session)) { 161 errno = ENOENT; 162 return -1; 163 } 164 165 if (!prop_dictionary_get_int64(env, "l2tpremotesession", 166 &remote_session)) { 167 errno = ENOENT; 168 return -1; 169 } 170 171 l2tpr.my_sess_id = local_session; 172 l2tpr.peer_sess_id = remote_session; 173 174 if (indirect_ioctl(env, SIOCSL2TPSESSION, &l2tpr) == -1) 175 return -1; 176 177 l2tpr.state = L2TP_STATE_UP; 178 179 if (indirect_ioctl(env, SIOCSL2TPSTATE, &l2tpr) == -1) 180 return -1; 181 182 return 0; 183 } 184 185 int 186 deletel2tpcookie(prop_dictionary_t env, prop_dictionary_t oenv) 187 { 188 struct l2tp_req l2tpr; 189 190 memset(&l2tpr, 0, sizeof(l2tpr)); 191 192 if (indirect_ioctl(env, SIOCDL2TPCOOKIE, &l2tpr) == -1) 193 return -1; 194 195 return 0; 196 } 197 198 int 199 setl2tpcookie(prop_dictionary_t env, prop_dictionary_t oenv) 200 { 201 struct l2tp_req l2tpr; 202 uint16_t cookielen; 203 uint64_t cookie; 204 205 memset(&l2tpr, 0, sizeof(l2tpr)); 206 207 if (!prop_dictionary_get_uint16(env, "l2tplocalcookielen", &cookielen)) { 208 errno = ENOENT; 209 return -1; 210 } 211 if (!prop_dictionary_get_uint64(env, "l2tplocalcookie", &cookie)) { 212 errno = ENOENT; 213 return -1; 214 } 215 l2tpr.my_cookie_len = cookielen; 216 l2tpr.my_cookie = cookie; 217 218 if (!prop_dictionary_get_uint16(env, "l2tpremotecookielen", &cookielen)) { 219 errno = ENOENT; 220 return -1; 221 } 222 if (!prop_dictionary_get_uint64(env, "l2tpremotecookie", &cookie)) { 223 errno = ENOENT; 224 return -1; 225 } 226 l2tpr.peer_cookie_len = cookielen; 227 l2tpr.peer_cookie = cookie; 228 229 if (indirect_ioctl(env, SIOCSL2TPCOOKIE, &l2tpr) == -1) 230 return -1; 231 232 return 0; 233 } 234 235 static void 236 l2tp_status(prop_dictionary_t env, prop_dictionary_t oenv) 237 { 238 struct l2tp_req l2tpr; 239 240 if (getl2tp(env, &l2tpr, true) == -1) 241 return; 242 243 printf("\tl2tp-state: %s\n", l2tpr.state == L2TP_STATE_UP ? "up" : "down"); 244 245 if (l2tpr.my_sess_id != 0 || l2tpr.peer_sess_id != 0) { 246 printf("\tlocal-session-id: %u\n", l2tpr.my_sess_id); 247 printf("\tremote-session-id: %u\n", l2tpr.peer_sess_id); 248 } 249 250 if (l2tpr.my_cookie != 0 || l2tpr.peer_cookie != 0) { 251 printf("\tlocal-cookie: %" PRIu64 "\n", l2tpr.my_cookie); 252 printf("\tremote-cookie: %" PRIu64 "\n", l2tpr.peer_cookie); 253 } 254 } 255 256 static void 257 l2tp_usage(prop_dictionary_t env) 258 { 259 fprintf(stderr, "\t[ session local-session-id remote-session-id ]\n"); 260 fprintf(stderr, "\t[ cookie local-cookie-length local-cookie remote-cookie-length remote-cookie ]\n"); 261 } 262 263 static void 264 l2tp_constructor(void) 265 { 266 cmdloop_branch_init(&branch, &l2tp.pk_parser); 267 register_cmdloop_branch(&branch); 268 status_func_init(&status, l2tp_status); 269 usage_func_init(&usage, l2tp_usage); 270 register_status(&status); 271 register_usage(&usage); 272 } 273