1 /*- 2 * Copyright (c) 2000 Jakob Stoklund Olesen <stoklund (at) 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: src/usr.sbin/ppp/atm.c,v 1.10.26.1 2010/12/21 17:10:29 kensmith Exp $ 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 65 struct 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 71 unsigned 72 atm_DeviceSize(void) 73 { 74 return sizeof(struct atmdevice); 75 } 76 77 static ssize_t 78 atm_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 88 static ssize_t 89 atm_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 99 static void 100 atm_Free(struct physical *p) 101 { 102 struct atmdevice *dev = device2atm(p->handler); 103 104 free(dev); 105 } 106 107 static void 108 atm_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 122 static 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 143 struct device * 144 atm_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 167 static struct atmdevice * 168 atm_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 207 struct device * 208 atm_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
