ether.c revision 96582
152942Sbrian/*-
252942Sbrian * Copyright (c) 1999 Brian Somers <brian@Awfulhak.org>
352942Sbrian * All rights reserved.
452942Sbrian *
552942Sbrian * Redistribution and use in source and binary forms, with or without
652942Sbrian * modification, are permitted provided that the following conditions
752942Sbrian * are met:
852942Sbrian * 1. Redistributions of source code must retain the above copyright
952942Sbrian *    notice, this list of conditions and the following disclaimer.
1052942Sbrian * 2. Redistributions in binary form must reproduce the above copyright
1152942Sbrian *    notice, this list of conditions and the following disclaimer in the
1252942Sbrian *    documentation and/or other materials provided with the distribution.
1352942Sbrian *
1452942Sbrian * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1552942Sbrian * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1652942Sbrian * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1752942Sbrian * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1852942Sbrian * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
1952942Sbrian * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2052942Sbrian * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2152942Sbrian * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2252942Sbrian * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2352942Sbrian * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2452942Sbrian * SUCH DAMAGE.
2552942Sbrian *
2652942Sbrian * $FreeBSD: head/usr.sbin/ppp/ether.c 96582 2002-05-14 12:55:39Z brian $
2752942Sbrian */
2852942Sbrian
2952942Sbrian#include <sys/param.h>
3052942Sbrian#include <sys/socket.h>
3152942Sbrian#include <sys/un.h>
3252942Sbrian#include <netinet/in.h>
3352942Sbrian#include <arpa/inet.h>
3452942Sbrian#include <netdb.h>
3552942Sbrian#include <netgraph.h>
3652942Sbrian#include <net/ethernet.h>
3774916Sbrian#include <net/if.h>
3874916Sbrian#include <net/route.h>
3952942Sbrian#include <netinet/in_systm.h>
4052942Sbrian#include <netinet/ip.h>
4152942Sbrian#include <netgraph/ng_ether.h>
4252942Sbrian#include <netgraph/ng_message.h>
4352942Sbrian#include <netgraph/ng_pppoe.h>
4452942Sbrian#include <netgraph/ng_socket.h>
4552942Sbrian
4652942Sbrian#include <errno.h>
4752942Sbrian#include <stdio.h>
4852942Sbrian#include <stdlib.h>
4952942Sbrian#include <string.h>
5052942Sbrian#include <sysexits.h>
5152942Sbrian#include <sys/fcntl.h>
5271006Sbrian#include <sys/stat.h>
5352942Sbrian#include <sys/uio.h>
5452942Sbrian#include <termios.h>
5552942Sbrian#include <sys/time.h>
5696582Sbrian#include <syslog.h>
5752942Sbrian#include <unistd.h>
5852942Sbrian
5952942Sbrian#include "layer.h"
6052942Sbrian#include "defs.h"
6152942Sbrian#include "mbuf.h"
6252942Sbrian#include "log.h"
6352942Sbrian#include "timer.h"
6452942Sbrian#include "lqr.h"
6552942Sbrian#include "hdlc.h"
6652942Sbrian#include "throughput.h"
6752942Sbrian#include "fsm.h"
6852942Sbrian#include "lcp.h"
6952942Sbrian#include "ccp.h"
7052942Sbrian#include "link.h"
7152942Sbrian#include "async.h"
7252942Sbrian#include "descriptor.h"
7352942Sbrian#include "physical.h"
7452942Sbrian#include "main.h"
7552942Sbrian#include "mp.h"
7652942Sbrian#include "chat.h"
7752942Sbrian#include "auth.h"
7852942Sbrian#include "chap.h"
7952942Sbrian#include "cbcp.h"
8052942Sbrian#include "datalink.h"
8152942Sbrian#include "slcompress.h"
8252942Sbrian#include "iplist.h"
8381634Sbrian#include "ncpaddr.h"
8481634Sbrian#include "ip.h"
8552942Sbrian#include "ipcp.h"
8652942Sbrian#include "filter.h"
8752942Sbrian#ifndef NORADIUS
8852942Sbrian#include "radius.h"
8952942Sbrian#endif
9081634Sbrian#include "ipv6cp.h"
9181634Sbrian#include "ncp.h"
9252942Sbrian#include "bundle.h"
9352942Sbrian#include "id.h"
9474916Sbrian#include "iface.h"
9596582Sbrian#include "route.h"
9652942Sbrian#include "ether.h"
9752942Sbrian
9852942Sbrian
9952942Sbrian#define PPPOE_NODE_TYPE_LEN (sizeof NG_PPPOE_NODE_TYPE - 1) /* "PPPoE" */
10052942Sbrian
10152942Sbrianstruct etherdevice {
10252942Sbrian  struct device dev;			/* What struct physical knows about */
10352942Sbrian  int cs;				/* Control socket */
10452942Sbrian  int connected;			/* Are we connected yet ? */
10552942Sbrian  int timeout;				/* Seconds attempting to connect */
10652942Sbrian  char hook[sizeof TUN_NAME + 11];	/* Our socket node hook */
10796582Sbrian  u_int32_t slot;			/* ifindex << 24 | unit */
10852942Sbrian};
10952942Sbrian
11052942Sbrian#define device2ether(d) \
11152942Sbrian  ((d)->type == ETHER_DEVICE ? (struct etherdevice *)d : NULL)
11252942Sbrian
11352942Sbrianint
11452942Sbrianether_DeviceSize(void)
11552942Sbrian{
11652942Sbrian  return sizeof(struct etherdevice);
11752942Sbrian}
11852942Sbrian
11952942Sbrianstatic ssize_t
12052942Sbrianether_Write(struct physical *p, const void *v, size_t n)
12152942Sbrian{
12252942Sbrian  struct etherdevice *dev = device2ether(p->handler);
12352942Sbrian
12452942Sbrian  return NgSendData(p->fd, dev->hook, v, n) == -1 ? -1 : n;
12552942Sbrian}
12652942Sbrian
12752942Sbrianstatic ssize_t
12852942Sbrianether_Read(struct physical *p, void *v, size_t n)
12952942Sbrian{
13052942Sbrian  char hook[sizeof TUN_NAME + 11];
13152942Sbrian
13252942Sbrian  return NgRecvData(p->fd, v, n, hook);
13352942Sbrian}
13452942Sbrian
13552942Sbrianstatic int
13652942Sbrianether_RemoveFromSet(struct physical *p, fd_set *r, fd_set *w, fd_set *e)
13752942Sbrian{
13852942Sbrian  struct etherdevice *dev = device2ether(p->handler);
13952942Sbrian  int result;
14052942Sbrian
14152942Sbrian  if (r && dev->cs >= 0 && FD_ISSET(dev->cs, r)) {
14252942Sbrian    FD_CLR(dev->cs, r);
14352942Sbrian    log_Printf(LogTIMER, "%s: fdunset(ctrl) %d\n", p->link.name, dev->cs);
14452942Sbrian    result = 1;
14552942Sbrian  } else
14652942Sbrian    result = 0;
14752942Sbrian
14852942Sbrian  /* Careful... physical_RemoveFromSet() called us ! */
14952942Sbrian
15052942Sbrian  p->handler->removefromset = NULL;
15152942Sbrian  result += physical_RemoveFromSet(p, r, w, e);
15252942Sbrian  p->handler->removefromset = ether_RemoveFromSet;
15352942Sbrian
15452942Sbrian  return result;
15552942Sbrian}
15652942Sbrian
15752942Sbrianstatic void
15852942Sbrianether_Free(struct physical *p)
15952942Sbrian{
16052942Sbrian  struct etherdevice *dev = device2ether(p->handler);
16152942Sbrian
16252942Sbrian  physical_SetDescriptor(p);
16352942Sbrian  if (dev->cs != -1)
16452942Sbrian    close(dev->cs);
16552942Sbrian  free(dev);
16652942Sbrian}
16752942Sbrian
16852942Sbrianstatic const char *
16952942Sbrianether_OpenInfo(struct physical *p)
17052942Sbrian{
17152942Sbrian  struct etherdevice *dev = device2ether(p->handler);
17252942Sbrian
17352942Sbrian  switch (dev->connected) {
17452942Sbrian    case CARRIER_PENDING:
17552942Sbrian      return "negotiating";
17652942Sbrian    case CARRIER_OK:
17752942Sbrian      return "established";
17852942Sbrian  }
17952942Sbrian
18052942Sbrian  return "disconnected";
18152942Sbrian}
18252942Sbrian
18396582Sbrianstatic int
18496582Sbrianether_Slot(struct physical *p)
18596582Sbrian{
18696582Sbrian  struct etherdevice *dev = device2ether(p->handler);
18796582Sbrian
18896582Sbrian  return dev->slot;
18996582Sbrian}
19096582Sbrian
19196582Sbrian
19252942Sbrianstatic void
19352942Sbrianether_device2iov(struct device *d, struct iovec *iov, int *niov,
19453684Sbrian                 int maxiov, int *auxfd, int *nauxfd)
19552942Sbrian{
19652942Sbrian  struct etherdevice *dev = device2ether(d);
19752942Sbrian  int sz = physical_MaxDeviceSize();
19852942Sbrian
19952942Sbrian  iov[*niov].iov_base = realloc(d, sz);
20052942Sbrian  if (iov[*niov].iov_base == NULL) {
20152942Sbrian    log_Printf(LogALERT, "Failed to allocate memory: %d\n", sz);
20252942Sbrian    AbortProgram(EX_OSERR);
20352942Sbrian  }
20452942Sbrian  iov[*niov].iov_len = sz;
20552942Sbrian  (*niov)++;
20652942Sbrian
20752942Sbrian  if (dev->cs >= 0) {
20852942Sbrian    *auxfd = dev->cs;
20952942Sbrian    (*nauxfd)++;
21052942Sbrian  }
21152942Sbrian}
21252942Sbrian
21352942Sbrianstatic void
21452942Sbrianether_MessageIn(struct etherdevice *dev)
21552942Sbrian{
21652942Sbrian  char msgbuf[sizeof(struct ng_mesg) + sizeof(struct ngpppoe_sts)];
21752942Sbrian  struct ng_mesg *rep = (struct ng_mesg *)msgbuf;
21852942Sbrian  struct ngpppoe_sts *sts = (struct ngpppoe_sts *)(msgbuf + sizeof *rep);
21996582Sbrian  char *end, unknown[14], sessionid[5];
22052942Sbrian  const char *msg;
22152942Sbrian  struct timeval t;
22266898Sbrian  fd_set *r;
22396582Sbrian  u_long slot;
22466898Sbrian  int ret;
22552942Sbrian
22652942Sbrian  if (dev->cs < 0)
22752942Sbrian    return;
22852942Sbrian
22966898Sbrian  if ((r = mkfdset()) == NULL) {
23066898Sbrian    log_Printf(LogERROR, "DoLoop: Cannot create fd_set\n");
23166898Sbrian    return;
23266898Sbrian  }
23366898Sbrian  zerofdset(r);
23466898Sbrian  FD_SET(dev->cs, r);
23552942Sbrian  t.tv_sec = t.tv_usec = 0;
23666898Sbrian  ret = select(dev->cs + 1, r, NULL, NULL, &t);
23766898Sbrian  free(r);
23866898Sbrian
23966898Sbrian  if (ret <= 0)
24052942Sbrian    return;
24152942Sbrian
24282277Sbrian  if (NgRecvMsg(dev->cs, rep, sizeof msgbuf, NULL) <= 0)
24352942Sbrian    return;
24452942Sbrian
24552942Sbrian  if (rep->header.version != NG_VERSION) {
24652942Sbrian    log_Printf(LogWARN, "%ld: Unexpected netgraph version, expected %ld\n",
24752942Sbrian               (long)rep->header.version, (long)NG_VERSION);
24852942Sbrian    return;
24952942Sbrian  }
25052942Sbrian
25152942Sbrian  if (rep->header.typecookie != NGM_PPPOE_COOKIE) {
25252942Sbrian    log_Printf(LogWARN, "%ld: Unexpected netgraph cookie, expected %ld\n",
25352942Sbrian               (long)rep->header.typecookie, (long)NGM_PPPOE_COOKIE);
25452942Sbrian    return;
25552942Sbrian  }
25652942Sbrian
25752942Sbrian  switch (rep->header.cmd) {
25852942Sbrian    case NGM_PPPOE_SET_FLAG:	msg = "SET_FLAG";	break;
25952942Sbrian    case NGM_PPPOE_CONNECT:	msg = "CONNECT";	break;
26052942Sbrian    case NGM_PPPOE_LISTEN:	msg = "LISTEN";		break;
26152942Sbrian    case NGM_PPPOE_OFFER:	msg = "OFFER";		break;
26252942Sbrian    case NGM_PPPOE_SUCCESS:	msg = "SUCCESS";	break;
26352942Sbrian    case NGM_PPPOE_FAIL:	msg = "FAIL";		break;
26452942Sbrian    case NGM_PPPOE_CLOSE:	msg = "CLOSE";		break;
26552942Sbrian    case NGM_PPPOE_GET_STATUS:	msg = "GET_STATUS";	break;
26690975Sbrian    case NGM_PPPOE_ACNAME:
26790975Sbrian      msg = "ACNAME";
26890975Sbrian      if (setenv("ACNAME", sts->hook, 1) != 0)
26990975Sbrian        log_Printf(LogWARN, "setenv: cannot set ACNAME=%s: %m", sts->hook);
27090975Sbrian      break;
27196582Sbrian    case NGM_PPPOE_SESSIONID:
27296582Sbrian      msg = "SESSIONID";
27396582Sbrian      snprintf(sessionid, sizeof sessionid, "%04x", *(u_int16_t *)sts);
27496582Sbrian      if (setenv("SESSIONID", sessionid, 1) != 0)
27596582Sbrian        syslog(LOG_WARNING, "setenv: cannot set SESSIONID=%s: %m",
27696582Sbrian               sessionid);
27796582Sbrian      /* Use this in preference to our interface index */
27896582Sbrian      slot = strtoul(sessionid, &end, 16);
27996582Sbrian      if (end != sessionid && *end == '\0')
28096582Sbrian          dev->slot = slot;
28196582Sbrian      break;
28252942Sbrian    default:
28352942Sbrian      snprintf(unknown, sizeof unknown, "<%d>", (int)rep->header.cmd);
28452942Sbrian      msg = unknown;
28552942Sbrian      break;
28652942Sbrian  }
28752942Sbrian
28852942Sbrian  log_Printf(LogPHASE, "Received NGM_PPPOE_%s (hook \"%s\")\n", msg, sts->hook);
28952942Sbrian
29052942Sbrian  switch (rep->header.cmd) {
29152942Sbrian    case NGM_PPPOE_SUCCESS:
29252942Sbrian      dev->connected = CARRIER_OK;
29352942Sbrian      break;
29452942Sbrian    case NGM_PPPOE_FAIL:
29552942Sbrian    case NGM_PPPOE_CLOSE:
29652942Sbrian      dev->connected = CARRIER_LOST;
29752942Sbrian      break;
29852942Sbrian  }
29952942Sbrian}
30052942Sbrian
30152942Sbrianstatic int
30252942Sbrianether_AwaitCarrier(struct physical *p)
30352942Sbrian{
30452942Sbrian  struct etherdevice *dev = device2ether(p->handler);
30552942Sbrian
30653071Sbrian  if (dev->connected != CARRIER_OK && !dev->timeout--)
30752942Sbrian    dev->connected = CARRIER_LOST;
30852942Sbrian  else if (dev->connected == CARRIER_PENDING)
30952942Sbrian    ether_MessageIn(dev);
31052942Sbrian
31152942Sbrian  return dev->connected;
31252942Sbrian}
31352942Sbrian
31452942Sbrianstatic const struct device baseetherdevice = {
31552942Sbrian  ETHER_DEVICE,
31652942Sbrian  "ether",
31778410Sbrian  1492,
31853733Sbrian  { CD_REQUIRED, DEF_ETHERCDDELAY },
31952942Sbrian  ether_AwaitCarrier,
32052942Sbrian  ether_RemoveFromSet,
32152942Sbrian  NULL,
32252942Sbrian  NULL,
32352942Sbrian  NULL,
32452942Sbrian  NULL,
32593418Sbrian  NULL,
32652942Sbrian  ether_Free,
32752942Sbrian  ether_Read,
32852942Sbrian  ether_Write,
32952942Sbrian  ether_device2iov,
33052942Sbrian  NULL,
33196582Sbrian  ether_OpenInfo,
33296582Sbrian  ether_Slot
33352942Sbrian};
33452942Sbrian
33552942Sbrianstruct device *
33652942Sbrianether_iov2device(int type, struct physical *p, struct iovec *iov, int *niov,
33752942Sbrian                 int maxiov, int *auxfd, int *nauxfd)
33852942Sbrian{
33952942Sbrian  if (type == ETHER_DEVICE) {
34052942Sbrian    struct etherdevice *dev = (struct etherdevice *)iov[(*niov)++].iov_base;
34152942Sbrian
34252942Sbrian    dev = realloc(dev, sizeof *dev);	/* Reduce to the correct size */
34352942Sbrian    if (dev == NULL) {
34452942Sbrian      log_Printf(LogALERT, "Failed to allocate memory: %d\n",
34552942Sbrian                 (int)(sizeof *dev));
34652942Sbrian      AbortProgram(EX_OSERR);
34752942Sbrian    }
34852942Sbrian
34952942Sbrian    if (*nauxfd) {
35052942Sbrian      dev->cs = *auxfd;
35152942Sbrian      (*nauxfd)--;
35252942Sbrian    } else
35352942Sbrian      dev->cs = -1;
35452942Sbrian
35552942Sbrian    /* Refresh function pointers etc */
35652942Sbrian    memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
35752942Sbrian
35852942Sbrian    physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
35952942Sbrian    return &dev->dev;
36052942Sbrian  }
36152942Sbrian
36252942Sbrian  return NULL;
36352942Sbrian}
36452942Sbrian
36552942Sbrianstatic int
36658028Sbrianether_UpdateSet(struct fdescriptor *d, fd_set *r, fd_set *w, fd_set *e, int *n)
36752942Sbrian{
36852942Sbrian  struct physical *p = descriptor2physical(d);
36952942Sbrian  struct etherdevice *dev = device2ether(p->handler);
37052942Sbrian  int result;
37152942Sbrian
37252942Sbrian  if (r && dev->cs >= 0) {
37352942Sbrian    FD_SET(dev->cs, r);
37452942Sbrian    log_Printf(LogTIMER, "%s(ctrl): fdset(r) %d\n", p->link.name, dev->cs);
37552942Sbrian    result = 1;
37652942Sbrian  } else
37752942Sbrian    result = 0;
37852942Sbrian
37952942Sbrian  result += physical_doUpdateSet(d, r, w, e, n, 0);
38052942Sbrian
38152942Sbrian  return result;
38252942Sbrian}
38352942Sbrian
38452942Sbrianstatic int
38558028Sbrianether_IsSet(struct fdescriptor *d, const fd_set *fdset)
38652942Sbrian{
38752942Sbrian  struct physical *p = descriptor2physical(d);
38852942Sbrian  struct etherdevice *dev = device2ether(p->handler);
38952942Sbrian  int result;
39052942Sbrian
39152942Sbrian  result = dev->cs >= 0 && FD_ISSET(dev->cs, fdset);
39252942Sbrian  result += physical_IsSet(d, fdset);
39352942Sbrian
39452942Sbrian  return result;
39552942Sbrian}
39652942Sbrian
39752942Sbrianstatic void
39858028Sbrianether_DescriptorRead(struct fdescriptor *d, struct bundle *bundle,
39952942Sbrian                     const fd_set *fdset)
40052942Sbrian{
40152942Sbrian  struct physical *p = descriptor2physical(d);
40252942Sbrian  struct etherdevice *dev = device2ether(p->handler);
40352942Sbrian
40452942Sbrian  if (dev->cs >= 0 && FD_ISSET(dev->cs, fdset)) {
40552942Sbrian    ether_MessageIn(dev);
40652942Sbrian    if (dev->connected == CARRIER_LOST) {
40752942Sbrian      log_Printf(LogPHASE, "%s: Device disconnected\n", p->link.name);
40852942Sbrian      datalink_Down(p->dl, CLOSE_NORMAL);
40952942Sbrian      return;
41052942Sbrian    }
41152942Sbrian  }
41252942Sbrian
41352942Sbrian  if (physical_IsSet(d, fdset))
41452942Sbrian    physical_DescriptorRead(d, bundle, fdset);
41552942Sbrian}
41652942Sbrian
41752942Sbrianstatic struct device *
41852942Sbrianether_Abandon(struct etherdevice *dev, struct physical *p)
41952942Sbrian{
42052942Sbrian  /* Abandon our node construction */
42152942Sbrian  close(dev->cs);
42252942Sbrian  close(p->fd);
42352942Sbrian  p->fd = -2;	/* Nobody else need try.. */
42452942Sbrian  free(dev);
42552942Sbrian
42652942Sbrian  return NULL;
42752942Sbrian}
42852942Sbrian
42952942Sbrianstruct device *
43052942Sbrianether_Create(struct physical *p)
43152942Sbrian{
43252942Sbrian  u_char rbuf[2048];
43352942Sbrian  struct etherdevice *dev;
43452942Sbrian  struct ng_mesg *resp;
43552942Sbrian  const struct hooklist *hlist;
43652942Sbrian  const struct nodeinfo *ninfo;
43796582Sbrian  char *path, *sessionid;
43874916Sbrian  int ifacelen, f;
43952942Sbrian
44052942Sbrian  dev = NULL;
44174916Sbrian  path = NULL;
44274916Sbrian  ifacelen = 0;
44352942Sbrian  if (p->fd < 0 && !strncasecmp(p->name.full, NG_PPPOE_NODE_TYPE,
44452942Sbrian                                PPPOE_NODE_TYPE_LEN) &&
44552942Sbrian      p->name.full[PPPOE_NODE_TYPE_LEN] == ':') {
44652942Sbrian    const struct linkinfo *nlink;
44752942Sbrian    struct ngpppoe_init_data *data;
44852942Sbrian    struct ngm_mkpeer mkp;
44952942Sbrian    struct ngm_connect ngc;
45052942Sbrian    const char *iface, *provider;
45174916Sbrian    char etherid[12];
45274916Sbrian    int providerlen;
45352942Sbrian    char connectpath[sizeof dev->hook + 2];	/* .:<hook> */
45452942Sbrian
45552942Sbrian    p->fd--;				/* We own the device - change fd */
45652942Sbrian
45793418Sbrian    loadmodules(LOAD_VERBOSLY, "netgraph", "ng_ether", "ng_pppoe", "ng_socket",
45893418Sbrian                NULL);
45952942Sbrian
46052942Sbrian    if ((dev = malloc(sizeof *dev)) == NULL)
46152942Sbrian      return NULL;
46252942Sbrian
46352942Sbrian    iface = p->name.full + PPPOE_NODE_TYPE_LEN + 1;
46452942Sbrian
46552942Sbrian    provider = strchr(iface, ':');
46652942Sbrian    if (provider) {
46752942Sbrian      ifacelen = provider - iface;
46852942Sbrian      provider++;
46952942Sbrian      providerlen = strlen(provider);
47052942Sbrian    } else {
47152942Sbrian      ifacelen = strlen(iface);
47252942Sbrian      provider = "";
47352942Sbrian      providerlen = 0;
47452942Sbrian    }
47552942Sbrian
47652942Sbrian    /*
47752942Sbrian     * We're going to do this (where tunN is our tunnel device):
47852942Sbrian     *
47952942Sbrian     * .---------.
48052942Sbrian     * |  ether  |
48152942Sbrian     * | <iface> |                         dev->cs
48252942Sbrian     * `---------'                           |
48352942Sbrian     *  (orphan)                     p->fd   |
48452942Sbrian     *     |                           |     |
48552942Sbrian     *     |                           |     |
48652942Sbrian     * (ethernet)                      |     |
48752942Sbrian     * .---------.                  .-----------.
48852942Sbrian     * |  pppoe  |                  |  socket   |
48952942Sbrian     * | <iface> |(tunN)<---->(tunN)| <unnamed> |
49052942Sbrian     * `---------                   `-----------'
49152942Sbrian     *   (tunX)
49252942Sbrian     *     ^
49352942Sbrian     *     |
49452942Sbrian     *     `--->(tunX)
49552942Sbrian     */
49652942Sbrian
49752942Sbrian    /* Create a socket node */
49853535Sbrian    if (ID0NgMkSockNode(NULL, &dev->cs, &p->fd) == -1) {
49952942Sbrian      log_Printf(LogWARN, "Cannot create netgraph socket node: %s\n",
50052942Sbrian                 strerror(errno));
50152942Sbrian      free(dev);
50293418Sbrian      p->fd = -2;
50352942Sbrian      return NULL;
50452942Sbrian    }
50552942Sbrian
50652942Sbrian    /*
50752942Sbrian     * Ask for a list of hooks attached to the "ether" node.  This node should
50852942Sbrian     * magically exist as a way of hooking stuff onto an ethernet device
50952942Sbrian     */
51052942Sbrian    path = (char *)alloca(ifacelen + 2);
51152942Sbrian    sprintf(path, "%.*s:", ifacelen, iface);
51252942Sbrian    if (NgSendMsg(dev->cs, path, NGM_GENERIC_COOKIE, NGM_LISTHOOKS,
51352942Sbrian                  NULL, 0) < 0) {
51452942Sbrian      log_Printf(LogWARN, "%s Cannot send a netgraph message: %s\n",
51552942Sbrian                 path, strerror(errno));
51652942Sbrian      return ether_Abandon(dev, p);
51752942Sbrian    }
51852942Sbrian
51952942Sbrian    /* Get our list back */
52052942Sbrian    resp = (struct ng_mesg *)rbuf;
52182277Sbrian    if (NgRecvMsg(dev->cs, resp, sizeof rbuf, NULL) <= 0) {
52252942Sbrian      log_Printf(LogWARN, "Cannot get netgraph response: %s\n",
52352942Sbrian                 strerror(errno));
52452942Sbrian      return ether_Abandon(dev, p);
52552942Sbrian    }
52652942Sbrian
52752942Sbrian    hlist = (const struct hooklist *)resp->data;
52852942Sbrian    ninfo = &hlist->nodeinfo;
52952942Sbrian
53052942Sbrian    /* Make sure we've got the right type of node */
53152942Sbrian    if (strncmp(ninfo->type, NG_ETHER_NODE_TYPE,
53252942Sbrian                sizeof NG_ETHER_NODE_TYPE - 1)) {
53352942Sbrian      log_Printf(LogWARN, "%s Unexpected node type ``%s'' (wanted ``"
53452942Sbrian                 NG_ETHER_NODE_TYPE "'')\n", path, ninfo->type);
53552942Sbrian      return ether_Abandon(dev, p);
53652942Sbrian    }
53752942Sbrian
53852963Sbrian    log_Printf(LogDEBUG, "List of netgraph node ``%s'' (id %x) hooks:\n",
53952942Sbrian               path, ninfo->id);
54052942Sbrian
54152942Sbrian    /* look for a hook already attached.  */
54252942Sbrian    for (f = 0; f < ninfo->hooks; f++) {
54352942Sbrian      nlink = &hlist->link[f];
54452942Sbrian
54552942Sbrian      log_Printf(LogDEBUG, "  Found %s -> %s\n", nlink->ourhook,
54652942Sbrian                 nlink->peerhook);
54752942Sbrian
54852942Sbrian      if (!strcmp(nlink->ourhook, NG_ETHER_HOOK_ORPHAN) ||
54952942Sbrian          !strcmp(nlink->ourhook, NG_ETHER_HOOK_DIVERT)) {
55052942Sbrian        /*
55152942Sbrian         * Something is using the data coming out of this ``ether'' node.
55252942Sbrian         * If it's a PPPoE node, we use that node, otherwise we complain that
55352942Sbrian         * someone else is using the node.
55452942Sbrian         */
55552942Sbrian        if (!strcmp(nlink->nodeinfo.type, NG_PPPOE_NODE_TYPE))
55652942Sbrian          /* Use this PPPoE node ! */
55752963Sbrian          snprintf(ngc.path, sizeof ngc.path, "[%x]:", nlink->nodeinfo.id);
55852942Sbrian        else {
55952942Sbrian          log_Printf(LogWARN, "%s Node type ``%s'' is currently active\n",
56052942Sbrian                     path, nlink->nodeinfo.type);
56152942Sbrian          return ether_Abandon(dev, p);
56252942Sbrian        }
56352942Sbrian        break;
56452942Sbrian      }
56552942Sbrian    }
56652942Sbrian
56752942Sbrian    if (f == ninfo->hooks) {
56852942Sbrian      /*
56952942Sbrian       * Create a new ``PPPoE'' node connected to the ``ether'' node using
57093418Sbrian       * the ``orphan'' and ``ethernet'' hooks
57152942Sbrian       */
57252942Sbrian      snprintf(mkp.type, sizeof mkp.type, "%s", NG_PPPOE_NODE_TYPE);
57352942Sbrian      snprintf(mkp.ourhook, sizeof mkp.ourhook, "%s", NG_ETHER_HOOK_ORPHAN);
57452942Sbrian      snprintf(mkp.peerhook, sizeof mkp.peerhook, "%s", NG_PPPOE_HOOK_ETHERNET);
57552963Sbrian      snprintf(etherid, sizeof etherid, "[%x]:", ninfo->id);
57652942Sbrian
57752942Sbrian      log_Printf(LogDEBUG, "Creating PPPoE netgraph node %s%s -> %s\n",
57852942Sbrian                 etherid, mkp.ourhook, mkp.peerhook);
57952942Sbrian
58052942Sbrian      if (NgSendMsg(dev->cs, etherid, NGM_GENERIC_COOKIE,
58152942Sbrian                    NGM_MKPEER, &mkp, sizeof mkp) < 0) {
58252942Sbrian        log_Printf(LogWARN, "%s Cannot create PPPoE netgraph node: %s\n",
58352942Sbrian                   etherid, strerror(errno));
58452942Sbrian        return ether_Abandon(dev, p);
58552942Sbrian      }
58652942Sbrian
58752942Sbrian      snprintf(ngc.path, sizeof ngc.path, "%s%s", path, NG_ETHER_HOOK_ORPHAN);
58852942Sbrian    }
58952942Sbrian
59052942Sbrian    snprintf(dev->hook, sizeof dev->hook, "%s%d",
59152942Sbrian             TUN_NAME, p->dl->bundle->unit);
59252942Sbrian
59352942Sbrian    /*
59452942Sbrian     * Connect the PPPoE node to our socket node.
59552942Sbrian     * ngc.path has already been set up
59652942Sbrian     */
59752942Sbrian    snprintf(ngc.ourhook, sizeof ngc.ourhook, "%s", dev->hook);
59852942Sbrian    memcpy(ngc.peerhook, ngc.ourhook, sizeof ngc.peerhook);
59952942Sbrian
60052942Sbrian    log_Printf(LogDEBUG, "Connecting netgraph socket .:%s -> %s:%s\n",
60152942Sbrian               ngc.ourhook, ngc.path, ngc.peerhook);
60252942Sbrian    if (NgSendMsg(dev->cs, ".:", NGM_GENERIC_COOKIE,
60352942Sbrian                  NGM_CONNECT, &ngc, sizeof ngc) < 0) {
60452942Sbrian      log_Printf(LogWARN, "Cannot connect PPPoE and socket netgraph "
60552942Sbrian                 "nodes: %s\n", strerror(errno));
60652942Sbrian      return ether_Abandon(dev, p);
60752942Sbrian    }
60852942Sbrian
60979854Sbrian    /* Bring the Ethernet interface up */
61079854Sbrian    path[ifacelen] = '\0';	/* Remove the trailing ':' */
61179854Sbrian    if (!iface_SetFlags(path, IFF_UP))
61279854Sbrian      log_Printf(LogWARN, "%s: Failed to set the IFF_UP flag on %s\n",
61379854Sbrian                 p->link.name, path);
61479854Sbrian
61552942Sbrian    /* And finally, request a connection to the given provider */
61652942Sbrian
61768032Sbrian    data = (struct ngpppoe_init_data *)alloca(sizeof *data + providerlen);
61852942Sbrian    snprintf(data->hook, sizeof data->hook, "%s", dev->hook);
61968846Sbrian    memcpy(data->data, provider, providerlen);
62068846Sbrian    data->data_len = providerlen;
62152942Sbrian
62252942Sbrian    snprintf(connectpath, sizeof connectpath, ".:%s", dev->hook);
62352942Sbrian    log_Printf(LogDEBUG, "Sending PPPOE_CONNECT to %s\n", connectpath);
62452942Sbrian    if (NgSendMsg(dev->cs, connectpath, NGM_PPPOE_COOKIE,
62552942Sbrian                  NGM_PPPOE_CONNECT, data, sizeof *data + providerlen) == -1) {
62652942Sbrian      log_Printf(LogWARN, "``%s'': Cannot start netgraph node: %s\n",
62752942Sbrian                 connectpath, strerror(errno));
62852942Sbrian      return ether_Abandon(dev, p);
62952942Sbrian    }
63052942Sbrian
63153062Sbrian    /* Hook things up so that we monitor dev->cs */
63253062Sbrian    p->desc.UpdateSet = ether_UpdateSet;
63353062Sbrian    p->desc.IsSet = ether_IsSet;
63453062Sbrian    p->desc.Read = ether_DescriptorRead;
63553733Sbrian
63653733Sbrian    memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
63753733Sbrian    switch (p->cfg.cd.necessity) {
63853733Sbrian      case CD_VARIABLE:
63953733Sbrian        dev->dev.cd.delay = p->cfg.cd.delay;
64053733Sbrian        break;
64153733Sbrian      case CD_REQUIRED:
64253733Sbrian        dev->dev.cd = p->cfg.cd;
64353733Sbrian        break;
64453733Sbrian      case CD_NOTREQUIRED:
64553733Sbrian        log_Printf(LogWARN, "%s: Carrier must be set, using ``set cd %d!''\n",
64653733Sbrian                   p->link.name, dev->dev.cd.delay);
64753733Sbrian      case CD_DEFAULT:
64853733Sbrian        break;
64953733Sbrian    }
65053733Sbrian
65153733Sbrian    dev->timeout = dev->dev.cd.delay;
65253733Sbrian    dev->connected = CARRIER_PENDING;
65396582Sbrian    /* This will be overridden by our session id - if provided by netgraph */
65496582Sbrian    dev->slot = GetIfIndex(path);
65552942Sbrian  } else {
65652942Sbrian    /* See if we're a netgraph socket */
65771006Sbrian    struct stat st;
65852942Sbrian
65971006Sbrian    if (fstat(p->fd, &st) != -1 && (st.st_mode & S_IFSOCK)) {
66071006Sbrian      struct sockaddr_storage ssock;
66171006Sbrian      struct sockaddr *sock = (struct sockaddr *)&ssock;
66271006Sbrian      int sz;
66352942Sbrian
66471006Sbrian      sz = sizeof ssock;
66571006Sbrian      if (getsockname(p->fd, sock, &sz) == -1) {
66671006Sbrian        log_Printf(LogPHASE, "%s: Link is a closed socket !\n", p->link.name);
66771006Sbrian        close(p->fd);
66871006Sbrian        p->fd = -1;
66952942Sbrian        return NULL;
67052942Sbrian      }
67152942Sbrian
67271006Sbrian      if (sock->sa_family == AF_NETGRAPH) {
67371006Sbrian        /*
67471006Sbrian         * It's a netgraph node... We can't determine hook names etc, so we
67571006Sbrian         * stay pretty impartial....
67671006Sbrian         */
67771006Sbrian        log_Printf(LogPHASE, "%s: Link is a netgraph node\n", p->link.name);
67871006Sbrian
67971006Sbrian        if ((dev = malloc(sizeof *dev)) == NULL) {
68071006Sbrian          log_Printf(LogWARN, "%s: Cannot allocate an ether device: %s\n",
68171006Sbrian                     p->link.name, strerror(errno));
68271006Sbrian          return NULL;
68371006Sbrian        }
68471006Sbrian
68571006Sbrian        memcpy(&dev->dev, &baseetherdevice, sizeof dev->dev);
68671006Sbrian        dev->cs = -1;
68771006Sbrian        dev->timeout = 0;
68871006Sbrian        dev->connected = CARRIER_OK;
68971006Sbrian        *dev->hook = '\0';
69096582Sbrian
69196582Sbrian        /*
69296582Sbrian         * If we're being envoked from pppoed(8), we may have a SESSIONID
69396582Sbrian         * set in the environment.  If so, use it as the slot
69496582Sbrian         */
69596582Sbrian        if ((sessionid = getenv("SESSIONID")) != NULL) {
69696582Sbrian          char *end;
69796582Sbrian          u_long slot;
69896582Sbrian
69996582Sbrian          slot = strtoul(sessionid, &end, 16);
70096582Sbrian          dev->slot = end != sessionid && *end == '\0' ? slot : 0;
70196582Sbrian        } else
70296582Sbrian          dev->slot = 0;
70371006Sbrian      }
70452942Sbrian    }
70552942Sbrian  }
70652942Sbrian
70752942Sbrian  if (dev) {
70852942Sbrian    physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF);
70952942Sbrian    return &dev->dev;
71052942Sbrian  }
71152942Sbrian
71252942Sbrian  return NULL;
71352942Sbrian}
714