1/*- 2 * Copyright (c) 2000 Jakob Stoklund Olesen <stoklund@taxidriver.dk> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 * 26 * $FreeBSD$ 27 */ 28 29#include <sys/types.h> 30#include <sys/socket.h> 31#include <net/if.h> 32#include <netnatm/natm.h> 33 34#include <errno.h> 35#include <stdio.h> 36#include <stdlib.h> 37#include <string.h> 38#include <sysexits.h> 39#include <sys/uio.h> 40#include <termios.h> 41#include <unistd.h> 42 43#include "layer.h" 44#include "defs.h" 45#include "mbuf.h" 46#include "log.h" 47#include "timer.h" 48#include "lqr.h" 49#include "hdlc.h" 50#include "throughput.h" 51#include "fsm.h" 52#include "lcp.h" 53#include "ccp.h" 54#include "link.h" 55#include "async.h" 56#include "descriptor.h" 57#include "physical.h" 58#include "main.h" 59#include "atm.h" 60 61/* String identifying PPPoA */ 62#define PPPOA "PPPoA" 63#define PPPOA_LEN (sizeof(PPPOA) - 1) 64 65struct atmdevice { 66 struct device dev; /* What struct physical knows about */ 67}; 68 69#define device2atm(d) ((d)->type == ATM_DEVICE ? (struct atmdevice *)d : NULL) 70 71unsigned 72atm_DeviceSize(void) 73{ 74 return sizeof(struct atmdevice); 75} 76 77static ssize_t 78atm_Sendto(struct physical *p, const void *v, size_t n) 79{ 80 ssize_t ret = write(p->fd, v, n); 81 if (ret < 0) { 82 log_Printf(LogDEBUG, "atm_Sendto(%ld): %s\n", (long)n, strerror(errno)); 83 return ret; 84 } 85 return ret; 86} 87 88static ssize_t 89atm_Recvfrom(struct physical *p, void *v, size_t n) 90{ 91 ssize_t ret = read(p->fd, (char*)v, n); 92 if (ret < 0) { 93 log_Printf(LogDEBUG, "atm_Recvfrom(%ld): %s\n", (long)n, strerror(errno)); 94 return ret; 95 } 96 return ret; 97} 98 99static void 100atm_Free(struct physical *p) 101{ 102 struct atmdevice *dev = device2atm(p->handler); 103 104 free(dev); 105} 106 107static void 108atm_device2iov(struct device *d, struct iovec *iov, int *niov, 109 int maxiov __unused, int *auxfd __unused, int *nauxfd __unused) 110{ 111 int sz = physical_MaxDeviceSize(); 112 113 iov[*niov].iov_base = realloc(d, sz); 114 if (iov[*niov].iov_base == NULL) { 115 log_Printf(LogALERT, "Failed to allocate memory: %d\n", sz); 116 AbortProgram(EX_OSERR); 117 } 118 iov[*niov].iov_len = sz; 119 (*niov)++; 120} 121 122static const struct device baseatmdevice = { 123 ATM_DEVICE, 124 "atm", 125 0, 126 { CD_NOTREQUIRED, 0 }, 127 NULL, 128 NULL, 129 NULL, 130 NULL, 131 NULL, 132 NULL, 133 NULL, 134 atm_Free, 135 atm_Recvfrom, 136 atm_Sendto, 137 atm_device2iov, 138 NULL, 139 NULL, 140 NULL 141}; 142 143struct device * 144atm_iov2device(int type, struct physical *p, struct iovec *iov, int *niov, 145 int maxiov __unused, int *auxfd __unused, int *nauxfd __unused) 146{ 147 if (type == ATM_DEVICE) { 148 struct atmdevice *dev = (struct atmdevice *)iov[(*niov)++].iov_base; 149 150 dev = realloc(dev, sizeof *dev); /* Reduce to the correct size */ 151 if (dev == NULL) { 152 log_Printf(LogALERT, "Failed to allocate memory: %d\n", 153 (int)(sizeof *dev)); 154 AbortProgram(EX_OSERR); 155 } 156 157 /* Refresh function pointers etc */ 158 memcpy(&dev->dev, &baseatmdevice, sizeof dev->dev); 159 160 physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF); 161 return &dev->dev; 162 } 163 164 return NULL; 165} 166 167static struct atmdevice * 168atm_CreateDevice(struct physical *p, const char *iface, unsigned vpi, 169 unsigned vci) 170{ 171 struct atmdevice *dev; 172 struct sockaddr_natm sock; 173 174 if ((dev = calloc(1, sizeof *dev)) == NULL) { 175 log_Printf(LogWARN, "%s: Cannot allocate an atm device: %s\n", 176 p->link.name, strerror(errno)); 177 return NULL; 178 } 179 180 sock.snatm_len = sizeof sock; 181 sock.snatm_family = AF_NATM; 182 strncpy(sock.snatm_if, iface, IFNAMSIZ); 183 sock.snatm_vpi = vpi; 184 sock.snatm_vci = vci; 185 186 log_Printf(LogPHASE, "%s: Connecting to %s:%u.%u\n", p->link.name, 187 iface, vpi, vci); 188 189 p->fd = socket(PF_NATM, SOCK_DGRAM, PROTO_NATMAAL5); 190 if (p->fd >= 0) { 191 log_Printf(LogDEBUG, "%s: Opened atm socket %s\n", p->link.name, 192 p->name.full); 193 if (connect(p->fd, (struct sockaddr *)&sock, sizeof sock) == 0) 194 return dev; 195 else 196 log_Printf(LogWARN, "%s: connect: %s\n", p->name.full, strerror(errno)); 197 } else 198 log_Printf(LogWARN, "%s: socket: %s\n", p->name.full, strerror(errno)); 199 200 close(p->fd); 201 p->fd = -1; 202 free(dev); 203 204 return NULL; 205} 206 207struct device * 208atm_Create(struct physical *p) 209{ 210 struct atmdevice *dev; 211 212 dev = NULL; 213 if (p->fd < 0 && !strncasecmp(p->name.full, PPPOA, PPPOA_LEN) 214 && p->name.full[PPPOA_LEN] == ':') { 215 char iface[25]; 216 unsigned vci, vpi; 217 218 if (sscanf(p->name.full + PPPOA_LEN + 1, "%25[A-Za-z0-9]:%u.%u", iface, 219 &vpi, &vci) != 3) { 220 log_Printf(LogWARN, "Malformed ATM device name \'%s\', " 221 "PPPoA:if:vpi.vci expected\n", p->name.full); 222 return NULL; 223 } 224 225 dev = atm_CreateDevice(p, iface, vpi, vci); 226 } 227 228 if (dev) { 229 memcpy(&dev->dev, &baseatmdevice, sizeof dev->dev); 230 physical_SetupStack(p, dev->dev.name, PHYSICAL_FORCE_SYNCNOACF); 231 if (p->cfg.cd.necessity != CD_DEFAULT) 232 log_Printf(LogWARN, "Carrier settings ignored\n"); 233 return &dev->dev; 234 } 235 236 return NULL; 237} 238