187c3786eSBrian Somers /*-
2*4d846d26SWarner Losh * SPDX-License-Identifier: BSD-2-Clause
31de7b4b8SPedro F. Giffuni *
487c3786eSBrian Somers * Copyright (c) 1999 Brian Somers <brian@Awfulhak.org>
587c3786eSBrian Somers * All rights reserved.
687c3786eSBrian Somers *
787c3786eSBrian Somers * Redistribution and use in source and binary forms, with or without
887c3786eSBrian Somers * modification, are permitted provided that the following conditions
987c3786eSBrian Somers * are met:
1087c3786eSBrian Somers * 1. Redistributions of source code must retain the above copyright
1187c3786eSBrian Somers * notice, this list of conditions and the following disclaimer.
1287c3786eSBrian Somers * 2. Redistributions in binary form must reproduce the above copyright
1387c3786eSBrian Somers * notice, this list of conditions and the following disclaimer in the
1487c3786eSBrian Somers * documentation and/or other materials provided with the distribution.
1587c3786eSBrian Somers *
1687c3786eSBrian Somers * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1787c3786eSBrian Somers * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1887c3786eSBrian Somers * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1987c3786eSBrian Somers * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
2087c3786eSBrian Somers * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
2187c3786eSBrian Somers * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2287c3786eSBrian Somers * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2387c3786eSBrian Somers * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2487c3786eSBrian Somers * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2587c3786eSBrian Somers * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2687c3786eSBrian Somers * SUCH DAMAGE.
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
113057f1760SBrian Somers unsigned
ether_DeviceSize(void)11487c3786eSBrian Somers ether_DeviceSize(void)
11587c3786eSBrian Somers {
11687c3786eSBrian Somers return sizeof(struct etherdevice);
11787c3786eSBrian Somers }
11887c3786eSBrian Somers
11987c3786eSBrian Somers static ssize_t
ether_Write(struct physical * p,const void * v,size_t n)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
124057f1760SBrian Somers return NgSendData(p->fd, dev->hook, v, n) == -1 ? -1 : (ssize_t)n;
12587c3786eSBrian Somers }
12687c3786eSBrian Somers
12787c3786eSBrian Somers static ssize_t
ether_Read(struct physical * p,void * v,size_t n)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
ether_RemoveFromSet(struct physical * p,fd_set * r,fd_set * w,fd_set * e)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
ether_Free(struct physical * p)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 *
ether_OpenInfo(struct physical * p)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
ether_Slot(struct physical * p)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
ether_device2iov(struct device * d,struct iovec * iov,int * niov,int maxiov __unused,int * auxfd,int * nauxfd)19387c3786eSBrian Somers ether_device2iov(struct device *d, struct iovec *iov, int *niov,
194057f1760SBrian Somers int maxiov __unused, int *auxfd, int *nauxfd)
19587c3786eSBrian Somers {
196c5e246d4SBrian Somers struct etherdevice *dev;
19787c3786eSBrian Somers int sz = physical_MaxDeviceSize();
19887c3786eSBrian Somers
199c5e246d4SBrian Somers iov[*niov].iov_base = d = realloc(d, sz);
200c5e246d4SBrian Somers if (d == 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
207c5e246d4SBrian Somers dev = device2ether(d);
20887c3786eSBrian Somers if (dev->cs >= 0) {
20987c3786eSBrian Somers *auxfd = dev->cs;
21087c3786eSBrian Somers (*nauxfd)++;
21187c3786eSBrian Somers }
21287c3786eSBrian Somers }
21387c3786eSBrian Somers
21487c3786eSBrian Somers static void
ether_MessageIn(struct etherdevice * dev)21587c3786eSBrian Somers ether_MessageIn(struct etherdevice *dev)
21687c3786eSBrian Somers {
21787c3786eSBrian Somers char msgbuf[sizeof(struct ng_mesg) + sizeof(struct ngpppoe_sts)];
21887c3786eSBrian Somers struct ng_mesg *rep = (struct ng_mesg *)msgbuf;
21987c3786eSBrian Somers struct ngpppoe_sts *sts = (struct ngpppoe_sts *)(msgbuf + sizeof *rep);
220de59e178SBrian Somers char *end, unknown[14], sessionid[5];
22187c3786eSBrian Somers const char *msg;
22287c3786eSBrian Somers struct timeval t;
2238a52f3ecSBrian Somers fd_set *r;
224de59e178SBrian Somers u_long slot;
225dbc46ca4SBrian Somers int asciilen, ret;
22687c3786eSBrian Somers
22787c3786eSBrian Somers if (dev->cs < 0)
22887c3786eSBrian Somers return;
22987c3786eSBrian Somers
2308a52f3ecSBrian Somers if ((r = mkfdset()) == NULL) {
2318a52f3ecSBrian Somers log_Printf(LogERROR, "DoLoop: Cannot create fd_set\n");
2328a52f3ecSBrian Somers return;
2338a52f3ecSBrian Somers }
2346ca7707bSBrian Somers
2356ca7707bSBrian Somers while (1) {
2368a52f3ecSBrian Somers zerofdset(r);
2378a52f3ecSBrian Somers FD_SET(dev->cs, r);
23887c3786eSBrian Somers t.tv_sec = t.tv_usec = 0;
2398a52f3ecSBrian Somers ret = select(dev->cs + 1, r, NULL, NULL, &t);
2408a52f3ecSBrian Somers
2418a52f3ecSBrian Somers if (ret <= 0)
2426ca7707bSBrian Somers break;
24387c3786eSBrian Somers
2441a939a07SBrian Somers if (NgRecvMsg(dev->cs, rep, sizeof msgbuf, NULL) <= 0)
2456ca7707bSBrian Somers break;
24687c3786eSBrian Somers
24787c3786eSBrian Somers if (rep->header.version != NG_VERSION) {
24887c3786eSBrian Somers log_Printf(LogWARN, "%ld: Unexpected netgraph version, expected %ld\n",
24987c3786eSBrian Somers (long)rep->header.version, (long)NG_VERSION);
2506ca7707bSBrian Somers break;
25187c3786eSBrian Somers }
25287c3786eSBrian Somers
25387c3786eSBrian Somers if (rep->header.typecookie != NGM_PPPOE_COOKIE) {
25487c3786eSBrian Somers log_Printf(LogWARN, "%ld: Unexpected netgraph cookie, expected %ld\n",
25587c3786eSBrian Somers (long)rep->header.typecookie, (long)NGM_PPPOE_COOKIE);
2566ca7707bSBrian Somers break;
25787c3786eSBrian Somers }
25887c3786eSBrian Somers
259dbc46ca4SBrian Somers asciilen = 0;
26087c3786eSBrian Somers switch (rep->header.cmd) {
26187c3786eSBrian Somers case NGM_PPPOE_SET_FLAG: msg = "SET_FLAG"; break;
26287c3786eSBrian Somers case NGM_PPPOE_CONNECT: msg = "CONNECT"; break;
26387c3786eSBrian Somers case NGM_PPPOE_LISTEN: msg = "LISTEN"; break;
26487c3786eSBrian Somers case NGM_PPPOE_OFFER: msg = "OFFER"; break;
26587c3786eSBrian Somers case NGM_PPPOE_SUCCESS: msg = "SUCCESS"; break;
26687c3786eSBrian Somers case NGM_PPPOE_FAIL: msg = "FAIL"; break;
26787c3786eSBrian Somers case NGM_PPPOE_CLOSE: msg = "CLOSE"; break;
26887c3786eSBrian Somers case NGM_PPPOE_GET_STATUS: msg = "GET_STATUS"; break;
2697f77b559SBrian Somers case NGM_PPPOE_ACNAME:
2707f77b559SBrian Somers msg = "ACNAME";
2717f77b559SBrian Somers if (setenv("ACNAME", sts->hook, 1) != 0)
2727f77b559SBrian Somers log_Printf(LogWARN, "setenv: cannot set ACNAME=%s: %m", sts->hook);
273dbc46ca4SBrian Somers asciilen = rep->header.arglen;
2747f77b559SBrian Somers break;
275de59e178SBrian Somers case NGM_PPPOE_SESSIONID:
276de59e178SBrian Somers msg = "SESSIONID";
277de59e178SBrian Somers snprintf(sessionid, sizeof sessionid, "%04x", *(u_int16_t *)sts);
278de59e178SBrian Somers if (setenv("SESSIONID", sessionid, 1) != 0)
279de59e178SBrian Somers syslog(LOG_WARNING, "setenv: cannot set SESSIONID=%s: %m",
280de59e178SBrian Somers sessionid);
281de59e178SBrian Somers /* Use this in preference to our interface index */
282de59e178SBrian Somers slot = strtoul(sessionid, &end, 16);
283de59e178SBrian Somers if (end != sessionid && *end == '\0')
284de59e178SBrian Somers dev->slot = slot;
285de59e178SBrian Somers break;
28687c3786eSBrian Somers default:
28787c3786eSBrian Somers snprintf(unknown, sizeof unknown, "<%d>", (int)rep->header.cmd);
28887c3786eSBrian Somers msg = unknown;
28987c3786eSBrian Somers break;
29087c3786eSBrian Somers }
29187c3786eSBrian Somers
292dbc46ca4SBrian Somers if (asciilen)
293dbc46ca4SBrian Somers log_Printf(LogPHASE, "Received NGM_PPPOE_%s (hook \"%.*s\")\n",
294dbc46ca4SBrian Somers msg, asciilen, sts->hook);
295dbc46ca4SBrian Somers else
296dbc46ca4SBrian Somers log_Printf(LogPHASE, "Received NGM_PPPOE_%s\n", msg);
29787c3786eSBrian Somers
29887c3786eSBrian Somers switch (rep->header.cmd) {
29987c3786eSBrian Somers case NGM_PPPOE_SUCCESS:
30087c3786eSBrian Somers dev->connected = CARRIER_OK;
30187c3786eSBrian Somers break;
30287c3786eSBrian Somers case NGM_PPPOE_FAIL:
30387c3786eSBrian Somers case NGM_PPPOE_CLOSE:
30487c3786eSBrian Somers dev->connected = CARRIER_LOST;
30587c3786eSBrian Somers break;
30687c3786eSBrian Somers }
30787c3786eSBrian Somers }
3086ca7707bSBrian Somers free(r);
3096ca7707bSBrian Somers }
31087c3786eSBrian Somers
31187c3786eSBrian Somers static int
ether_AwaitCarrier(struct physical * p)31287c3786eSBrian Somers ether_AwaitCarrier(struct physical *p)
31387c3786eSBrian Somers {
31487c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler);
31587c3786eSBrian Somers
316772d2e09SBrian Somers if (dev->connected != CARRIER_OK && !dev->timeout--)
31787c3786eSBrian Somers dev->connected = CARRIER_LOST;
31887c3786eSBrian Somers else if (dev->connected == CARRIER_PENDING)
31987c3786eSBrian Somers ether_MessageIn(dev);
32087c3786eSBrian Somers
32187c3786eSBrian Somers return dev->connected;
32287c3786eSBrian Somers }
32387c3786eSBrian Somers
32487c3786eSBrian Somers static const struct device baseetherdevice = {
32587c3786eSBrian Somers ETHER_DEVICE,
32687c3786eSBrian Somers "ether",
327c8b9fb53SBrian Somers 1492,
328fdc29d54SBrian Somers { CD_REQUIRED, DEF_ETHERCDDELAY },
32987c3786eSBrian Somers ether_AwaitCarrier,
33087c3786eSBrian Somers ether_RemoveFromSet,
33187c3786eSBrian Somers NULL,
33287c3786eSBrian Somers NULL,
33387c3786eSBrian Somers NULL,
33487c3786eSBrian Somers NULL,
335fb11a9c2SBrian Somers NULL,
33687c3786eSBrian Somers ether_Free,
33787c3786eSBrian Somers ether_Read,
33887c3786eSBrian Somers ether_Write,
33987c3786eSBrian Somers ether_device2iov,
34087c3786eSBrian Somers NULL,
341de59e178SBrian Somers ether_OpenInfo,
342de59e178SBrian Somers ether_Slot
34387c3786eSBrian Somers };
34487c3786eSBrian Somers
34587c3786eSBrian Somers struct device *
ether_iov2device(int type,struct physical * p,struct iovec * iov,int * niov,int maxiov __unused,int * auxfd,int * nauxfd)34687c3786eSBrian Somers ether_iov2device(int type, struct physical *p, struct iovec *iov, int *niov,
347057f1760SBrian Somers int maxiov __unused, int *auxfd, int *nauxfd)
34887c3786eSBrian Somers {
34987c3786eSBrian Somers if (type == ETHER_DEVICE) {
35087c3786eSBrian Somers struct etherdevice *dev = (struct etherdevice *)iov[(*niov)++].iov_base;
35187c3786eSBrian Somers
35287c3786eSBrian Somers dev = realloc(dev, sizeof *dev); /* Reduce to the correct size */
35387c3786eSBrian Somers if (dev == NULL) {
35487c3786eSBrian Somers log_Printf(LogALERT, "Failed to allocate memory: %d\n",
35587c3786eSBrian Somers (int)(sizeof *dev));
35687c3786eSBrian Somers AbortProgram(EX_OSERR);
35787c3786eSBrian Somers }
35887c3786eSBrian Somers
35987c3786eSBrian Somers if (*nauxfd) {
36087c3786eSBrian Somers dev->cs = *auxfd;
36187c3786eSBrian Somers (*nauxfd)--;
36287c3786eSBrian Somers } else
36387c3786eSBrian Somers dev->cs = -1;
36487c3786eSBrian Somers
36587c3786eSBrian Somers /* Refresh function pointers etc */
36687c3786eSBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
36787c3786eSBrian Somers
36887c3786eSBrian Somers physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
36987c3786eSBrian Somers return &dev->dev;
37087c3786eSBrian Somers }
37187c3786eSBrian Somers
37287c3786eSBrian Somers return NULL;
37387c3786eSBrian Somers }
37487c3786eSBrian Somers
37587c3786eSBrian Somers static int
ether_UpdateSet(struct fdescriptor * d,fd_set * r,fd_set * w,fd_set * e,int * n)376f013f33eSBrian Somers ether_UpdateSet(struct fdescriptor *d, fd_set *r, fd_set *w, fd_set *e, int *n)
37787c3786eSBrian Somers {
37887c3786eSBrian Somers struct physical *p = descriptor2physical(d);
37987c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler);
38087c3786eSBrian Somers int result;
38187c3786eSBrian Somers
38287c3786eSBrian Somers if (r && dev->cs >= 0) {
38387c3786eSBrian Somers FD_SET(dev->cs, r);
38487c3786eSBrian Somers log_Printf(LogTIMER, "%s(ctrl): fdset(r) %d\n", p->link.name, dev->cs);
38587c3786eSBrian Somers result = 1;
38687c3786eSBrian Somers } else
38787c3786eSBrian Somers result = 0;
38887c3786eSBrian Somers
38987c3786eSBrian Somers result += physical_doUpdateSet(d, r, w, e, n, 0);
39087c3786eSBrian Somers
39187c3786eSBrian Somers return result;
39287c3786eSBrian Somers }
39387c3786eSBrian Somers
39487c3786eSBrian Somers static int
ether_IsSet(struct fdescriptor * d,const fd_set * fdset)395f013f33eSBrian Somers ether_IsSet(struct fdescriptor *d, const fd_set *fdset)
39687c3786eSBrian Somers {
39787c3786eSBrian Somers struct physical *p = descriptor2physical(d);
39887c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler);
39987c3786eSBrian Somers int result;
40087c3786eSBrian Somers
40187c3786eSBrian Somers result = dev->cs >= 0 && FD_ISSET(dev->cs, fdset);
40287c3786eSBrian Somers result += physical_IsSet(d, fdset);
40387c3786eSBrian Somers
40487c3786eSBrian Somers return result;
40587c3786eSBrian Somers }
40687c3786eSBrian Somers
40787c3786eSBrian Somers static void
ether_DescriptorRead(struct fdescriptor * d,struct bundle * bundle,const fd_set * fdset)408f013f33eSBrian Somers ether_DescriptorRead(struct fdescriptor *d, struct bundle *bundle,
40987c3786eSBrian Somers const fd_set *fdset)
41087c3786eSBrian Somers {
41187c3786eSBrian Somers struct physical *p = descriptor2physical(d);
41287c3786eSBrian Somers struct etherdevice *dev = device2ether(p->handler);
41387c3786eSBrian Somers
41487c3786eSBrian Somers if (dev->cs >= 0 && FD_ISSET(dev->cs, fdset)) {
41587c3786eSBrian Somers ether_MessageIn(dev);
41687c3786eSBrian Somers if (dev->connected == CARRIER_LOST) {
41787c3786eSBrian Somers log_Printf(LogPHASE, "%s: Device disconnected\n", p->link.name);
41887c3786eSBrian Somers datalink_Down(p->dl, CLOSE_NORMAL);
41987c3786eSBrian Somers return;
42087c3786eSBrian Somers }
42187c3786eSBrian Somers }
42287c3786eSBrian Somers
42387c3786eSBrian Somers if (physical_IsSet(d, fdset))
42487c3786eSBrian Somers physical_DescriptorRead(d, bundle, fdset);
42587c3786eSBrian Somers }
42687c3786eSBrian Somers
42787c3786eSBrian Somers static struct device *
ether_Abandon(struct etherdevice * dev,struct physical * p)42887c3786eSBrian Somers ether_Abandon(struct etherdevice *dev, struct physical *p)
42987c3786eSBrian Somers {
43087c3786eSBrian Somers /* Abandon our node construction */
43187c3786eSBrian Somers close(dev->cs);
43287c3786eSBrian Somers close(p->fd);
43387c3786eSBrian Somers p->fd = -2; /* Nobody else need try.. */
43487c3786eSBrian Somers free(dev);
43587c3786eSBrian Somers
43687c3786eSBrian Somers return NULL;
43787c3786eSBrian Somers }
43887c3786eSBrian Somers
43987c3786eSBrian Somers struct device *
ether_Create(struct physical * p)44087c3786eSBrian Somers ether_Create(struct physical *p)
44187c3786eSBrian Somers {
44287c3786eSBrian Somers u_char rbuf[2048];
44387c3786eSBrian Somers struct etherdevice *dev;
44487c3786eSBrian Somers struct ng_mesg *resp;
44587c3786eSBrian Somers const struct hooklist *hlist;
44687c3786eSBrian Somers const struct nodeinfo *ninfo;
447057f1760SBrian Somers char *path, *sessionid;
448057f1760SBrian Somers const char *mode;
449057f1760SBrian Somers size_t ifacelen;
450057f1760SBrian Somers unsigned f;
45187c3786eSBrian Somers
45287c3786eSBrian Somers dev = NULL;
453dc744e19SBrian Somers path = NULL;
454dc744e19SBrian Somers ifacelen = 0;
45587c3786eSBrian Somers if (p->fd < 0 && !strncasecmp(p->name.full, NG_PPPOE_NODE_TYPE,
45687c3786eSBrian Somers PPPOE_NODE_TYPE_LEN) &&
45787c3786eSBrian Somers p->name.full[PPPOE_NODE_TYPE_LEN] == ':') {
45887c3786eSBrian Somers const struct linkinfo *nlink;
45987c3786eSBrian Somers struct ngpppoe_init_data *data;
46087c3786eSBrian Somers struct ngm_mkpeer mkp;
46187c3786eSBrian Somers struct ngm_connect ngc;
46287c3786eSBrian Somers const char *iface, *provider;
463dc744e19SBrian Somers char etherid[12];
464dc744e19SBrian Somers int providerlen;
46587c3786eSBrian Somers char connectpath[sizeof dev->hook + 2]; /* .:<hook> */
46687c3786eSBrian Somers
46787c3786eSBrian Somers p->fd--; /* We own the device - change fd */
46887c3786eSBrian Somers
469fb11a9c2SBrian Somers loadmodules(LOAD_VERBOSLY, "netgraph", "ng_ether", "ng_pppoe", "ng_socket",
470fb11a9c2SBrian Somers NULL);
47187c3786eSBrian Somers
47287c3786eSBrian Somers if ((dev = malloc(sizeof *dev)) == NULL)
47387c3786eSBrian Somers return NULL;
47487c3786eSBrian Somers
47587c3786eSBrian Somers iface = p->name.full + PPPOE_NODE_TYPE_LEN + 1;
47687c3786eSBrian Somers
47787c3786eSBrian Somers provider = strchr(iface, ':');
47887c3786eSBrian Somers if (provider) {
47987c3786eSBrian Somers ifacelen = provider - iface;
48087c3786eSBrian Somers provider++;
48187c3786eSBrian Somers providerlen = strlen(provider);
48287c3786eSBrian Somers } else {
48387c3786eSBrian Somers ifacelen = strlen(iface);
48487c3786eSBrian Somers provider = "";
48587c3786eSBrian Somers providerlen = 0;
48687c3786eSBrian Somers }
48787c3786eSBrian Somers
48887c3786eSBrian Somers /*
48987c3786eSBrian Somers * We're going to do this (where tunN is our tunnel device):
49087c3786eSBrian Somers *
49187c3786eSBrian Somers * .---------.
49287c3786eSBrian Somers * | ether |
49387c3786eSBrian Somers * | <iface> | dev->cs
49487c3786eSBrian Somers * `---------' |
49587c3786eSBrian Somers * (orphan) p->fd |
49687c3786eSBrian Somers * | | |
49787c3786eSBrian Somers * | | |
49887c3786eSBrian Somers * (ethernet) | |
49987c3786eSBrian Somers * .---------. .-----------.
50087c3786eSBrian Somers * | pppoe | | socket |
50187c3786eSBrian Somers * | <iface> |(tunN)<---->(tunN)| <unnamed> |
50287c3786eSBrian Somers * `--------- `-----------'
50387c3786eSBrian Somers * (tunX)
50487c3786eSBrian Somers * ^
50587c3786eSBrian Somers * |
50687c3786eSBrian Somers * `--->(tunX)
50787c3786eSBrian Somers */
50887c3786eSBrian Somers
50987c3786eSBrian Somers /* Create a socket node */
51031dd45c4SBrian Somers if (ID0NgMkSockNode(NULL, &dev->cs, &p->fd) == -1) {
51187c3786eSBrian Somers log_Printf(LogWARN, "Cannot create netgraph socket node: %s\n",
51287c3786eSBrian Somers strerror(errno));
51387c3786eSBrian Somers free(dev);
514fb11a9c2SBrian Somers p->fd = -2;
51587c3786eSBrian Somers return NULL;
51687c3786eSBrian Somers }
51787c3786eSBrian Somers
51887c3786eSBrian Somers /*
51987c3786eSBrian Somers * Ask for a list of hooks attached to the "ether" node. This node should
52087c3786eSBrian Somers * magically exist as a way of hooking stuff onto an ethernet device
52187c3786eSBrian Somers */
52287c3786eSBrian Somers path = (char *)alloca(ifacelen + 2);
5231814213eSMarcel Moolenaar sprintf(path, "%.*s:", (int)ifacelen, iface);
52487c3786eSBrian Somers if (NgSendMsg(dev->cs, path, NGM_GENERIC_COOKIE, NGM_LISTHOOKS,
52587c3786eSBrian Somers NULL, 0) < 0) {
52687c3786eSBrian Somers log_Printf(LogWARN, "%s Cannot send a netgraph message: %s\n",
52787c3786eSBrian Somers path, strerror(errno));
52887c3786eSBrian Somers return ether_Abandon(dev, p);
52987c3786eSBrian Somers }
53087c3786eSBrian Somers
53187c3786eSBrian Somers /* Get our list back */
53287c3786eSBrian Somers resp = (struct ng_mesg *)rbuf;
5331a939a07SBrian Somers if (NgRecvMsg(dev->cs, resp, sizeof rbuf, NULL) <= 0) {
53487c3786eSBrian Somers log_Printf(LogWARN, "Cannot get netgraph response: %s\n",
53587c3786eSBrian Somers strerror(errno));
53687c3786eSBrian Somers return ether_Abandon(dev, p);
53787c3786eSBrian Somers }
53887c3786eSBrian Somers
53987c3786eSBrian Somers hlist = (const struct hooklist *)resp->data;
54087c3786eSBrian Somers ninfo = &hlist->nodeinfo;
54187c3786eSBrian Somers
54287c3786eSBrian Somers /* Make sure we've got the right type of node */
54387c3786eSBrian Somers if (strncmp(ninfo->type, NG_ETHER_NODE_TYPE,
54487c3786eSBrian Somers sizeof NG_ETHER_NODE_TYPE - 1)) {
54587c3786eSBrian Somers log_Printf(LogWARN, "%s Unexpected node type ``%s'' (wanted ``"
54687c3786eSBrian Somers NG_ETHER_NODE_TYPE "'')\n", path, ninfo->type);
54787c3786eSBrian Somers return ether_Abandon(dev, p);
54887c3786eSBrian Somers }
54987c3786eSBrian Somers
5506b8b6befSBrian Somers log_Printf(LogDEBUG, "List of netgraph node ``%s'' (id %x) hooks:\n",
55187c3786eSBrian Somers path, ninfo->id);
55287c3786eSBrian Somers
55387c3786eSBrian Somers /* look for a hook already attached. */
55487c3786eSBrian Somers for (f = 0; f < ninfo->hooks; f++) {
55587c3786eSBrian Somers nlink = &hlist->link[f];
55687c3786eSBrian Somers
55787c3786eSBrian Somers log_Printf(LogDEBUG, " Found %s -> %s\n", nlink->ourhook,
55887c3786eSBrian Somers nlink->peerhook);
55987c3786eSBrian Somers
56087c3786eSBrian Somers if (!strcmp(nlink->ourhook, NG_ETHER_HOOK_ORPHAN) ||
56187c3786eSBrian Somers !strcmp(nlink->ourhook, NG_ETHER_HOOK_DIVERT)) {
56287c3786eSBrian Somers /*
56387c3786eSBrian Somers * Something is using the data coming out of this ``ether'' node.
56487c3786eSBrian Somers * If it's a PPPoE node, we use that node, otherwise we complain that
56587c3786eSBrian Somers * someone else is using the node.
56687c3786eSBrian Somers */
56787c3786eSBrian Somers if (!strcmp(nlink->nodeinfo.type, NG_PPPOE_NODE_TYPE))
56887c3786eSBrian Somers /* Use this PPPoE node ! */
5696b8b6befSBrian Somers snprintf(ngc.path, sizeof ngc.path, "[%x]:", nlink->nodeinfo.id);
57087c3786eSBrian Somers else {
57187c3786eSBrian Somers log_Printf(LogWARN, "%s Node type ``%s'' is currently active\n",
57287c3786eSBrian Somers path, nlink->nodeinfo.type);
57387c3786eSBrian Somers return ether_Abandon(dev, p);
57487c3786eSBrian Somers }
57587c3786eSBrian Somers break;
57687c3786eSBrian Somers }
57787c3786eSBrian Somers }
57887c3786eSBrian Somers
57987c3786eSBrian Somers if (f == ninfo->hooks) {
58087c3786eSBrian Somers /*
58187c3786eSBrian Somers * Create a new ``PPPoE'' node connected to the ``ether'' node using
582fb11a9c2SBrian Somers * the ``orphan'' and ``ethernet'' hooks
58387c3786eSBrian Somers */
58487c3786eSBrian Somers snprintf(mkp.type, sizeof mkp.type, "%s", NG_PPPOE_NODE_TYPE);
58587c3786eSBrian Somers snprintf(mkp.ourhook, sizeof mkp.ourhook, "%s", NG_ETHER_HOOK_ORPHAN);
58687c3786eSBrian Somers snprintf(mkp.peerhook, sizeof mkp.peerhook, "%s", NG_PPPOE_HOOK_ETHERNET);
5876b8b6befSBrian Somers snprintf(etherid, sizeof etherid, "[%x]:", ninfo->id);
58887c3786eSBrian Somers
58987c3786eSBrian Somers log_Printf(LogDEBUG, "Creating PPPoE netgraph node %s%s -> %s\n",
59087c3786eSBrian Somers etherid, mkp.ourhook, mkp.peerhook);
59187c3786eSBrian Somers
59287c3786eSBrian Somers if (NgSendMsg(dev->cs, etherid, NGM_GENERIC_COOKIE,
59387c3786eSBrian Somers NGM_MKPEER, &mkp, sizeof mkp) < 0) {
59487c3786eSBrian Somers log_Printf(LogWARN, "%s Cannot create PPPoE netgraph node: %s\n",
59587c3786eSBrian Somers etherid, strerror(errno));
59687c3786eSBrian Somers return ether_Abandon(dev, p);
59787c3786eSBrian Somers }
59887c3786eSBrian Somers
59987c3786eSBrian Somers snprintf(ngc.path, sizeof ngc.path, "%s%s", path, NG_ETHER_HOOK_ORPHAN);
60087c3786eSBrian Somers }
60187c3786eSBrian Somers
60287c3786eSBrian Somers snprintf(dev->hook, sizeof dev->hook, "%s%d",
60387c3786eSBrian Somers TUN_NAME, p->dl->bundle->unit);
60487c3786eSBrian Somers
60587c3786eSBrian Somers /*
60687c3786eSBrian Somers * Connect the PPPoE node to our socket node.
60787c3786eSBrian Somers * ngc.path has already been set up
60887c3786eSBrian Somers */
60987c3786eSBrian Somers snprintf(ngc.ourhook, sizeof ngc.ourhook, "%s", dev->hook);
61087c3786eSBrian Somers memcpy(ngc.peerhook, ngc.ourhook, sizeof ngc.peerhook);
61187c3786eSBrian Somers
61287c3786eSBrian Somers log_Printf(LogDEBUG, "Connecting netgraph socket .:%s -> %s:%s\n",
61387c3786eSBrian Somers ngc.ourhook, ngc.path, ngc.peerhook);
61487c3786eSBrian Somers if (NgSendMsg(dev->cs, ".:", NGM_GENERIC_COOKIE,
61587c3786eSBrian Somers NGM_CONNECT, &ngc, sizeof ngc) < 0) {
61687c3786eSBrian Somers log_Printf(LogWARN, "Cannot connect PPPoE and socket netgraph "
61787c3786eSBrian Somers "nodes: %s\n", strerror(errno));
61887c3786eSBrian Somers return ether_Abandon(dev, p);
61987c3786eSBrian Somers }
62087c3786eSBrian Somers
6218152dca8SBrian Somers /* Bring the Ethernet interface up */
6228152dca8SBrian Somers path[ifacelen] = '\0'; /* Remove the trailing ':' */
6238152dca8SBrian Somers if (!iface_SetFlags(path, IFF_UP))
6248152dca8SBrian Somers log_Printf(LogWARN, "%s: Failed to set the IFF_UP flag on %s\n",
6258152dca8SBrian Somers p->link.name, path);
6268152dca8SBrian Somers
627b5bc6d4dSGleb Smirnoff snprintf(connectpath, sizeof connectpath, ".:%s", dev->hook);
628b5bc6d4dSGleb Smirnoff
629b5bc6d4dSGleb Smirnoff /* Configure node to 3Com mode if needed */
630b5bc6d4dSGleb Smirnoff if (p->cfg.pppoe_configured) {
631b5bc6d4dSGleb Smirnoff mode = p->cfg.nonstandard_pppoe ? NG_PPPOE_NONSTANDARD : NG_PPPOE_STANDARD;
632b5bc6d4dSGleb Smirnoff if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE,
633b5bc6d4dSGleb Smirnoff NGM_PPPOE_SETMODE, mode, strlen(mode) + 1) == -1) {
634b5bc6d4dSGleb Smirnoff log_Printf(LogWARN, "``%s'': Cannot configure netgraph node: %s\n",
635b5bc6d4dSGleb Smirnoff connectpath, strerror(errno));
636b5bc6d4dSGleb Smirnoff return ether_Abandon(dev, p);
637b5bc6d4dSGleb Smirnoff }
638b5bc6d4dSGleb Smirnoff }
639b5bc6d4dSGleb Smirnoff
64087c3786eSBrian Somers /* And finally, request a connection to the given provider */
64187c3786eSBrian Somers
642fbf03853SBrian Somers data = (struct ngpppoe_init_data *)alloca(sizeof *data + providerlen);
64387c3786eSBrian Somers snprintf(data->hook, sizeof data->hook, "%s", dev->hook);
64480e2e6b6SBrian Somers memcpy(data->data, provider, providerlen);
64580e2e6b6SBrian Somers data->data_len = providerlen;
64687c3786eSBrian Somers
64787c3786eSBrian Somers log_Printf(LogDEBUG, "Sending PPPOE_CONNECT to %s\n", connectpath);
64887c3786eSBrian Somers if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE,
64987c3786eSBrian Somers NGM_PPPOE_CONNECT, data, sizeof *data + providerlen) == -1) {
65087c3786eSBrian Somers log_Printf(LogWARN, "``%s'': Cannot start netgraph node: %s\n",
65187c3786eSBrian Somers connectpath, strerror(errno));
65287c3786eSBrian Somers return ether_Abandon(dev, p);
65387c3786eSBrian Somers }
65487c3786eSBrian Somers
65540125273SBrian Somers /* Hook things up so that we monitor dev->cs */
65640125273SBrian Somers p->desc.UpdateSet = ether_UpdateSet;
65740125273SBrian Somers p->desc.IsSet = ether_IsSet;
65840125273SBrian Somers p->desc.Read = ether_DescriptorRead;
659fdc29d54SBrian Somers
660fdc29d54SBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
661fdc29d54SBrian Somers switch (p->cfg.cd.necessity) {
662fdc29d54SBrian Somers case CD_VARIABLE:
663fdc29d54SBrian Somers dev->dev.cd.delay = p->cfg.cd.delay;
664fdc29d54SBrian Somers break;
665fdc29d54SBrian Somers case CD_REQUIRED:
666fdc29d54SBrian Somers dev->dev.cd = p->cfg.cd;
667fdc29d54SBrian Somers break;
668fdc29d54SBrian Somers case CD_NOTREQUIRED:
669fdc29d54SBrian Somers log_Printf(LogWARN, "%s: Carrier must be set, using ``set cd %d!''\n",
670fdc29d54SBrian Somers p->link.name, dev->dev.cd.delay);
671fdc29d54SBrian Somers case CD_DEFAULT:
672fdc29d54SBrian Somers break;
673fdc29d54SBrian Somers }
674fdc29d54SBrian Somers
675fdc29d54SBrian Somers dev->timeout = dev->dev.cd.delay;
676fdc29d54SBrian Somers dev->connected = CARRIER_PENDING;
677de59e178SBrian Somers /* This will be overridden by our session id - if provided by netgraph */
678de59e178SBrian Somers dev->slot = GetIfIndex(path);
67987c3786eSBrian Somers } else {
68087c3786eSBrian Somers /* See if we're a netgraph socket */
681165fbe26SBrian Somers struct stat st;
682165fbe26SBrian Somers
683165fbe26SBrian Somers if (fstat(p->fd, &st) != -1 && (st.st_mode & S_IFSOCK)) {
684165fbe26SBrian Somers struct sockaddr_storage ssock;
685165fbe26SBrian Somers struct sockaddr *sock = (struct sockaddr *)&ssock;
68687c3786eSBrian Somers int sz;
68787c3786eSBrian Somers
688165fbe26SBrian Somers sz = sizeof ssock;
689165fbe26SBrian Somers if (getsockname(p->fd, sock, &sz) == -1) {
690165fbe26SBrian Somers log_Printf(LogPHASE, "%s: Link is a closed socket !\n", p->link.name);
691165fbe26SBrian Somers close(p->fd);
692165fbe26SBrian Somers p->fd = -1;
693165fbe26SBrian Somers return NULL;
694165fbe26SBrian Somers }
695165fbe26SBrian Somers
696165fbe26SBrian Somers if (sock->sa_family == AF_NETGRAPH) {
69787c3786eSBrian Somers /*
69840125273SBrian Somers * It's a netgraph node... We can't determine hook names etc, so we
69940125273SBrian Somers * stay pretty impartial....
70087c3786eSBrian Somers */
70140125273SBrian Somers log_Printf(LogPHASE, "%s: Link is a netgraph node\n", p->link.name);
70287c3786eSBrian Somers
70387c3786eSBrian Somers if ((dev = malloc(sizeof *dev)) == NULL) {
70487c3786eSBrian Somers log_Printf(LogWARN, "%s: Cannot allocate an ether device: %s\n",
70587c3786eSBrian Somers p->link.name, strerror(errno));
70687c3786eSBrian Somers return NULL;
70787c3786eSBrian Somers }
70887c3786eSBrian Somers
709fdc29d54SBrian Somers memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
71087c3786eSBrian Somers dev->cs = -1;
71187c3786eSBrian Somers dev->timeout = 0;
71287c3786eSBrian Somers dev->connected = CARRIER_OK;
71340125273SBrian Somers *dev->hook = '\0';
714de59e178SBrian Somers
715de59e178SBrian Somers /*
716de59e178SBrian Somers * If we're being envoked from pppoed(8), we may have a SESSIONID
717de59e178SBrian Somers * set in the environment. If so, use it as the slot
718de59e178SBrian Somers */
719de59e178SBrian Somers if ((sessionid = getenv("SESSIONID")) != NULL) {
720de59e178SBrian Somers char *end;
721de59e178SBrian Somers u_long slot;
722de59e178SBrian Somers
723de59e178SBrian Somers slot = strtoul(sessionid, &end, 16);
724de59e178SBrian Somers dev->slot = end != sessionid && *end == '\0' ? slot : 0;
725de59e178SBrian Somers } else
726de59e178SBrian Somers dev->slot = 0;
72787c3786eSBrian Somers }
72887c3786eSBrian Somers }
729165fbe26SBrian Somers }
73087c3786eSBrian Somers
73187c3786eSBrian Somers if (dev) {
73287c3786eSBrian Somers physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
73387c3786eSBrian Somers return &dev->dev;
73487c3786eSBrian Somers }
73587c3786eSBrian Somers
73687c3786eSBrian Somers return NULL;
73787c3786eSBrian Somers }
738