xref: /freebsd/usr.sbin/ppp/ether.c (revision b5bc6d4db0d4a428ce9fc6395ba1b12ec45cd95f)
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>
52165fbe26SBrian Somers #include <sys/stat.h>
5387c3786eSBrian Somers #include <sys/uio.h>
5487c3786eSBrian Somers #include <termios.h>
5587c3786eSBrian Somers #include <sys/time.h>
56de59e178SBrian Somers #include <syslog.h>
5787c3786eSBrian Somers #include <unistd.h>
5887c3786eSBrian Somers 
5987c3786eSBrian Somers #include "layer.h"
6087c3786eSBrian Somers #include "defs.h"
6187c3786eSBrian Somers #include "mbuf.h"
6287c3786eSBrian Somers #include "log.h"
6387c3786eSBrian Somers #include "timer.h"
6487c3786eSBrian Somers #include "lqr.h"
6587c3786eSBrian Somers #include "hdlc.h"
6687c3786eSBrian Somers #include "throughput.h"
6787c3786eSBrian Somers #include "fsm.h"
6887c3786eSBrian Somers #include "lcp.h"
6987c3786eSBrian Somers #include "ccp.h"
7087c3786eSBrian Somers #include "link.h"
7187c3786eSBrian Somers #include "async.h"
7287c3786eSBrian Somers #include "descriptor.h"
7387c3786eSBrian Somers #include "physical.h"
7487c3786eSBrian Somers #include "main.h"
7587c3786eSBrian Somers #include "mp.h"
7687c3786eSBrian Somers #include "chat.h"
7787c3786eSBrian Somers #include "auth.h"
7887c3786eSBrian Somers #include "chap.h"
7987c3786eSBrian Somers #include "cbcp.h"
8087c3786eSBrian Somers #include "datalink.h"
8187c3786eSBrian Somers #include "slcompress.h"
8287c3786eSBrian Somers #include "iplist.h"
8330949fd4SBrian Somers #include "ncpaddr.h"
8430949fd4SBrian Somers #include "ip.h"
8587c3786eSBrian Somers #include "ipcp.h"
8687c3786eSBrian Somers #include "filter.h"
8787c3786eSBrian Somers #ifndef NORADIUS
8887c3786eSBrian Somers #include "radius.h"
8987c3786eSBrian Somers #endif
9030949fd4SBrian Somers #include "ipv6cp.h"
9130949fd4SBrian Somers #include "ncp.h"
9287c3786eSBrian Somers #include "bundle.h"
9387c3786eSBrian Somers #include "id.h"
94dc744e19SBrian Somers #include "iface.h"
95de59e178SBrian Somers #include "route.h"
9687c3786eSBrian Somers #include "ether.h"
9787c3786eSBrian Somers 
9887c3786eSBrian Somers 
9987c3786eSBrian Somers #define PPPOE_NODE_TYPE_LEN (sizeof NG_PPPOE_NODE_TYPE - 1) /* "PPPoE" */
10087c3786eSBrian Somers 
10187c3786eSBrian Somers struct etherdevice {
10287c3786eSBrian Somers   struct device dev;			/* What struct physical knows about */
10387c3786eSBrian Somers   int cs;				/* Control socket */
10487c3786eSBrian Somers   int connected;			/* Are we connected yet ? */
10587c3786eSBrian Somers   int timeout;				/* Seconds attempting to connect */
10687c3786eSBrian Somers   char hook[sizeof TUN_NAME + 11];	/* Our socket node hook */
107de59e178SBrian Somers   u_int32_t slot;			/* ifindex << 24 | unit */
10887c3786eSBrian Somers };
10987c3786eSBrian Somers 
11087c3786eSBrian Somers #define device2ether(d) \
11187c3786eSBrian Somers   ((d)->type == ETHER_DEVICE ? (struct etherdevice *)d : NULL)
11287c3786eSBrian Somers 
11387c3786eSBrian Somers int
11487c3786eSBrian Somers ether_DeviceSize(void)
11587c3786eSBrian Somers {
11687c3786eSBrian Somers   return sizeof(struct etherdevice);
11787c3786eSBrian Somers }
11887c3786eSBrian Somers 
11987c3786eSBrian Somers static ssize_t
12087c3786eSBrian Somers ether_Write(struct physical *p, const void *v, size_t n)
12187c3786eSBrian Somers {
12287c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
12387c3786eSBrian Somers 
12487c3786eSBrian Somers   return NgSendData(p->fd, dev->hook, v, n) == -1 ? -1 : n;
12587c3786eSBrian Somers }
12687c3786eSBrian Somers 
12787c3786eSBrian Somers static ssize_t
12887c3786eSBrian Somers ether_Read(struct physical *p, void *v, size_t n)
12987c3786eSBrian Somers {
13087c3786eSBrian Somers   char hook[sizeof TUN_NAME + 11];
13187c3786eSBrian Somers 
13287c3786eSBrian Somers   return NgRecvData(p->fd, v, n, hook);
13387c3786eSBrian Somers }
13487c3786eSBrian Somers 
13587c3786eSBrian Somers static int
13687c3786eSBrian Somers ether_RemoveFromSet(struct physical *p, fd_set *r, fd_set *w, fd_set *e)
13787c3786eSBrian Somers {
13887c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
13987c3786eSBrian Somers   int result;
14087c3786eSBrian Somers 
14187c3786eSBrian Somers   if (r && dev->cs >= 0 && FD_ISSET(dev->cs, r)) {
14287c3786eSBrian Somers     FD_CLR(dev->cs, r);
14387c3786eSBrian Somers     log_Printf(LogTIMER, "%s: fdunset(ctrl) %d\n", p->link.name, dev->cs);
14487c3786eSBrian Somers     result = 1;
14587c3786eSBrian Somers   } else
14687c3786eSBrian Somers     result = 0;
14787c3786eSBrian Somers 
14887c3786eSBrian Somers   /* Careful... physical_RemoveFromSet() called us ! */
14987c3786eSBrian Somers 
15087c3786eSBrian Somers   p->handler->removefromset = NULL;
15187c3786eSBrian Somers   result += physical_RemoveFromSet(p, r, w, e);
15287c3786eSBrian Somers   p->handler->removefromset = ether_RemoveFromSet;
15387c3786eSBrian Somers 
15487c3786eSBrian Somers   return result;
15587c3786eSBrian Somers }
15687c3786eSBrian Somers 
15787c3786eSBrian Somers static void
15887c3786eSBrian Somers ether_Free(struct physical *p)
15987c3786eSBrian Somers {
16087c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
16187c3786eSBrian Somers 
16287c3786eSBrian Somers   physical_SetDescriptor(p);
16387c3786eSBrian Somers   if (dev->cs != -1)
16487c3786eSBrian Somers     close(dev->cs);
16587c3786eSBrian Somers   free(dev);
16687c3786eSBrian Somers }
16787c3786eSBrian Somers 
16887c3786eSBrian Somers static const char *
16987c3786eSBrian Somers ether_OpenInfo(struct physical *p)
17087c3786eSBrian Somers {
17187c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
17287c3786eSBrian Somers 
17387c3786eSBrian Somers   switch (dev->connected) {
17487c3786eSBrian Somers     case CARRIER_PENDING:
17587c3786eSBrian Somers       return "negotiating";
17687c3786eSBrian Somers     case CARRIER_OK:
17787c3786eSBrian Somers       return "established";
17887c3786eSBrian Somers   }
17987c3786eSBrian Somers 
18087c3786eSBrian Somers   return "disconnected";
18187c3786eSBrian Somers }
18287c3786eSBrian Somers 
183de59e178SBrian Somers static int
184de59e178SBrian Somers ether_Slot(struct physical *p)
185de59e178SBrian Somers {
186de59e178SBrian Somers   struct etherdevice *dev = device2ether(p->handler);
187de59e178SBrian Somers 
188de59e178SBrian Somers   return dev->slot;
189de59e178SBrian Somers }
190de59e178SBrian Somers 
191de59e178SBrian Somers 
19287c3786eSBrian Somers static void
19387c3786eSBrian Somers ether_device2iov(struct device *d, struct iovec *iov, int *niov,
1942cb305afSBrian Somers                  int maxiov, int *auxfd, int *nauxfd)
19587c3786eSBrian Somers {
19687c3786eSBrian Somers   struct etherdevice *dev = device2ether(d);
19787c3786eSBrian Somers   int sz = physical_MaxDeviceSize();
19887c3786eSBrian Somers 
19987c3786eSBrian Somers   iov[*niov].iov_base = realloc(d, sz);
20087c3786eSBrian Somers   if (iov[*niov].iov_base == NULL) {
20187c3786eSBrian Somers     log_Printf(LogALERT, "Failed to allocate memory: %d\n", sz);
20287c3786eSBrian Somers     AbortProgram(EX_OSERR);
20387c3786eSBrian Somers   }
20487c3786eSBrian Somers   iov[*niov].iov_len = sz;
20587c3786eSBrian Somers   (*niov)++;
20687c3786eSBrian Somers 
20787c3786eSBrian Somers   if (dev->cs >= 0) {
20887c3786eSBrian Somers     *auxfd = dev->cs;
20987c3786eSBrian Somers     (*nauxfd)++;
21087c3786eSBrian Somers   }
21187c3786eSBrian Somers }
21287c3786eSBrian Somers 
21387c3786eSBrian Somers static void
21487c3786eSBrian Somers ether_MessageIn(struct etherdevice *dev)
21587c3786eSBrian Somers {
21687c3786eSBrian Somers   char msgbuf[sizeof(struct ng_mesg) + sizeof(struct ngpppoe_sts)];
21787c3786eSBrian Somers   struct ng_mesg *rep = (struct ng_mesg *)msgbuf;
21887c3786eSBrian Somers   struct ngpppoe_sts *sts = (struct ngpppoe_sts *)(msgbuf + sizeof *rep);
219de59e178SBrian Somers   char *end, unknown[14], sessionid[5];
22087c3786eSBrian Somers   const char *msg;
22187c3786eSBrian Somers   struct timeval t;
2228a52f3ecSBrian Somers   fd_set *r;
223de59e178SBrian Somers   u_long slot;
224dbc46ca4SBrian Somers   int asciilen, ret;
22587c3786eSBrian Somers 
22687c3786eSBrian Somers   if (dev->cs < 0)
22787c3786eSBrian Somers     return;
22887c3786eSBrian Somers 
2298a52f3ecSBrian Somers   if ((r = mkfdset()) == NULL) {
2308a52f3ecSBrian Somers     log_Printf(LogERROR, "DoLoop: Cannot create fd_set\n");
2318a52f3ecSBrian Somers     return;
2328a52f3ecSBrian Somers   }
2336ca7707bSBrian Somers 
2346ca7707bSBrian Somers   while (1) {
2358a52f3ecSBrian Somers     zerofdset(r);
2368a52f3ecSBrian Somers     FD_SET(dev->cs, r);
23787c3786eSBrian Somers     t.tv_sec = t.tv_usec = 0;
2388a52f3ecSBrian Somers     ret = select(dev->cs + 1, r, NULL, NULL, &t);
2398a52f3ecSBrian Somers 
2408a52f3ecSBrian Somers     if (ret <= 0)
2416ca7707bSBrian Somers       break;
24287c3786eSBrian Somers 
2431a939a07SBrian Somers     if (NgRecvMsg(dev->cs, rep, sizeof msgbuf, NULL) <= 0)
2446ca7707bSBrian Somers       break;
24587c3786eSBrian Somers 
24687c3786eSBrian Somers     if (rep->header.version != NG_VERSION) {
24787c3786eSBrian Somers       log_Printf(LogWARN, "%ld: Unexpected netgraph version, expected %ld\n",
24887c3786eSBrian Somers                  (long)rep->header.version, (long)NG_VERSION);
2496ca7707bSBrian Somers       break;
25087c3786eSBrian Somers     }
25187c3786eSBrian Somers 
25287c3786eSBrian Somers     if (rep->header.typecookie != NGM_PPPOE_COOKIE) {
25387c3786eSBrian Somers       log_Printf(LogWARN, "%ld: Unexpected netgraph cookie, expected %ld\n",
25487c3786eSBrian Somers                  (long)rep->header.typecookie, (long)NGM_PPPOE_COOKIE);
2556ca7707bSBrian Somers       break;
25687c3786eSBrian Somers     }
25787c3786eSBrian Somers 
258dbc46ca4SBrian Somers     asciilen = 0;
25987c3786eSBrian Somers     switch (rep->header.cmd) {
26087c3786eSBrian Somers       case NGM_PPPOE_SET_FLAG:	msg = "SET_FLAG";	break;
26187c3786eSBrian Somers       case NGM_PPPOE_CONNECT:	msg = "CONNECT";	break;
26287c3786eSBrian Somers       case NGM_PPPOE_LISTEN:	msg = "LISTEN";		break;
26387c3786eSBrian Somers       case NGM_PPPOE_OFFER:	msg = "OFFER";		break;
26487c3786eSBrian Somers       case NGM_PPPOE_SUCCESS:	msg = "SUCCESS";	break;
26587c3786eSBrian Somers       case NGM_PPPOE_FAIL:	msg = "FAIL";		break;
26687c3786eSBrian Somers       case NGM_PPPOE_CLOSE:	msg = "CLOSE";		break;
26787c3786eSBrian Somers       case NGM_PPPOE_GET_STATUS:	msg = "GET_STATUS";	break;
2687f77b559SBrian Somers       case NGM_PPPOE_ACNAME:
2697f77b559SBrian Somers         msg = "ACNAME";
2707f77b559SBrian Somers         if (setenv("ACNAME", sts->hook, 1) != 0)
2717f77b559SBrian Somers           log_Printf(LogWARN, "setenv: cannot set ACNAME=%s: %m", sts->hook);
272dbc46ca4SBrian Somers         asciilen = rep->header.arglen;
2737f77b559SBrian Somers         break;
274de59e178SBrian Somers       case NGM_PPPOE_SESSIONID:
275de59e178SBrian Somers         msg = "SESSIONID";
276de59e178SBrian Somers         snprintf(sessionid, sizeof sessionid, "%04x", *(u_int16_t *)sts);
277de59e178SBrian Somers         if (setenv("SESSIONID", sessionid, 1) != 0)
278de59e178SBrian Somers           syslog(LOG_WARNING, "setenv: cannot set SESSIONID=%s: %m",
279de59e178SBrian Somers                  sessionid);
280de59e178SBrian Somers         /* Use this in preference to our interface index */
281de59e178SBrian Somers         slot = strtoul(sessionid, &end, 16);
282de59e178SBrian Somers         if (end != sessionid && *end == '\0')
283de59e178SBrian Somers             dev->slot = slot;
284de59e178SBrian Somers         break;
28587c3786eSBrian Somers       default:
28687c3786eSBrian Somers         snprintf(unknown, sizeof unknown, "<%d>", (int)rep->header.cmd);
28787c3786eSBrian Somers         msg = unknown;
28887c3786eSBrian Somers         break;
28987c3786eSBrian Somers     }
29087c3786eSBrian Somers 
291dbc46ca4SBrian Somers     if (asciilen)
292dbc46ca4SBrian Somers       log_Printf(LogPHASE, "Received NGM_PPPOE_%s (hook \"%.*s\")\n",
293dbc46ca4SBrian Somers                  msg, asciilen, sts->hook);
294dbc46ca4SBrian Somers     else
295dbc46ca4SBrian Somers       log_Printf(LogPHASE, "Received NGM_PPPOE_%s\n", msg);
29687c3786eSBrian Somers 
29787c3786eSBrian Somers     switch (rep->header.cmd) {
29887c3786eSBrian Somers       case NGM_PPPOE_SUCCESS:
29987c3786eSBrian Somers         dev->connected = CARRIER_OK;
30087c3786eSBrian Somers         break;
30187c3786eSBrian Somers       case NGM_PPPOE_FAIL:
30287c3786eSBrian Somers       case NGM_PPPOE_CLOSE:
30387c3786eSBrian Somers         dev->connected = CARRIER_LOST;
30487c3786eSBrian Somers         break;
30587c3786eSBrian Somers     }
30687c3786eSBrian Somers   }
3076ca7707bSBrian Somers   free(r);
3086ca7707bSBrian Somers }
30987c3786eSBrian Somers 
31087c3786eSBrian Somers static int
31187c3786eSBrian Somers ether_AwaitCarrier(struct physical *p)
31287c3786eSBrian Somers {
31387c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
31487c3786eSBrian Somers 
315772d2e09SBrian Somers   if (dev->connected != CARRIER_OK && !dev->timeout--)
31687c3786eSBrian Somers     dev->connected = CARRIER_LOST;
31787c3786eSBrian Somers   else if (dev->connected == CARRIER_PENDING)
31887c3786eSBrian Somers     ether_MessageIn(dev);
31987c3786eSBrian Somers 
32087c3786eSBrian Somers   return dev->connected;
32187c3786eSBrian Somers }
32287c3786eSBrian Somers 
32387c3786eSBrian Somers static const struct device baseetherdevice = {
32487c3786eSBrian Somers   ETHER_DEVICE,
32587c3786eSBrian Somers   "ether",
326c8b9fb53SBrian Somers   1492,
327fdc29d54SBrian Somers   { CD_REQUIRED, DEF_ETHERCDDELAY },
32887c3786eSBrian Somers   ether_AwaitCarrier,
32987c3786eSBrian Somers   ether_RemoveFromSet,
33087c3786eSBrian Somers   NULL,
33187c3786eSBrian Somers   NULL,
33287c3786eSBrian Somers   NULL,
33387c3786eSBrian Somers   NULL,
334fb11a9c2SBrian Somers   NULL,
33587c3786eSBrian Somers   ether_Free,
33687c3786eSBrian Somers   ether_Read,
33787c3786eSBrian Somers   ether_Write,
33887c3786eSBrian Somers   ether_device2iov,
33987c3786eSBrian Somers   NULL,
340de59e178SBrian Somers   ether_OpenInfo,
341de59e178SBrian Somers   ether_Slot
34287c3786eSBrian Somers };
34387c3786eSBrian Somers 
34487c3786eSBrian Somers struct device *
34587c3786eSBrian Somers ether_iov2device(int type, struct physical *p, struct iovec *iov, int *niov,
34687c3786eSBrian Somers                  int maxiov, int *auxfd, int *nauxfd)
34787c3786eSBrian Somers {
34887c3786eSBrian Somers   if (type == ETHER_DEVICE) {
34987c3786eSBrian Somers     struct etherdevice *dev = (struct etherdevice *)iov[(*niov)++].iov_base;
35087c3786eSBrian Somers 
35187c3786eSBrian Somers     dev = realloc(dev, sizeof *dev);	/* Reduce to the correct size */
35287c3786eSBrian Somers     if (dev == NULL) {
35387c3786eSBrian Somers       log_Printf(LogALERT, "Failed to allocate memory: %d\n",
35487c3786eSBrian Somers                  (int)(sizeof *dev));
35587c3786eSBrian Somers       AbortProgram(EX_OSERR);
35687c3786eSBrian Somers     }
35787c3786eSBrian Somers 
35887c3786eSBrian Somers     if (*nauxfd) {
35987c3786eSBrian Somers       dev->cs = *auxfd;
36087c3786eSBrian Somers       (*nauxfd)--;
36187c3786eSBrian Somers     } else
36287c3786eSBrian Somers       dev->cs = -1;
36387c3786eSBrian Somers 
36487c3786eSBrian Somers     /* Refresh function pointers etc */
36587c3786eSBrian Somers     memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
36687c3786eSBrian Somers 
36787c3786eSBrian Somers     physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
36887c3786eSBrian Somers     return &dev->dev;
36987c3786eSBrian Somers   }
37087c3786eSBrian Somers 
37187c3786eSBrian Somers   return NULL;
37287c3786eSBrian Somers }
37387c3786eSBrian Somers 
37487c3786eSBrian Somers static int
375f013f33eSBrian Somers ether_UpdateSet(struct fdescriptor *d, fd_set *r, fd_set *w, fd_set *e, int *n)
37687c3786eSBrian Somers {
37787c3786eSBrian Somers   struct physical *p = descriptor2physical(d);
37887c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
37987c3786eSBrian Somers   int result;
38087c3786eSBrian Somers 
38187c3786eSBrian Somers   if (r && dev->cs >= 0) {
38287c3786eSBrian Somers     FD_SET(dev->cs, r);
38387c3786eSBrian Somers     log_Printf(LogTIMER, "%s(ctrl): fdset(r) %d\n", p->link.name, dev->cs);
38487c3786eSBrian Somers     result = 1;
38587c3786eSBrian Somers   } else
38687c3786eSBrian Somers     result = 0;
38787c3786eSBrian Somers 
38887c3786eSBrian Somers   result += physical_doUpdateSet(d, r, w, e, n, 0);
38987c3786eSBrian Somers 
39087c3786eSBrian Somers   return result;
39187c3786eSBrian Somers }
39287c3786eSBrian Somers 
39387c3786eSBrian Somers static int
394f013f33eSBrian Somers ether_IsSet(struct fdescriptor *d, const fd_set *fdset)
39587c3786eSBrian Somers {
39687c3786eSBrian Somers   struct physical *p = descriptor2physical(d);
39787c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
39887c3786eSBrian Somers   int result;
39987c3786eSBrian Somers 
40087c3786eSBrian Somers   result = dev->cs >= 0 && FD_ISSET(dev->cs, fdset);
40187c3786eSBrian Somers   result += physical_IsSet(d, fdset);
40287c3786eSBrian Somers 
40387c3786eSBrian Somers   return result;
40487c3786eSBrian Somers }
40587c3786eSBrian Somers 
40687c3786eSBrian Somers static void
407f013f33eSBrian Somers ether_DescriptorRead(struct fdescriptor *d, struct bundle *bundle,
40887c3786eSBrian Somers                      const fd_set *fdset)
40987c3786eSBrian Somers {
41087c3786eSBrian Somers   struct physical *p = descriptor2physical(d);
41187c3786eSBrian Somers   struct etherdevice *dev = device2ether(p->handler);
41287c3786eSBrian Somers 
41387c3786eSBrian Somers   if (dev->cs >= 0 && FD_ISSET(dev->cs, fdset)) {
41487c3786eSBrian Somers     ether_MessageIn(dev);
41587c3786eSBrian Somers     if (dev->connected == CARRIER_LOST) {
41687c3786eSBrian Somers       log_Printf(LogPHASE, "%s: Device disconnected\n", p->link.name);
41787c3786eSBrian Somers       datalink_Down(p->dl, CLOSE_NORMAL);
41887c3786eSBrian Somers       return;
41987c3786eSBrian Somers     }
42087c3786eSBrian Somers   }
42187c3786eSBrian Somers 
42287c3786eSBrian Somers   if (physical_IsSet(d, fdset))
42387c3786eSBrian Somers     physical_DescriptorRead(d, bundle, fdset);
42487c3786eSBrian Somers }
42587c3786eSBrian Somers 
42687c3786eSBrian Somers static struct device *
42787c3786eSBrian Somers ether_Abandon(struct etherdevice *dev, struct physical *p)
42887c3786eSBrian Somers {
42987c3786eSBrian Somers   /* Abandon our node construction */
43087c3786eSBrian Somers   close(dev->cs);
43187c3786eSBrian Somers   close(p->fd);
43287c3786eSBrian Somers   p->fd = -2;	/* Nobody else need try.. */
43387c3786eSBrian Somers   free(dev);
43487c3786eSBrian Somers 
43587c3786eSBrian Somers   return NULL;
43687c3786eSBrian Somers }
43787c3786eSBrian Somers 
43887c3786eSBrian Somers struct device *
43987c3786eSBrian Somers ether_Create(struct physical *p)
44087c3786eSBrian Somers {
44187c3786eSBrian Somers   u_char rbuf[2048];
44287c3786eSBrian Somers   struct etherdevice *dev;
44387c3786eSBrian Somers   struct ng_mesg *resp;
44487c3786eSBrian Somers   const struct hooklist *hlist;
44587c3786eSBrian Somers   const struct nodeinfo *ninfo;
446b5bc6d4dSGleb Smirnoff   char *path, *sessionid, *mode;
447dc744e19SBrian Somers   int ifacelen, f;
44887c3786eSBrian Somers 
44987c3786eSBrian Somers   dev = NULL;
450dc744e19SBrian Somers   path = NULL;
451dc744e19SBrian Somers   ifacelen = 0;
45287c3786eSBrian Somers   if (p->fd < 0 && !strncasecmp(p->name.full, NG_PPPOE_NODE_TYPE,
45387c3786eSBrian Somers                                 PPPOE_NODE_TYPE_LEN) &&
45487c3786eSBrian Somers       p->name.full[PPPOE_NODE_TYPE_LEN] == ':') {
45587c3786eSBrian Somers     const struct linkinfo *nlink;
45687c3786eSBrian Somers     struct ngpppoe_init_data *data;
45787c3786eSBrian Somers     struct ngm_mkpeer mkp;
45887c3786eSBrian Somers     struct ngm_connect ngc;
45987c3786eSBrian Somers     const char *iface, *provider;
460dc744e19SBrian Somers     char etherid[12];
461dc744e19SBrian Somers     int providerlen;
46287c3786eSBrian Somers     char connectpath[sizeof dev->hook + 2];	/* .:<hook> */
46387c3786eSBrian Somers 
46487c3786eSBrian Somers     p->fd--;				/* We own the device - change fd */
46587c3786eSBrian Somers 
466fb11a9c2SBrian Somers     loadmodules(LOAD_VERBOSLY, "netgraph", "ng_ether", "ng_pppoe", "ng_socket",
467fb11a9c2SBrian Somers                 NULL);
46887c3786eSBrian Somers 
46987c3786eSBrian Somers     if ((dev = malloc(sizeof *dev)) == NULL)
47087c3786eSBrian Somers       return NULL;
47187c3786eSBrian Somers 
47287c3786eSBrian Somers     iface = p->name.full + PPPOE_NODE_TYPE_LEN + 1;
47387c3786eSBrian Somers 
47487c3786eSBrian Somers     provider = strchr(iface, ':');
47587c3786eSBrian Somers     if (provider) {
47687c3786eSBrian Somers       ifacelen = provider - iface;
47787c3786eSBrian Somers       provider++;
47887c3786eSBrian Somers       providerlen = strlen(provider);
47987c3786eSBrian Somers     } else {
48087c3786eSBrian Somers       ifacelen = strlen(iface);
48187c3786eSBrian Somers       provider = "";
48287c3786eSBrian Somers       providerlen = 0;
48387c3786eSBrian Somers     }
48487c3786eSBrian Somers 
48587c3786eSBrian Somers     /*
48687c3786eSBrian Somers      * We're going to do this (where tunN is our tunnel device):
48787c3786eSBrian Somers      *
48887c3786eSBrian Somers      * .---------.
48987c3786eSBrian Somers      * |  ether  |
49087c3786eSBrian Somers      * | <iface> |                         dev->cs
49187c3786eSBrian Somers      * `---------'                           |
49287c3786eSBrian Somers      *  (orphan)                     p->fd   |
49387c3786eSBrian Somers      *     |                           |     |
49487c3786eSBrian Somers      *     |                           |     |
49587c3786eSBrian Somers      * (ethernet)                      |     |
49687c3786eSBrian Somers      * .---------.                  .-----------.
49787c3786eSBrian Somers      * |  pppoe  |                  |  socket   |
49887c3786eSBrian Somers      * | <iface> |(tunN)<---->(tunN)| <unnamed> |
49987c3786eSBrian Somers      * `---------                   `-----------'
50087c3786eSBrian Somers      *   (tunX)
50187c3786eSBrian Somers      *     ^
50287c3786eSBrian Somers      *     |
50387c3786eSBrian Somers      *     `--->(tunX)
50487c3786eSBrian Somers      */
50587c3786eSBrian Somers 
50687c3786eSBrian Somers     /* Create a socket node */
50731dd45c4SBrian Somers     if (ID0NgMkSockNode(NULL, &dev->cs, &p->fd) == -1) {
50887c3786eSBrian Somers       log_Printf(LogWARN, "Cannot create netgraph socket node: %s\n",
50987c3786eSBrian Somers                  strerror(errno));
51087c3786eSBrian Somers       free(dev);
511fb11a9c2SBrian Somers       p->fd = -2;
51287c3786eSBrian Somers       return NULL;
51387c3786eSBrian Somers     }
51487c3786eSBrian Somers 
51587c3786eSBrian Somers     /*
51687c3786eSBrian Somers      * Ask for a list of hooks attached to the "ether" node.  This node should
51787c3786eSBrian Somers      * magically exist as a way of hooking stuff onto an ethernet device
51887c3786eSBrian Somers      */
51987c3786eSBrian Somers     path = (char *)alloca(ifacelen + 2);
52087c3786eSBrian Somers     sprintf(path, "%.*s:", ifacelen, iface);
52187c3786eSBrian Somers     if (NgSendMsg(dev->cs, path, NGM_GENERIC_COOKIE, NGM_LISTHOOKS,
52287c3786eSBrian Somers                   NULL, 0) < 0) {
52387c3786eSBrian Somers       log_Printf(LogWARN, "%s Cannot send a netgraph message: %s\n",
52487c3786eSBrian Somers                  path, strerror(errno));
52587c3786eSBrian Somers       return ether_Abandon(dev, p);
52687c3786eSBrian Somers     }
52787c3786eSBrian Somers 
52887c3786eSBrian Somers     /* Get our list back */
52987c3786eSBrian Somers     resp = (struct ng_mesg *)rbuf;
5301a939a07SBrian Somers     if (NgRecvMsg(dev->cs, resp, sizeof rbuf, NULL) <= 0) {
53187c3786eSBrian Somers       log_Printf(LogWARN, "Cannot get netgraph response: %s\n",
53287c3786eSBrian Somers                  strerror(errno));
53387c3786eSBrian Somers       return ether_Abandon(dev, p);
53487c3786eSBrian Somers     }
53587c3786eSBrian Somers 
53687c3786eSBrian Somers     hlist = (const struct hooklist *)resp->data;
53787c3786eSBrian Somers     ninfo = &hlist->nodeinfo;
53887c3786eSBrian Somers 
53987c3786eSBrian Somers     /* Make sure we've got the right type of node */
54087c3786eSBrian Somers     if (strncmp(ninfo->type, NG_ETHER_NODE_TYPE,
54187c3786eSBrian Somers                 sizeof NG_ETHER_NODE_TYPE - 1)) {
54287c3786eSBrian Somers       log_Printf(LogWARN, "%s Unexpected node type ``%s'' (wanted ``"
54387c3786eSBrian Somers                  NG_ETHER_NODE_TYPE "'')\n", path, ninfo->type);
54487c3786eSBrian Somers       return ether_Abandon(dev, p);
54587c3786eSBrian Somers     }
54687c3786eSBrian Somers 
5476b8b6befSBrian Somers     log_Printf(LogDEBUG, "List of netgraph node ``%s'' (id %x) hooks:\n",
54887c3786eSBrian Somers                path, ninfo->id);
54987c3786eSBrian Somers 
55087c3786eSBrian Somers     /* look for a hook already attached.  */
55187c3786eSBrian Somers     for (f = 0; f < ninfo->hooks; f++) {
55287c3786eSBrian Somers       nlink = &hlist->link[f];
55387c3786eSBrian Somers 
55487c3786eSBrian Somers       log_Printf(LogDEBUG, "  Found %s -> %s\n", nlink->ourhook,
55587c3786eSBrian Somers                  nlink->peerhook);
55687c3786eSBrian Somers 
55787c3786eSBrian Somers       if (!strcmp(nlink->ourhook, NG_ETHER_HOOK_ORPHAN) ||
55887c3786eSBrian Somers           !strcmp(nlink->ourhook, NG_ETHER_HOOK_DIVERT)) {
55987c3786eSBrian Somers         /*
56087c3786eSBrian Somers          * Something is using the data coming out of this ``ether'' node.
56187c3786eSBrian Somers          * If it's a PPPoE node, we use that node, otherwise we complain that
56287c3786eSBrian Somers          * someone else is using the node.
56387c3786eSBrian Somers          */
56487c3786eSBrian Somers         if (!strcmp(nlink->nodeinfo.type, NG_PPPOE_NODE_TYPE))
56587c3786eSBrian Somers           /* Use this PPPoE node ! */
5666b8b6befSBrian Somers           snprintf(ngc.path, sizeof ngc.path, "[%x]:", nlink->nodeinfo.id);
56787c3786eSBrian Somers         else {
56887c3786eSBrian Somers           log_Printf(LogWARN, "%s Node type ``%s'' is currently active\n",
56987c3786eSBrian Somers                      path, nlink->nodeinfo.type);
57087c3786eSBrian Somers           return ether_Abandon(dev, p);
57187c3786eSBrian Somers         }
57287c3786eSBrian Somers         break;
57387c3786eSBrian Somers       }
57487c3786eSBrian Somers     }
57587c3786eSBrian Somers 
57687c3786eSBrian Somers     if (f == ninfo->hooks) {
57787c3786eSBrian Somers       /*
57887c3786eSBrian Somers        * Create a new ``PPPoE'' node connected to the ``ether'' node using
579fb11a9c2SBrian Somers        * the ``orphan'' and ``ethernet'' hooks
58087c3786eSBrian Somers        */
58187c3786eSBrian Somers       snprintf(mkp.type, sizeof mkp.type, "%s", NG_PPPOE_NODE_TYPE);
58287c3786eSBrian Somers       snprintf(mkp.ourhook, sizeof mkp.ourhook, "%s", NG_ETHER_HOOK_ORPHAN);
58387c3786eSBrian Somers       snprintf(mkp.peerhook, sizeof mkp.peerhook, "%s", NG_PPPOE_HOOK_ETHERNET);
5846b8b6befSBrian Somers       snprintf(etherid, sizeof etherid, "[%x]:", ninfo->id);
58587c3786eSBrian Somers 
58687c3786eSBrian Somers       log_Printf(LogDEBUG, "Creating PPPoE netgraph node %s%s -> %s\n",
58787c3786eSBrian Somers                  etherid, mkp.ourhook, mkp.peerhook);
58887c3786eSBrian Somers 
58987c3786eSBrian Somers       if (NgSendMsg(dev->cs, etherid, NGM_GENERIC_COOKIE,
59087c3786eSBrian Somers                     NGM_MKPEER, &mkp, sizeof mkp) < 0) {
59187c3786eSBrian Somers         log_Printf(LogWARN, "%s Cannot create PPPoE netgraph node: %s\n",
59287c3786eSBrian Somers                    etherid, strerror(errno));
59387c3786eSBrian Somers         return ether_Abandon(dev, p);
59487c3786eSBrian Somers       }
59587c3786eSBrian Somers 
59687c3786eSBrian Somers       snprintf(ngc.path, sizeof ngc.path, "%s%s", path, NG_ETHER_HOOK_ORPHAN);
59787c3786eSBrian Somers     }
59887c3786eSBrian Somers 
59987c3786eSBrian Somers     snprintf(dev->hook, sizeof dev->hook, "%s%d",
60087c3786eSBrian Somers              TUN_NAME, p->dl->bundle->unit);
60187c3786eSBrian Somers 
60287c3786eSBrian Somers     /*
60387c3786eSBrian Somers      * Connect the PPPoE node to our socket node.
60487c3786eSBrian Somers      * ngc.path has already been set up
60587c3786eSBrian Somers      */
60687c3786eSBrian Somers     snprintf(ngc.ourhook, sizeof ngc.ourhook, "%s", dev->hook);
60787c3786eSBrian Somers     memcpy(ngc.peerhook, ngc.ourhook, sizeof ngc.peerhook);
60887c3786eSBrian Somers 
60987c3786eSBrian Somers     log_Printf(LogDEBUG, "Connecting netgraph socket .:%s -> %s:%s\n",
61087c3786eSBrian Somers                ngc.ourhook, ngc.path, ngc.peerhook);
61187c3786eSBrian Somers     if (NgSendMsg(dev->cs, ".:", NGM_GENERIC_COOKIE,
61287c3786eSBrian Somers                   NGM_CONNECT, &ngc, sizeof ngc) < 0) {
61387c3786eSBrian Somers       log_Printf(LogWARN, "Cannot connect PPPoE and socket netgraph "
61487c3786eSBrian Somers                  "nodes: %s\n", strerror(errno));
61587c3786eSBrian Somers       return ether_Abandon(dev, p);
61687c3786eSBrian Somers     }
61787c3786eSBrian Somers 
6188152dca8SBrian Somers     /* Bring the Ethernet interface up */
6198152dca8SBrian Somers     path[ifacelen] = '\0';	/* Remove the trailing ':' */
6208152dca8SBrian Somers     if (!iface_SetFlags(path, IFF_UP))
6218152dca8SBrian Somers       log_Printf(LogWARN, "%s: Failed to set the IFF_UP flag on %s\n",
6228152dca8SBrian Somers                  p->link.name, path);
6238152dca8SBrian Somers 
624b5bc6d4dSGleb Smirnoff     snprintf(connectpath, sizeof connectpath, ".:%s", dev->hook);
625b5bc6d4dSGleb Smirnoff 
626b5bc6d4dSGleb Smirnoff     /* Configure node to 3Com mode if needed */
627b5bc6d4dSGleb Smirnoff     if (p->cfg.pppoe_configured) {
628b5bc6d4dSGleb Smirnoff       mode = p->cfg.nonstandard_pppoe ? NG_PPPOE_NONSTANDARD : NG_PPPOE_STANDARD;
629b5bc6d4dSGleb Smirnoff       if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE,
630b5bc6d4dSGleb Smirnoff 		NGM_PPPOE_SETMODE, mode, strlen(mode) + 1) == -1) {
631b5bc6d4dSGleb Smirnoff         log_Printf(LogWARN, "``%s'': Cannot configure netgraph node: %s\n",
632b5bc6d4dSGleb Smirnoff                  connectpath, strerror(errno));
633b5bc6d4dSGleb Smirnoff         return ether_Abandon(dev, p);
634b5bc6d4dSGleb Smirnoff       }
635b5bc6d4dSGleb Smirnoff     }
636b5bc6d4dSGleb Smirnoff 
63787c3786eSBrian Somers     /* And finally, request a connection to the given provider */
63887c3786eSBrian Somers 
639fbf03853SBrian Somers     data = (struct ngpppoe_init_data *)alloca(sizeof *data + providerlen);
64087c3786eSBrian Somers     snprintf(data->hook, sizeof data->hook, "%s", dev->hook);
64180e2e6b6SBrian Somers     memcpy(data->data, provider, providerlen);
64280e2e6b6SBrian Somers     data->data_len = providerlen;
64387c3786eSBrian Somers 
64487c3786eSBrian Somers     log_Printf(LogDEBUG, "Sending PPPOE_CONNECT to %s\n", connectpath);
64587c3786eSBrian Somers     if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE,
64687c3786eSBrian Somers                   NGM_PPPOE_CONNECT, data, sizeof *data + providerlen) == -1) {
64787c3786eSBrian Somers       log_Printf(LogWARN, "``%s'': Cannot start netgraph node: %s\n",
64887c3786eSBrian Somers                  connectpath, strerror(errno));
64987c3786eSBrian Somers       return ether_Abandon(dev, p);
65087c3786eSBrian Somers     }
65187c3786eSBrian Somers 
65240125273SBrian Somers     /* Hook things up so that we monitor dev->cs */
65340125273SBrian Somers     p->desc.UpdateSet = ether_UpdateSet;
65440125273SBrian Somers     p->desc.IsSet = ether_IsSet;
65540125273SBrian Somers     p->desc.Read = ether_DescriptorRead;
656fdc29d54SBrian Somers 
657fdc29d54SBrian Somers     memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
658fdc29d54SBrian Somers     switch (p->cfg.cd.necessity) {
659fdc29d54SBrian Somers       case CD_VARIABLE:
660fdc29d54SBrian Somers         dev->dev.cd.delay = p->cfg.cd.delay;
661fdc29d54SBrian Somers         break;
662fdc29d54SBrian Somers       case CD_REQUIRED:
663fdc29d54SBrian Somers         dev->dev.cd = p->cfg.cd;
664fdc29d54SBrian Somers         break;
665fdc29d54SBrian Somers       case CD_NOTREQUIRED:
666fdc29d54SBrian Somers         log_Printf(LogWARN, "%s: Carrier must be set, using ``set cd %d!''\n",
667fdc29d54SBrian Somers                    p->link.name, dev->dev.cd.delay);
668fdc29d54SBrian Somers       case CD_DEFAULT:
669fdc29d54SBrian Somers         break;
670fdc29d54SBrian Somers     }
671fdc29d54SBrian Somers 
672fdc29d54SBrian Somers     dev->timeout = dev->dev.cd.delay;
673fdc29d54SBrian Somers     dev->connected = CARRIER_PENDING;
674de59e178SBrian Somers     /* This will be overridden by our session id - if provided by netgraph */
675de59e178SBrian Somers     dev->slot = GetIfIndex(path);
67687c3786eSBrian Somers   } else {
67787c3786eSBrian Somers     /* See if we're a netgraph socket */
678165fbe26SBrian Somers     struct stat st;
679165fbe26SBrian Somers 
680165fbe26SBrian Somers     if (fstat(p->fd, &st) != -1 && (st.st_mode & S_IFSOCK)) {
681165fbe26SBrian Somers       struct sockaddr_storage ssock;
682165fbe26SBrian Somers       struct sockaddr *sock = (struct sockaddr *)&ssock;
68387c3786eSBrian Somers       int sz;
68487c3786eSBrian Somers 
685165fbe26SBrian Somers       sz = sizeof ssock;
686165fbe26SBrian Somers       if (getsockname(p->fd, sock, &sz) == -1) {
687165fbe26SBrian Somers         log_Printf(LogPHASE, "%s: Link is a closed socket !\n", p->link.name);
688165fbe26SBrian Somers         close(p->fd);
689165fbe26SBrian Somers         p->fd = -1;
690165fbe26SBrian Somers         return NULL;
691165fbe26SBrian Somers       }
692165fbe26SBrian Somers 
693165fbe26SBrian Somers       if (sock->sa_family == AF_NETGRAPH) {
69487c3786eSBrian Somers         /*
69540125273SBrian Somers          * It's a netgraph node... We can't determine hook names etc, so we
69640125273SBrian Somers          * stay pretty impartial....
69787c3786eSBrian Somers          */
69840125273SBrian Somers         log_Printf(LogPHASE, "%s: Link is a netgraph node\n", p->link.name);
69987c3786eSBrian Somers 
70087c3786eSBrian Somers         if ((dev = malloc(sizeof *dev)) == NULL) {
70187c3786eSBrian Somers           log_Printf(LogWARN, "%s: Cannot allocate an ether device: %s\n",
70287c3786eSBrian Somers                      p->link.name, strerror(errno));
70387c3786eSBrian Somers           return NULL;
70487c3786eSBrian Somers         }
70587c3786eSBrian Somers 
706fdc29d54SBrian Somers         memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
70787c3786eSBrian Somers         dev->cs = -1;
70887c3786eSBrian Somers         dev->timeout = 0;
70987c3786eSBrian Somers         dev->connected = CARRIER_OK;
71040125273SBrian Somers         *dev->hook = '\0';
711de59e178SBrian Somers 
712de59e178SBrian Somers         /*
713de59e178SBrian Somers          * If we're being envoked from pppoed(8), we may have a SESSIONID
714de59e178SBrian Somers          * set in the environment.  If so, use it as the slot
715de59e178SBrian Somers          */
716de59e178SBrian Somers         if ((sessionid = getenv("SESSIONID")) != NULL) {
717de59e178SBrian Somers           char *end;
718de59e178SBrian Somers           u_long slot;
719de59e178SBrian Somers 
720de59e178SBrian Somers           slot = strtoul(sessionid, &end, 16);
721de59e178SBrian Somers           dev->slot = end != sessionid && *end == '\0' ? slot : 0;
722de59e178SBrian Somers         } else
723de59e178SBrian Somers           dev->slot = 0;
72487c3786eSBrian Somers       }
72587c3786eSBrian Somers     }
726165fbe26SBrian Somers   }
72787c3786eSBrian Somers 
72887c3786eSBrian Somers   if (dev) {
72987c3786eSBrian Somers     physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
73087c3786eSBrian Somers     return &dev->dev;
73187c3786eSBrian Somers   }
73287c3786eSBrian Somers 
73387c3786eSBrian Somers   return NULL;
73487c3786eSBrian Somers }
735