187c3786eSBrian Somers /*- 287c3786eSBrian Somers * Copyright (c) 1999 Brian Somers <brian@Awfulhak.org> 387c3786eSBrian Somers * All rights reserved. 487c3786eSBrian Somers * 587c3786eSBrian Somers * Redistribution and use in source and binary forms, with or without 687c3786eSBrian Somers * modification, are permitted provided that the following conditions 787c3786eSBrian Somers * are met: 887c3786eSBrian Somers * 1. Redistributions of source code must retain the above copyright 987c3786eSBrian Somers * notice, this list of conditions and the following disclaimer. 1087c3786eSBrian Somers * 2. Redistributions in binary form must reproduce the above copyright 1187c3786eSBrian Somers * notice, this list of conditions and the following disclaimer in the 1287c3786eSBrian Somers * documentation and/or other materials provided with the distribution. 1387c3786eSBrian Somers * 1487c3786eSBrian Somers * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 1587c3786eSBrian Somers * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 1687c3786eSBrian Somers * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 1787c3786eSBrian Somers * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 1887c3786eSBrian Somers * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 1987c3786eSBrian Somers * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 2087c3786eSBrian Somers * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 2187c3786eSBrian Somers * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 2287c3786eSBrian Somers * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 2387c3786eSBrian Somers * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 2487c3786eSBrian Somers * SUCH DAMAGE. 2587c3786eSBrian Somers * 2687c3786eSBrian Somers * $FreeBSD$ 2787c3786eSBrian Somers */ 2887c3786eSBrian Somers 2987c3786eSBrian Somers #include <sys/param.h> 3087c3786eSBrian Somers #include <sys/socket.h> 3187c3786eSBrian Somers #include <sys/un.h> 3287c3786eSBrian Somers #include <netinet/in.h> 3387c3786eSBrian Somers #include <arpa/inet.h> 3487c3786eSBrian Somers #include <netdb.h> 3587c3786eSBrian Somers #include <netgraph.h> 3687c3786eSBrian Somers #include <net/ethernet.h> 37dc744e19SBrian Somers #include <net/if.h> 38dc744e19SBrian Somers #include <net/route.h> 3987c3786eSBrian Somers #include <netinet/in_systm.h> 4087c3786eSBrian Somers #include <netinet/ip.h> 4187c3786eSBrian Somers #include <netgraph/ng_ether.h> 4287c3786eSBrian Somers #include <netgraph/ng_message.h> 4387c3786eSBrian Somers #include <netgraph/ng_pppoe.h> 4487c3786eSBrian Somers #include <netgraph/ng_socket.h> 4587c3786eSBrian Somers 4687c3786eSBrian Somers #include <errno.h> 4787c3786eSBrian Somers #include <stdio.h> 4887c3786eSBrian Somers #include <stdlib.h> 4987c3786eSBrian Somers #include <string.h> 5087c3786eSBrian Somers #include <sysexits.h> 5187c3786eSBrian Somers #include <sys/fcntl.h> 5287c3786eSBrian Somers #if defined(__FreeBSD__) && !defined(NOKLDLOAD) 5387c3786eSBrian Somers #include <sys/linker.h> 54fdb4bb1bSBrian Somers #include <sys/module.h> 5587c3786eSBrian Somers #endif 56165fbe26SBrian Somers #include <sys/stat.h> 5787c3786eSBrian Somers #include <sys/uio.h> 5887c3786eSBrian Somers #include <termios.h> 5987c3786eSBrian Somers #include <sys/time.h> 6087c3786eSBrian Somers #include <unistd.h> 6187c3786eSBrian Somers 6287c3786eSBrian Somers #include "layer.h" 6387c3786eSBrian Somers #include "defs.h" 6487c3786eSBrian Somers #include "mbuf.h" 6587c3786eSBrian Somers #include "log.h" 6687c3786eSBrian Somers #include "timer.h" 6787c3786eSBrian Somers #include "lqr.h" 6887c3786eSBrian Somers #include "hdlc.h" 6987c3786eSBrian Somers #include "throughput.h" 7087c3786eSBrian Somers #include "fsm.h" 7187c3786eSBrian Somers #include "lcp.h" 7287c3786eSBrian Somers #include "ccp.h" 7387c3786eSBrian Somers #include "link.h" 7487c3786eSBrian Somers #include "async.h" 7587c3786eSBrian Somers #include "descriptor.h" 7687c3786eSBrian Somers #include "physical.h" 7787c3786eSBrian Somers #include "main.h" 7887c3786eSBrian Somers #include "mp.h" 7987c3786eSBrian Somers #include "chat.h" 8087c3786eSBrian Somers #include "auth.h" 8187c3786eSBrian Somers #include "chap.h" 8287c3786eSBrian Somers #include "cbcp.h" 8387c3786eSBrian Somers #include "datalink.h" 8487c3786eSBrian Somers #include "slcompress.h" 8587c3786eSBrian Somers #include "iplist.h" 8630949fd4SBrian Somers #include "ncpaddr.h" 8730949fd4SBrian Somers #include "ip.h" 8887c3786eSBrian Somers #include "ipcp.h" 8987c3786eSBrian Somers #include "filter.h" 9087c3786eSBrian Somers #ifndef NORADIUS 9187c3786eSBrian Somers #include "radius.h" 9287c3786eSBrian Somers #endif 9330949fd4SBrian Somers #include "ipv6cp.h" 9430949fd4SBrian Somers #include "ncp.h" 9587c3786eSBrian Somers #include "bundle.h" 9687c3786eSBrian Somers #include "id.h" 97dc744e19SBrian Somers #include "iface.h" 9887c3786eSBrian Somers #include "ether.h" 9987c3786eSBrian Somers 10087c3786eSBrian Somers 10187c3786eSBrian Somers #define PPPOE_NODE_TYPE_LEN (sizeof NG_PPPOE_NODE_TYPE - 1) /* "PPPoE" */ 10287c3786eSBrian Somers 10387c3786eSBrian Somers struct etherdevice { 10487c3786eSBrian Somers struct device dev; /* What struct physical knows about */ 10587c3786eSBrian Somers int cs; /* Control socket */ 10687c3786eSBrian Somers int connected; /* Are we connected yet ? */ 10787c3786eSBrian Somers int timeout; /* Seconds attempting to connect */ 10887c3786eSBrian Somers char hook[sizeof TUN_NAME + 11]; /* Our socket node hook */ 10987c3786eSBrian Somers }; 11087c3786eSBrian Somers 11187c3786eSBrian Somers #define device2ether(d) \ 11287c3786eSBrian Somers ((d)->type == ETHER_DEVICE ? (struct etherdevice *)d : NULL) 11387c3786eSBrian Somers 11487c3786eSBrian Somers int 11587c3786eSBrian Somers ether_DeviceSize(void) 11687c3786eSBrian Somers { 11787c3786eSBrian Somers return sizeof(struct etherdevice); 11887c3786eSBrian Somers } 11987c3786eSBrian Somers 12087c3786eSBrian Somers static ssize_t 12187c3786eSBrian Somers ether_Write(struct physical *p, const void *v, size_t n) 12287c3786eSBrian Somers { 12387c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 12487c3786eSBrian Somers 12587c3786eSBrian Somers return NgSendData(p->fd, dev->hook, v, n) == -1 ? -1 : n; 12687c3786eSBrian Somers } 12787c3786eSBrian Somers 12887c3786eSBrian Somers static ssize_t 12987c3786eSBrian Somers ether_Read(struct physical *p, void *v, size_t n) 13087c3786eSBrian Somers { 13187c3786eSBrian Somers char hook[sizeof TUN_NAME + 11]; 13287c3786eSBrian Somers 13387c3786eSBrian Somers return NgRecvData(p->fd, v, n, hook); 13487c3786eSBrian Somers } 13587c3786eSBrian Somers 13687c3786eSBrian Somers static int 13787c3786eSBrian Somers ether_RemoveFromSet(struct physical *p, fd_set *r, fd_set *w, fd_set *e) 13887c3786eSBrian Somers { 13987c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 14087c3786eSBrian Somers int result; 14187c3786eSBrian Somers 14287c3786eSBrian Somers if (r && dev->cs >= 0 && FD_ISSET(dev->cs, r)) { 14387c3786eSBrian Somers FD_CLR(dev->cs, r); 14487c3786eSBrian Somers log_Printf(LogTIMER, "%s: fdunset(ctrl) %d\n", p->link.name, dev->cs); 14587c3786eSBrian Somers result = 1; 14687c3786eSBrian Somers } else 14787c3786eSBrian Somers result = 0; 14887c3786eSBrian Somers 14987c3786eSBrian Somers /* Careful... physical_RemoveFromSet() called us ! */ 15087c3786eSBrian Somers 15187c3786eSBrian Somers p->handler->removefromset = NULL; 15287c3786eSBrian Somers result += physical_RemoveFromSet(p, r, w, e); 15387c3786eSBrian Somers p->handler->removefromset = ether_RemoveFromSet; 15487c3786eSBrian Somers 15587c3786eSBrian Somers return result; 15687c3786eSBrian Somers } 15787c3786eSBrian Somers 15887c3786eSBrian Somers static void 15987c3786eSBrian Somers ether_Free(struct physical *p) 16087c3786eSBrian Somers { 16187c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 16287c3786eSBrian Somers 16387c3786eSBrian Somers physical_SetDescriptor(p); 16487c3786eSBrian Somers if (dev->cs != -1) 16587c3786eSBrian Somers close(dev->cs); 16687c3786eSBrian Somers free(dev); 16787c3786eSBrian Somers } 16887c3786eSBrian Somers 16987c3786eSBrian Somers static const char * 17087c3786eSBrian Somers ether_OpenInfo(struct physical *p) 17187c3786eSBrian Somers { 17287c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 17387c3786eSBrian Somers 17487c3786eSBrian Somers switch (dev->connected) { 17587c3786eSBrian Somers case CARRIER_PENDING: 17687c3786eSBrian Somers return "negotiating"; 17787c3786eSBrian Somers case CARRIER_OK: 17887c3786eSBrian Somers return "established"; 17987c3786eSBrian Somers } 18087c3786eSBrian Somers 18187c3786eSBrian Somers return "disconnected"; 18287c3786eSBrian Somers } 18387c3786eSBrian Somers 18487c3786eSBrian Somers static void 18587c3786eSBrian Somers ether_device2iov(struct device *d, struct iovec *iov, int *niov, 1862cb305afSBrian Somers int maxiov, int *auxfd, int *nauxfd) 18787c3786eSBrian Somers { 18887c3786eSBrian Somers struct etherdevice *dev = device2ether(d); 18987c3786eSBrian Somers int sz = physical_MaxDeviceSize(); 19087c3786eSBrian Somers 19187c3786eSBrian Somers iov[*niov].iov_base = realloc(d, sz); 19287c3786eSBrian Somers if (iov[*niov].iov_base == NULL) { 19387c3786eSBrian Somers log_Printf(LogALERT, "Failed to allocate memory: %d\n", sz); 19487c3786eSBrian Somers AbortProgram(EX_OSERR); 19587c3786eSBrian Somers } 19687c3786eSBrian Somers iov[*niov].iov_len = sz; 19787c3786eSBrian Somers (*niov)++; 19887c3786eSBrian Somers 19987c3786eSBrian Somers if (dev->cs >= 0) { 20087c3786eSBrian Somers *auxfd = dev->cs; 20187c3786eSBrian Somers (*nauxfd)++; 20287c3786eSBrian Somers } 20387c3786eSBrian Somers } 20487c3786eSBrian Somers 20587c3786eSBrian Somers static void 20687c3786eSBrian Somers ether_MessageIn(struct etherdevice *dev) 20787c3786eSBrian Somers { 20887c3786eSBrian Somers char msgbuf[sizeof(struct ng_mesg) + sizeof(struct ngpppoe_sts)]; 20987c3786eSBrian Somers struct ng_mesg *rep = (struct ng_mesg *)msgbuf; 21087c3786eSBrian Somers struct ngpppoe_sts *sts = (struct ngpppoe_sts *)(msgbuf + sizeof *rep); 21187c3786eSBrian Somers char unknown[14]; 21287c3786eSBrian Somers const char *msg; 21387c3786eSBrian Somers struct timeval t; 2148a52f3ecSBrian Somers fd_set *r; 2158a52f3ecSBrian Somers int ret; 21687c3786eSBrian Somers 21787c3786eSBrian Somers if (dev->cs < 0) 21887c3786eSBrian Somers return; 21987c3786eSBrian Somers 2208a52f3ecSBrian Somers if ((r = mkfdset()) == NULL) { 2218a52f3ecSBrian Somers log_Printf(LogERROR, "DoLoop: Cannot create fd_set\n"); 2228a52f3ecSBrian Somers return; 2238a52f3ecSBrian Somers } 2248a52f3ecSBrian Somers zerofdset(r); 2258a52f3ecSBrian Somers FD_SET(dev->cs, r); 22687c3786eSBrian Somers t.tv_sec = t.tv_usec = 0; 2278a52f3ecSBrian Somers ret = select(dev->cs + 1, r, NULL, NULL, &t); 2288a52f3ecSBrian Somers free(r); 2298a52f3ecSBrian Somers 2308a52f3ecSBrian Somers if (ret <= 0) 23187c3786eSBrian Somers return; 23287c3786eSBrian Somers 23387c3786eSBrian Somers if (NgRecvMsg(dev->cs, rep, sizeof msgbuf, NULL) < 0) 23487c3786eSBrian Somers return; 23587c3786eSBrian Somers 23687c3786eSBrian Somers if (rep->header.version != NG_VERSION) { 23787c3786eSBrian Somers log_Printf(LogWARN, "%ld: Unexpected netgraph version, expected %ld\n", 23887c3786eSBrian Somers (long)rep->header.version, (long)NG_VERSION); 23987c3786eSBrian Somers return; 24087c3786eSBrian Somers } 24187c3786eSBrian Somers 24287c3786eSBrian Somers if (rep->header.typecookie != NGM_PPPOE_COOKIE) { 24387c3786eSBrian Somers log_Printf(LogWARN, "%ld: Unexpected netgraph cookie, expected %ld\n", 24487c3786eSBrian Somers (long)rep->header.typecookie, (long)NGM_PPPOE_COOKIE); 24587c3786eSBrian Somers return; 24687c3786eSBrian Somers } 24787c3786eSBrian Somers 24887c3786eSBrian Somers switch (rep->header.cmd) { 24987c3786eSBrian Somers case NGM_PPPOE_SET_FLAG: msg = "SET_FLAG"; break; 25087c3786eSBrian Somers case NGM_PPPOE_CONNECT: msg = "CONNECT"; break; 25187c3786eSBrian Somers case NGM_PPPOE_LISTEN: msg = "LISTEN"; break; 25287c3786eSBrian Somers case NGM_PPPOE_OFFER: msg = "OFFER"; break; 25387c3786eSBrian Somers case NGM_PPPOE_SUCCESS: msg = "SUCCESS"; break; 25487c3786eSBrian Somers case NGM_PPPOE_FAIL: msg = "FAIL"; break; 25587c3786eSBrian Somers case NGM_PPPOE_CLOSE: msg = "CLOSE"; break; 25687c3786eSBrian Somers case NGM_PPPOE_GET_STATUS: msg = "GET_STATUS"; break; 25787c3786eSBrian Somers default: 25887c3786eSBrian Somers snprintf(unknown, sizeof unknown, "<%d>", (int)rep->header.cmd); 25987c3786eSBrian Somers msg = unknown; 26087c3786eSBrian Somers break; 26187c3786eSBrian Somers } 26287c3786eSBrian Somers 26387c3786eSBrian Somers log_Printf(LogPHASE, "Received NGM_PPPOE_%s (hook \"%s\")\n", msg, sts->hook); 26487c3786eSBrian Somers 26587c3786eSBrian Somers switch (rep->header.cmd) { 26687c3786eSBrian Somers case NGM_PPPOE_SUCCESS: 26787c3786eSBrian Somers dev->connected = CARRIER_OK; 26887c3786eSBrian Somers break; 26987c3786eSBrian Somers case NGM_PPPOE_FAIL: 27087c3786eSBrian Somers case NGM_PPPOE_CLOSE: 27187c3786eSBrian Somers dev->connected = CARRIER_LOST; 27287c3786eSBrian Somers break; 27387c3786eSBrian Somers } 27487c3786eSBrian Somers } 27587c3786eSBrian Somers 27687c3786eSBrian Somers static int 27787c3786eSBrian Somers ether_AwaitCarrier(struct physical *p) 27887c3786eSBrian Somers { 27987c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 28087c3786eSBrian Somers 281772d2e09SBrian Somers if (dev->connected != CARRIER_OK && !dev->timeout--) 28287c3786eSBrian Somers dev->connected = CARRIER_LOST; 28387c3786eSBrian Somers else if (dev->connected == CARRIER_PENDING) 28487c3786eSBrian Somers ether_MessageIn(dev); 28587c3786eSBrian Somers 28687c3786eSBrian Somers return dev->connected; 28787c3786eSBrian Somers } 28887c3786eSBrian Somers 28987c3786eSBrian Somers static const struct device baseetherdevice = { 29087c3786eSBrian Somers ETHER_DEVICE, 29187c3786eSBrian Somers "ether", 292c8b9fb53SBrian Somers 1492, 293fdc29d54SBrian Somers { CD_REQUIRED, DEF_ETHERCDDELAY }, 29487c3786eSBrian Somers ether_AwaitCarrier, 29587c3786eSBrian Somers ether_RemoveFromSet, 29687c3786eSBrian Somers NULL, 29787c3786eSBrian Somers NULL, 29887c3786eSBrian Somers NULL, 29987c3786eSBrian Somers NULL, 30087c3786eSBrian Somers ether_Free, 30187c3786eSBrian Somers ether_Read, 30287c3786eSBrian Somers ether_Write, 30387c3786eSBrian Somers ether_device2iov, 30487c3786eSBrian Somers NULL, 30587c3786eSBrian Somers ether_OpenInfo 30687c3786eSBrian Somers }; 30787c3786eSBrian Somers 30887c3786eSBrian Somers struct device * 30987c3786eSBrian Somers ether_iov2device(int type, struct physical *p, struct iovec *iov, int *niov, 31087c3786eSBrian Somers int maxiov, int *auxfd, int *nauxfd) 31187c3786eSBrian Somers { 31287c3786eSBrian Somers if (type == ETHER_DEVICE) { 31387c3786eSBrian Somers struct etherdevice *dev = (struct etherdevice *)iov[(*niov)++].iov_base; 31487c3786eSBrian Somers 31587c3786eSBrian Somers dev = realloc(dev, sizeof *dev); /* Reduce to the correct size */ 31687c3786eSBrian Somers if (dev == NULL) { 31787c3786eSBrian Somers log_Printf(LogALERT, "Failed to allocate memory: %d\n", 31887c3786eSBrian Somers (int)(sizeof *dev)); 31987c3786eSBrian Somers AbortProgram(EX_OSERR); 32087c3786eSBrian Somers } 32187c3786eSBrian Somers 32287c3786eSBrian Somers if (*nauxfd) { 32387c3786eSBrian Somers dev->cs = *auxfd; 32487c3786eSBrian Somers (*nauxfd)--; 32587c3786eSBrian Somers } else 32687c3786eSBrian Somers dev->cs = -1; 32787c3786eSBrian Somers 32887c3786eSBrian Somers /* Refresh function pointers etc */ 32987c3786eSBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev); 33087c3786eSBrian Somers 33187c3786eSBrian Somers physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF); 33287c3786eSBrian Somers return &dev->dev; 33387c3786eSBrian Somers } 33487c3786eSBrian Somers 33587c3786eSBrian Somers return NULL; 33687c3786eSBrian Somers } 33787c3786eSBrian Somers 33887c3786eSBrian Somers static int 339f013f33eSBrian Somers ether_UpdateSet(struct fdescriptor *d, fd_set *r, fd_set *w, fd_set *e, int *n) 34087c3786eSBrian Somers { 34187c3786eSBrian Somers struct physical *p = descriptor2physical(d); 34287c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 34387c3786eSBrian Somers int result; 34487c3786eSBrian Somers 34587c3786eSBrian Somers if (r && dev->cs >= 0) { 34687c3786eSBrian Somers FD_SET(dev->cs, r); 34787c3786eSBrian Somers log_Printf(LogTIMER, "%s(ctrl): fdset(r) %d\n", p->link.name, dev->cs); 34887c3786eSBrian Somers result = 1; 34987c3786eSBrian Somers } else 35087c3786eSBrian Somers result = 0; 35187c3786eSBrian Somers 35287c3786eSBrian Somers result += physical_doUpdateSet(d, r, w, e, n, 0); 35387c3786eSBrian Somers 35487c3786eSBrian Somers return result; 35587c3786eSBrian Somers } 35687c3786eSBrian Somers 35787c3786eSBrian Somers static int 358f013f33eSBrian Somers ether_IsSet(struct fdescriptor *d, const fd_set *fdset) 35987c3786eSBrian Somers { 36087c3786eSBrian Somers struct physical *p = descriptor2physical(d); 36187c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 36287c3786eSBrian Somers int result; 36387c3786eSBrian Somers 36487c3786eSBrian Somers result = dev->cs >= 0 && FD_ISSET(dev->cs, fdset); 36587c3786eSBrian Somers result += physical_IsSet(d, fdset); 36687c3786eSBrian Somers 36787c3786eSBrian Somers return result; 36887c3786eSBrian Somers } 36987c3786eSBrian Somers 37087c3786eSBrian Somers static void 371f013f33eSBrian Somers ether_DescriptorRead(struct fdescriptor *d, struct bundle *bundle, 37287c3786eSBrian Somers const fd_set *fdset) 37387c3786eSBrian Somers { 37487c3786eSBrian Somers struct physical *p = descriptor2physical(d); 37587c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler); 37687c3786eSBrian Somers 37787c3786eSBrian Somers if (dev->cs >= 0 && FD_ISSET(dev->cs, fdset)) { 37887c3786eSBrian Somers ether_MessageIn(dev); 37987c3786eSBrian Somers if (dev->connected == CARRIER_LOST) { 38087c3786eSBrian Somers log_Printf(LogPHASE, "%s: Device disconnected\n", p->link.name); 38187c3786eSBrian Somers datalink_Down(p->dl, CLOSE_NORMAL); 38287c3786eSBrian Somers return; 38387c3786eSBrian Somers } 38487c3786eSBrian Somers } 38587c3786eSBrian Somers 38687c3786eSBrian Somers if (physical_IsSet(d, fdset)) 38787c3786eSBrian Somers physical_DescriptorRead(d, bundle, fdset); 38887c3786eSBrian Somers } 38987c3786eSBrian Somers 39087c3786eSBrian Somers static struct device * 39187c3786eSBrian Somers ether_Abandon(struct etherdevice *dev, struct physical *p) 39287c3786eSBrian Somers { 39387c3786eSBrian Somers /* Abandon our node construction */ 39487c3786eSBrian Somers close(dev->cs); 39587c3786eSBrian Somers close(p->fd); 39687c3786eSBrian Somers p->fd = -2; /* Nobody else need try.. */ 39787c3786eSBrian Somers free(dev); 39887c3786eSBrian Somers 39987c3786eSBrian Somers return NULL; 40087c3786eSBrian Somers } 40187c3786eSBrian Somers 40287c3786eSBrian Somers struct device * 40387c3786eSBrian Somers ether_Create(struct physical *p) 40487c3786eSBrian Somers { 40587c3786eSBrian Somers u_char rbuf[2048]; 40687c3786eSBrian Somers struct etherdevice *dev; 40787c3786eSBrian Somers struct ng_mesg *resp; 40887c3786eSBrian Somers const struct hooklist *hlist; 40987c3786eSBrian Somers const struct nodeinfo *ninfo; 410dc744e19SBrian Somers char *path; 411dc744e19SBrian Somers int ifacelen, f; 41287c3786eSBrian Somers 41387c3786eSBrian Somers dev = NULL; 414dc744e19SBrian Somers path = NULL; 415dc744e19SBrian Somers ifacelen = 0; 41687c3786eSBrian Somers if (p->fd < 0 && !strncasecmp(p->name.full, NG_PPPOE_NODE_TYPE, 41787c3786eSBrian Somers PPPOE_NODE_TYPE_LEN) && 41887c3786eSBrian Somers p->name.full[PPPOE_NODE_TYPE_LEN] == ':') { 41987c3786eSBrian Somers const struct linkinfo *nlink; 42087c3786eSBrian Somers struct ngpppoe_init_data *data; 42187c3786eSBrian Somers struct ngm_mkpeer mkp; 42287c3786eSBrian Somers struct ngm_connect ngc; 42387c3786eSBrian Somers const char *iface, *provider; 424dc744e19SBrian Somers char etherid[12]; 425dc744e19SBrian Somers int providerlen; 42687c3786eSBrian Somers char connectpath[sizeof dev->hook + 2]; /* .:<hook> */ 42787c3786eSBrian Somers 42887c3786eSBrian Somers p->fd--; /* We own the device - change fd */ 42987c3786eSBrian Somers 430fdb4bb1bSBrian Somers #if defined(__FreeBSD__) && !defined(NOKLDLOAD) 4316ccdc30bSBrian Somers if (modfind("netgraph") == -1 && ID0kldload("netgraph") == -1) { 4326ccdc30bSBrian Somers log_Printf(LogWARN, "kldload: netgraph: %s\n", strerror(errno)); 43387c3786eSBrian Somers return NULL; 43487c3786eSBrian Somers } 43587c3786eSBrian Somers 436a61800c2SBrian Somers if (modfind("ng_ether") == -1 && ID0kldload("ng_ether") == -1) 437a61800c2SBrian Somers /* 438a61800c2SBrian Somers * Don't treat this as an error as older kernels have this stuff 439a61800c2SBrian Somers * built in as part of the netgraph node itself. 440a61800c2SBrian Somers */ 441a61800c2SBrian Somers log_Printf(LogWARN, "kldload: ng_ether: %s\n", strerror(errno)); 442a61800c2SBrian Somers 443cef1df88SBrian Somers if (modfind("ng_pppoe") == -1 && ID0kldload("ng_pppoe") == -1) { 444cef1df88SBrian Somers log_Printf(LogWARN, "kldload: ng_pppoe: %s\n", strerror(errno)); 445cef1df88SBrian Somers return NULL; 446cef1df88SBrian Somers } 447cef1df88SBrian Somers 448a61800c2SBrian Somers if (modfind("ng_socket") == -1 && ID0kldload("ng_socket") == -1) { 44987c3786eSBrian Somers log_Printf(LogWARN, "kldload: ng_socket: %s\n", strerror(errno)); 45087c3786eSBrian Somers return NULL; 45187c3786eSBrian Somers } 45287c3786eSBrian Somers #endif 45387c3786eSBrian Somers 45487c3786eSBrian Somers if ((dev = malloc(sizeof *dev)) == NULL) 45587c3786eSBrian Somers return NULL; 45687c3786eSBrian Somers 45787c3786eSBrian Somers iface = p->name.full + PPPOE_NODE_TYPE_LEN + 1; 45887c3786eSBrian Somers 45987c3786eSBrian Somers provider = strchr(iface, ':'); 46087c3786eSBrian Somers if (provider) { 46187c3786eSBrian Somers ifacelen = provider - iface; 46287c3786eSBrian Somers provider++; 46387c3786eSBrian Somers providerlen = strlen(provider); 46487c3786eSBrian Somers } else { 46587c3786eSBrian Somers ifacelen = strlen(iface); 46687c3786eSBrian Somers provider = ""; 46787c3786eSBrian Somers providerlen = 0; 46887c3786eSBrian Somers } 46987c3786eSBrian Somers 47087c3786eSBrian Somers /* 47187c3786eSBrian Somers * We're going to do this (where tunN is our tunnel device): 47287c3786eSBrian Somers * 47387c3786eSBrian Somers * .---------. 47487c3786eSBrian Somers * | ether | 47587c3786eSBrian Somers * | <iface> | dev->cs 47687c3786eSBrian Somers * `---------' | 47787c3786eSBrian Somers * (orphan) p->fd | 47887c3786eSBrian Somers * | | | 47987c3786eSBrian Somers * | | | 48087c3786eSBrian Somers * (ethernet) | | 48187c3786eSBrian Somers * .---------. .-----------. 48287c3786eSBrian Somers * | pppoe | | socket | 48387c3786eSBrian Somers * | <iface> |(tunN)<---->(tunN)| <unnamed> | 48487c3786eSBrian Somers * `--------- `-----------' 48587c3786eSBrian Somers * (tunX) 48687c3786eSBrian Somers * ^ 48787c3786eSBrian Somers * | 48887c3786eSBrian Somers * `--->(tunX) 48987c3786eSBrian Somers */ 49087c3786eSBrian Somers 49187c3786eSBrian Somers /* Create a socket node */ 49231dd45c4SBrian Somers if (ID0NgMkSockNode(NULL, &dev->cs, &p->fd) == -1) { 49387c3786eSBrian Somers log_Printf(LogWARN, "Cannot create netgraph socket node: %s\n", 49487c3786eSBrian Somers strerror(errno)); 49587c3786eSBrian Somers free(dev); 49687c3786eSBrian Somers return NULL; 49787c3786eSBrian Somers } 49887c3786eSBrian Somers 49987c3786eSBrian Somers /* 50087c3786eSBrian Somers * Ask for a list of hooks attached to the "ether" node. This node should 50187c3786eSBrian Somers * magically exist as a way of hooking stuff onto an ethernet device 50287c3786eSBrian Somers */ 50387c3786eSBrian Somers path = (char *)alloca(ifacelen + 2); 50487c3786eSBrian Somers sprintf(path, "%.*s:", ifacelen, iface); 50587c3786eSBrian Somers if (NgSendMsg(dev->cs, path, NGM_GENERIC_COOKIE, NGM_LISTHOOKS, 50687c3786eSBrian Somers NULL, 0) < 0) { 50787c3786eSBrian Somers log_Printf(LogWARN, "%s Cannot send a netgraph message: %s\n", 50887c3786eSBrian Somers path, strerror(errno)); 50987c3786eSBrian Somers return ether_Abandon(dev, p); 51087c3786eSBrian Somers } 51187c3786eSBrian Somers 51287c3786eSBrian Somers /* Get our list back */ 51387c3786eSBrian Somers resp = (struct ng_mesg *)rbuf; 51487c3786eSBrian Somers if (NgRecvMsg(dev->cs, resp, sizeof rbuf, NULL) < 0) { 51587c3786eSBrian Somers log_Printf(LogWARN, "Cannot get netgraph response: %s\n", 51687c3786eSBrian Somers strerror(errno)); 51787c3786eSBrian Somers return ether_Abandon(dev, p); 51887c3786eSBrian Somers } 51987c3786eSBrian Somers 52087c3786eSBrian Somers hlist = (const struct hooklist *)resp->data; 52187c3786eSBrian Somers ninfo = &hlist->nodeinfo; 52287c3786eSBrian Somers 52387c3786eSBrian Somers /* Make sure we've got the right type of node */ 52487c3786eSBrian Somers if (strncmp(ninfo->type, NG_ETHER_NODE_TYPE, 52587c3786eSBrian Somers sizeof NG_ETHER_NODE_TYPE - 1)) { 52687c3786eSBrian Somers log_Printf(LogWARN, "%s Unexpected node type ``%s'' (wanted ``" 52787c3786eSBrian Somers NG_ETHER_NODE_TYPE "'')\n", path, ninfo->type); 52887c3786eSBrian Somers return ether_Abandon(dev, p); 52987c3786eSBrian Somers } 53087c3786eSBrian Somers 5316b8b6befSBrian Somers log_Printf(LogDEBUG, "List of netgraph node ``%s'' (id %x) hooks:\n", 53287c3786eSBrian Somers path, ninfo->id); 53387c3786eSBrian Somers 53487c3786eSBrian Somers /* look for a hook already attached. */ 53587c3786eSBrian Somers for (f = 0; f < ninfo->hooks; f++) { 53687c3786eSBrian Somers nlink = &hlist->link[f]; 53787c3786eSBrian Somers 53887c3786eSBrian Somers log_Printf(LogDEBUG, " Found %s -> %s\n", nlink->ourhook, 53987c3786eSBrian Somers nlink->peerhook); 54087c3786eSBrian Somers 54187c3786eSBrian Somers if (!strcmp(nlink->ourhook, NG_ETHER_HOOK_ORPHAN) || 54287c3786eSBrian Somers !strcmp(nlink->ourhook, NG_ETHER_HOOK_DIVERT)) { 54387c3786eSBrian Somers /* 54487c3786eSBrian Somers * Something is using the data coming out of this ``ether'' node. 54587c3786eSBrian Somers * If it's a PPPoE node, we use that node, otherwise we complain that 54687c3786eSBrian Somers * someone else is using the node. 54787c3786eSBrian Somers */ 54887c3786eSBrian Somers if (!strcmp(nlink->nodeinfo.type, NG_PPPOE_NODE_TYPE)) 54987c3786eSBrian Somers /* Use this PPPoE node ! */ 5506b8b6befSBrian Somers snprintf(ngc.path, sizeof ngc.path, "[%x]:", nlink->nodeinfo.id); 55187c3786eSBrian Somers else { 55287c3786eSBrian Somers log_Printf(LogWARN, "%s Node type ``%s'' is currently active\n", 55387c3786eSBrian Somers path, nlink->nodeinfo.type); 55487c3786eSBrian Somers return ether_Abandon(dev, p); 55587c3786eSBrian Somers } 55687c3786eSBrian Somers break; 55787c3786eSBrian Somers } 55887c3786eSBrian Somers } 55987c3786eSBrian Somers 56087c3786eSBrian Somers if (f == ninfo->hooks) { 56187c3786eSBrian Somers /* 56287c3786eSBrian Somers * Create a new ``PPPoE'' node connected to the ``ether'' node using 56387c3786eSBrian Somers * the magic ``orphan'' and ``ethernet'' hooks 56487c3786eSBrian Somers */ 56587c3786eSBrian Somers snprintf(mkp.type, sizeof mkp.type, "%s", NG_PPPOE_NODE_TYPE); 56687c3786eSBrian Somers snprintf(mkp.ourhook, sizeof mkp.ourhook, "%s", NG_ETHER_HOOK_ORPHAN); 56787c3786eSBrian Somers snprintf(mkp.peerhook, sizeof mkp.peerhook, "%s", NG_PPPOE_HOOK_ETHERNET); 5686b8b6befSBrian Somers snprintf(etherid, sizeof etherid, "[%x]:", ninfo->id); 56987c3786eSBrian Somers 57087c3786eSBrian Somers log_Printf(LogDEBUG, "Creating PPPoE netgraph node %s%s -> %s\n", 57187c3786eSBrian Somers etherid, mkp.ourhook, mkp.peerhook); 57287c3786eSBrian Somers 57387c3786eSBrian Somers if (NgSendMsg(dev->cs, etherid, NGM_GENERIC_COOKIE, 57487c3786eSBrian Somers NGM_MKPEER, &mkp, sizeof mkp) < 0) { 57587c3786eSBrian Somers log_Printf(LogWARN, "%s Cannot create PPPoE netgraph node: %s\n", 57687c3786eSBrian Somers etherid, strerror(errno)); 57787c3786eSBrian Somers return ether_Abandon(dev, p); 57887c3786eSBrian Somers } 57987c3786eSBrian Somers 58087c3786eSBrian Somers snprintf(ngc.path, sizeof ngc.path, "%s%s", path, NG_ETHER_HOOK_ORPHAN); 58187c3786eSBrian Somers } 58287c3786eSBrian Somers 58387c3786eSBrian Somers snprintf(dev->hook, sizeof dev->hook, "%s%d", 58487c3786eSBrian Somers TUN_NAME, p->dl->bundle->unit); 58587c3786eSBrian Somers 58687c3786eSBrian Somers /* 58787c3786eSBrian Somers * Connect the PPPoE node to our socket node. 58887c3786eSBrian Somers * ngc.path has already been set up 58987c3786eSBrian Somers */ 59087c3786eSBrian Somers snprintf(ngc.ourhook, sizeof ngc.ourhook, "%s", dev->hook); 59187c3786eSBrian Somers memcpy(ngc.peerhook, ngc.ourhook, sizeof ngc.peerhook); 59287c3786eSBrian Somers 59387c3786eSBrian Somers log_Printf(LogDEBUG, "Connecting netgraph socket .:%s -> %s:%s\n", 59487c3786eSBrian Somers ngc.ourhook, ngc.path, ngc.peerhook); 59587c3786eSBrian Somers if (NgSendMsg(dev->cs, ".:", NGM_GENERIC_COOKIE, 59687c3786eSBrian Somers NGM_CONNECT, &ngc, sizeof ngc) < 0) { 59787c3786eSBrian Somers log_Printf(LogWARN, "Cannot connect PPPoE and socket netgraph " 59887c3786eSBrian Somers "nodes: %s\n", strerror(errno)); 59987c3786eSBrian Somers return ether_Abandon(dev, p); 60087c3786eSBrian Somers } 60187c3786eSBrian Somers 6028152dca8SBrian Somers /* Bring the Ethernet interface up */ 6038152dca8SBrian Somers path[ifacelen] = '\0'; /* Remove the trailing ':' */ 6048152dca8SBrian Somers if (!iface_SetFlags(path, IFF_UP)) 6058152dca8SBrian Somers log_Printf(LogWARN, "%s: Failed to set the IFF_UP flag on %s\n", 6068152dca8SBrian Somers p->link.name, path); 6078152dca8SBrian Somers 60887c3786eSBrian Somers /* And finally, request a connection to the given provider */ 60987c3786eSBrian Somers 610fbf03853SBrian Somers data = (struct ngpppoe_init_data *)alloca(sizeof *data + providerlen); 61187c3786eSBrian Somers snprintf(data->hook, sizeof data->hook, "%s", dev->hook); 61280e2e6b6SBrian Somers memcpy(data->data, provider, providerlen); 61380e2e6b6SBrian Somers data->data_len = providerlen; 61487c3786eSBrian Somers 61587c3786eSBrian Somers snprintf(connectpath, sizeof connectpath, ".:%s", dev->hook); 61687c3786eSBrian Somers log_Printf(LogDEBUG, "Sending PPPOE_CONNECT to %s\n", connectpath); 61787c3786eSBrian Somers if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE, 61887c3786eSBrian Somers NGM_PPPOE_CONNECT, data, sizeof *data + providerlen) == -1) { 61987c3786eSBrian Somers log_Printf(LogWARN, "``%s'': Cannot start netgraph node: %s\n", 62087c3786eSBrian Somers connectpath, strerror(errno)); 62187c3786eSBrian Somers return ether_Abandon(dev, p); 62287c3786eSBrian Somers } 62387c3786eSBrian Somers 62440125273SBrian Somers /* Hook things up so that we monitor dev->cs */ 62540125273SBrian Somers p->desc.UpdateSet = ether_UpdateSet; 62640125273SBrian Somers p->desc.IsSet = ether_IsSet; 62740125273SBrian Somers p->desc.Read = ether_DescriptorRead; 628fdc29d54SBrian Somers 629fdc29d54SBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev); 630fdc29d54SBrian Somers switch (p->cfg.cd.necessity) { 631fdc29d54SBrian Somers case CD_VARIABLE: 632fdc29d54SBrian Somers dev->dev.cd.delay = p->cfg.cd.delay; 633fdc29d54SBrian Somers break; 634fdc29d54SBrian Somers case CD_REQUIRED: 635fdc29d54SBrian Somers dev->dev.cd = p->cfg.cd; 636fdc29d54SBrian Somers break; 637fdc29d54SBrian Somers case CD_NOTREQUIRED: 638fdc29d54SBrian Somers log_Printf(LogWARN, "%s: Carrier must be set, using ``set cd %d!''\n", 639fdc29d54SBrian Somers p->link.name, dev->dev.cd.delay); 640fdc29d54SBrian Somers case CD_DEFAULT: 641fdc29d54SBrian Somers break; 642fdc29d54SBrian Somers } 643fdc29d54SBrian Somers 644fdc29d54SBrian Somers dev->timeout = dev->dev.cd.delay; 645fdc29d54SBrian Somers dev->connected = CARRIER_PENDING; 646fdc29d54SBrian Somers 64787c3786eSBrian Somers } else { 64887c3786eSBrian Somers /* See if we're a netgraph socket */ 649165fbe26SBrian Somers struct stat st; 650165fbe26SBrian Somers 651165fbe26SBrian Somers if (fstat(p->fd, &st) != -1 && (st.st_mode & S_IFSOCK)) { 652165fbe26SBrian Somers struct sockaddr_storage ssock; 653165fbe26SBrian Somers struct sockaddr *sock = (struct sockaddr *)&ssock; 65487c3786eSBrian Somers int sz; 65587c3786eSBrian Somers 656165fbe26SBrian Somers sz = sizeof ssock; 657165fbe26SBrian Somers if (getsockname(p->fd, sock, &sz) == -1) { 658165fbe26SBrian Somers log_Printf(LogPHASE, "%s: Link is a closed socket !\n", p->link.name); 659165fbe26SBrian Somers close(p->fd); 660165fbe26SBrian Somers p->fd = -1; 661165fbe26SBrian Somers return NULL; 662165fbe26SBrian Somers } 663165fbe26SBrian Somers 664165fbe26SBrian Somers if (sock->sa_family == AF_NETGRAPH) { 66587c3786eSBrian Somers /* 66640125273SBrian Somers * It's a netgraph node... We can't determine hook names etc, so we 66740125273SBrian Somers * stay pretty impartial.... 66887c3786eSBrian Somers */ 66940125273SBrian Somers log_Printf(LogPHASE, "%s: Link is a netgraph node\n", p->link.name); 67087c3786eSBrian Somers 67187c3786eSBrian Somers if ((dev = malloc(sizeof *dev)) == NULL) { 67287c3786eSBrian Somers log_Printf(LogWARN, "%s: Cannot allocate an ether device: %s\n", 67387c3786eSBrian Somers p->link.name, strerror(errno)); 67487c3786eSBrian Somers return NULL; 67587c3786eSBrian Somers } 67687c3786eSBrian Somers 677fdc29d54SBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev); 67887c3786eSBrian Somers dev->cs = -1; 67987c3786eSBrian Somers dev->timeout = 0; 68087c3786eSBrian Somers dev->connected = CARRIER_OK; 68140125273SBrian Somers *dev->hook = '\0'; 68287c3786eSBrian Somers } 68387c3786eSBrian Somers } 684165fbe26SBrian Somers } 68587c3786eSBrian Somers 68687c3786eSBrian Somers if (dev) { 68787c3786eSBrian Somers physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF); 68887c3786eSBrian Somers return &dev->dev; 68987c3786eSBrian Somers } 69087c3786eSBrian Somers 69187c3786eSBrian Somers return NULL; 69287c3786eSBrian Somers } 693