Blame view
drivers/net/wan/lapbether.c
9.95 KB
1da177e4c Linux-2.6.12-rc2 |
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 |
/* * "LAPB via ethernet" driver release 001 * * This code REQUIRES 2.1.15 or higher/ NET3.038 * * This module: * This module is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License * as published by the Free Software Foundation; either version * 2 of the License, or (at your option) any later version. * * This is a "pseudo" network driver to allow LAPB over Ethernet. * * This driver can use any ethernet destination address, and can be * limited to accept frames from one dedicated ethernet card only. * * History * LAPBETH 001 Jonathan Naylor Cloned from bpqether.c * 2000-10-29 Henner Eisen lapb_data_indication() return status. * 2000-11-14 Henner Eisen dev_hold/put, NETDEV_GOING_DOWN support */ |
23efcb738 wan: Update to cu... |
22 |
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
1da177e4c Linux-2.6.12-rc2 |
23 24 25 26 |
#include <linux/errno.h> #include <linux/types.h> #include <linux/socket.h> #include <linux/in.h> |
5a0e3ad6a include cleanup: ... |
27 |
#include <linux/slab.h> |
1da177e4c Linux-2.6.12-rc2 |
28 29 30 31 32 33 34 35 |
#include <linux/kernel.h> #include <linux/string.h> #include <linux/net.h> #include <linux/inet.h> #include <linux/netdevice.h> #include <linux/if_arp.h> #include <linux/skbuff.h> #include <net/sock.h> |
1da177e4c Linux-2.6.12-rc2 |
36 37 38 39 40 |
#include <asm/uaccess.h> #include <linux/mm.h> #include <linux/interrupt.h> #include <linux/notifier.h> #include <linux/stat.h> |
1da177e4c Linux-2.6.12-rc2 |
41 42 43 44 45 |
#include <linux/module.h> #include <linux/lapb.h> #include <linux/init.h> #include <net/x25device.h> |
dcfc5d787 wan: make read-on... |
46 |
static const u8 bcast_addr[6] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF }; |
1da177e4c Linux-2.6.12-rc2 |
47 48 49 50 51 52 53 54 55 |
/* If this number is made larger, check that the temporary string buffer * in lapbeth_new_device is large enough to store the probe device name.*/ #define MAXLAPBDEV 100 struct lapbethdev { struct list_head node; struct net_device *ethdev; /* link to ethernet device */ struct net_device *axdev; /* lapbeth device (lapb#) */ |
1da177e4c Linux-2.6.12-rc2 |
56 |
}; |
293a38393 lapb: use the sho... |
57 |
static LIST_HEAD(lapbeth_devices); |
1da177e4c Linux-2.6.12-rc2 |
58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 |
/* ------------------------------------------------------------------------ */ /* * Get the LAPB device for the ethernet device */ static struct lapbethdev *lapbeth_get_x25_dev(struct net_device *dev) { struct lapbethdev *lapbeth; list_for_each_entry_rcu(lapbeth, &lapbeth_devices, node) { if (lapbeth->ethdev == dev) return lapbeth; } return NULL; } static __inline__ int dev_is_ethdev(struct net_device *dev) { return dev->type == ARPHRD_ETHER && strncmp(dev->name, "dummy", 5); } /* ------------------------------------------------------------------------ */ /* * Receive a LAPB frame via an ethernet interface. */ |
f2ccd8fa0 [NET]: Kill skb->... |
85 |
static int lapbeth_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *ptype, struct net_device *orig_dev) |
1da177e4c Linux-2.6.12-rc2 |
86 87 88 |
{ int len, err; struct lapbethdev *lapbeth; |
c346dca10 [NET] NETNS: Omit... |
89 |
if (dev_net(dev) != &init_net) |
e730c1551 [NET]: Make packe... |
90 |
goto drop; |
1da177e4c Linux-2.6.12-rc2 |
91 92 93 94 95 96 97 98 99 100 101 102 |
if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL) return NET_RX_DROP; if (!pskb_may_pull(skb, 2)) goto drop; rcu_read_lock(); lapbeth = lapbeth_get_x25_dev(dev); if (!lapbeth) goto drop_unlock; if (!netif_running(lapbeth->axdev)) goto drop_unlock; |
1da177e4c Linux-2.6.12-rc2 |
103 |
len = skb->data[0] + skb->data[1] * 256; |
ea2ebaf82 lapbether: conver... |
104 105 |
dev->stats.rx_packets++; dev->stats.rx_bytes += len; |
1da177e4c Linux-2.6.12-rc2 |
106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 |
skb_pull(skb, 2); /* Remove the length bytes */ skb_trim(skb, len); /* Set the length of the data */ if ((err = lapb_data_received(lapbeth->axdev, skb)) != LAPB_OK) { printk(KERN_DEBUG "lapbether: lapb_data_received err - %d ", err); goto drop_unlock; } out: rcu_read_unlock(); return 0; drop_unlock: kfree_skb(skb); goto out; drop: kfree_skb(skb); return 0; } static int lapbeth_data_indication(struct net_device *dev, struct sk_buff *skb) { unsigned char *ptr; skb_push(skb, 1); if (skb_cow(skb, 1)) return NET_RX_DROP; ptr = skb->data; |
4d99503e0 X25: Use identifi... |
136 |
*ptr = X25_IFACE_DATA; |
1da177e4c Linux-2.6.12-rc2 |
137 138 |
skb->protocol = x25_type_trans(skb, dev); |
1da177e4c Linux-2.6.12-rc2 |
139 140 141 142 143 144 |
return netif_rx(skb); } /* * Send a LAPB frame via an ethernet interface */ |
d71a67492 wan: convert driv... |
145 146 |
static netdev_tx_t lapbeth_xmit(struct sk_buff *skb, struct net_device *dev) |
1da177e4c Linux-2.6.12-rc2 |
147 |
{ |
d77eeb702 net: fix network ... |
148 |
int err; |
1da177e4c Linux-2.6.12-rc2 |
149 150 151 152 153 |
/* * Just to be *really* sure not to send anything if the interface * is down, the ethernet device may have gone. */ |
d77eeb702 net: fix network ... |
154 |
if (!netif_running(dev)) |
1da177e4c Linux-2.6.12-rc2 |
155 |
goto drop; |
1da177e4c Linux-2.6.12-rc2 |
156 157 |
switch (skb->data[0]) { |
4d99503e0 X25: Use identifi... |
158 |
case X25_IFACE_DATA: |
1da177e4c Linux-2.6.12-rc2 |
159 |
break; |
4d99503e0 X25: Use identifi... |
160 |
case X25_IFACE_CONNECT: |
1da177e4c Linux-2.6.12-rc2 |
161 |
if ((err = lapb_connect_request(dev)) != LAPB_OK) |
23efcb738 wan: Update to cu... |
162 163 |
pr_err("lapb_connect_request error: %d ", err); |
d77eeb702 net: fix network ... |
164 |
goto drop; |
4d99503e0 X25: Use identifi... |
165 |
case X25_IFACE_DISCONNECT: |
1da177e4c Linux-2.6.12-rc2 |
166 |
if ((err = lapb_disconnect_request(dev)) != LAPB_OK) |
23efcb738 wan: Update to cu... |
167 168 |
pr_err("lapb_disconnect_request err: %d ", err); |
1da177e4c Linux-2.6.12-rc2 |
169 170 |
/* Fall thru */ default: |
d77eeb702 net: fix network ... |
171 |
goto drop; |
1da177e4c Linux-2.6.12-rc2 |
172 173 174 175 176 |
} skb_pull(skb, 1); if ((err = lapb_data_request(dev, skb)) != LAPB_OK) { |
23efcb738 wan: Update to cu... |
177 178 |
pr_err("lapb_data_request error - %d ", err); |
1da177e4c Linux-2.6.12-rc2 |
179 180 |
goto drop; } |
1da177e4c Linux-2.6.12-rc2 |
181 |
out: |
d77eeb702 net: fix network ... |
182 |
return NETDEV_TX_OK; |
1da177e4c Linux-2.6.12-rc2 |
183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 |
drop: kfree_skb(skb); goto out; } static void lapbeth_data_transmit(struct net_device *ndev, struct sk_buff *skb) { struct lapbethdev *lapbeth = netdev_priv(ndev); unsigned char *ptr; struct net_device *dev; int size = skb->len; skb->protocol = htons(ETH_P_X25); ptr = skb_push(skb, 2); *ptr++ = size % 256; *ptr++ = size / 256; |
ea2ebaf82 lapbether: conver... |
201 202 |
ndev->stats.tx_packets++; ndev->stats.tx_bytes += size; |
1da177e4c Linux-2.6.12-rc2 |
203 204 |
skb->dev = dev = lapbeth->ethdev; |
0c4e85813 [NET]: Wrap netde... |
205 |
dev_hard_header(skb, dev, ETH_P_DEC, bcast_addr, NULL, 0); |
1da177e4c Linux-2.6.12-rc2 |
206 207 208 209 210 211 212 213 214 215 |
dev_queue_xmit(skb); } static void lapbeth_connected(struct net_device *dev, int reason) { unsigned char *ptr; struct sk_buff *skb = dev_alloc_skb(1); if (!skb) { |
23efcb738 wan: Update to cu... |
216 217 |
pr_err("out of memory "); |
1da177e4c Linux-2.6.12-rc2 |
218 219 220 221 |
return; } ptr = skb_put(skb, 1); |
4d99503e0 X25: Use identifi... |
222 |
*ptr = X25_IFACE_CONNECT; |
1da177e4c Linux-2.6.12-rc2 |
223 224 |
skb->protocol = x25_type_trans(skb, dev); |
1da177e4c Linux-2.6.12-rc2 |
225 226 227 228 229 230 231 232 233 |
netif_rx(skb); } static void lapbeth_disconnected(struct net_device *dev, int reason) { unsigned char *ptr; struct sk_buff *skb = dev_alloc_skb(1); if (!skb) { |
23efcb738 wan: Update to cu... |
234 235 |
pr_err("out of memory "); |
1da177e4c Linux-2.6.12-rc2 |
236 237 238 239 |
return; } ptr = skb_put(skb, 1); |
4d99503e0 X25: Use identifi... |
240 |
*ptr = X25_IFACE_DISCONNECT; |
1da177e4c Linux-2.6.12-rc2 |
241 242 |
skb->protocol = x25_type_trans(skb, dev); |
1da177e4c Linux-2.6.12-rc2 |
243 244 245 246 |
netif_rx(skb); } /* |
1da177e4c Linux-2.6.12-rc2 |
247 248 249 250 251 252 253 254 |
* Set AX.25 callsign */ static int lapbeth_set_mac_address(struct net_device *dev, void *addr) { struct sockaddr *sa = addr; memcpy(dev->dev_addr, sa->sa_data, dev->addr_len); return 0; } |
d97a077a1 wan: make LAPB ca... |
255 |
static const struct lapb_register_struct lapbeth_callbacks = { |
1da177e4c Linux-2.6.12-rc2 |
256 257 258 259 260 261 |
.connect_confirmation = lapbeth_connected, .connect_indication = lapbeth_connected, .disconnect_confirmation = lapbeth_disconnected, .disconnect_indication = lapbeth_disconnected, .data_indication = lapbeth_data_indication, .data_transmit = lapbeth_data_transmit, |
1da177e4c Linux-2.6.12-rc2 |
262 263 264 265 266 267 268 269 270 271 |
}; /* * open/close a device */ static int lapbeth_open(struct net_device *dev) { int err; if ((err = lapb_register(dev, &lapbeth_callbacks)) != LAPB_OK) { |
23efcb738 wan: Update to cu... |
272 273 |
pr_err("lapb_register error: %d ", err); |
1da177e4c Linux-2.6.12-rc2 |
274 275 276 277 278 279 280 281 282 283 284 285 286 287 |
return -ENODEV; } netif_start_queue(dev); return 0; } static int lapbeth_close(struct net_device *dev) { int err; netif_stop_queue(dev); if ((err = lapb_unregister(dev)) != LAPB_OK) |
23efcb738 wan: Update to cu... |
288 289 |
pr_err("lapb_unregister error: %d ", err); |
1da177e4c Linux-2.6.12-rc2 |
290 291 292 293 294 |
return 0; } /* ------------------------------------------------------------------------ */ |
39549b1e8 labether: convert... |
295 296 297 298 299 300 |
static const struct net_device_ops lapbeth_netdev_ops = { .ndo_open = lapbeth_open, .ndo_stop = lapbeth_close, .ndo_start_xmit = lapbeth_xmit, .ndo_set_mac_address = lapbeth_set_mac_address, }; |
1da177e4c Linux-2.6.12-rc2 |
301 302 |
static void lapbeth_setup(struct net_device *dev) { |
39549b1e8 labether: convert... |
303 |
dev->netdev_ops = &lapbeth_netdev_ops; |
1da177e4c Linux-2.6.12-rc2 |
304 |
dev->destructor = free_netdev; |
1da177e4c Linux-2.6.12-rc2 |
305 306 307 308 |
dev->type = ARPHRD_X25; dev->hard_header_len = 3; dev->mtu = 1000; dev->addr_len = 0; |
1da177e4c Linux-2.6.12-rc2 |
309 310 311 312 313 314 315 316 317 318 319 320 |
} /* * Setup a new device. */ static int lapbeth_new_device(struct net_device *dev) { struct net_device *ndev; struct lapbethdev *lapbeth; int rc = -ENOMEM; ASSERT_RTNL(); |
c835a6773 net: set name_ass... |
321 322 |
ndev = alloc_netdev(sizeof(*lapbeth), "lapb%d", NET_NAME_UNKNOWN, lapbeth_setup); |
1da177e4c Linux-2.6.12-rc2 |
323 324 325 326 327 328 329 330 |
if (!ndev) goto out; lapbeth = netdev_priv(ndev); lapbeth->axdev = ndev; dev_hold(dev); lapbeth->ethdev = dev; |
1da177e4c Linux-2.6.12-rc2 |
331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 |
rc = -EIO; if (register_netdevice(ndev)) goto fail; list_add_rcu(&lapbeth->node, &lapbeth_devices); rc = 0; out: return rc; fail: dev_put(dev); free_netdev(ndev); kfree(lapbeth); goto out; } /* * Free a lapb network device. */ static void lapbeth_free_device(struct lapbethdev *lapbeth) { dev_put(lapbeth->ethdev); list_del_rcu(&lapbeth->node); unregister_netdevice(lapbeth->axdev); } /* * Handle device status changes. * * Called from notifier with RTNL held. */ static int lapbeth_device_event(struct notifier_block *this, unsigned long event, void *ptr) { struct lapbethdev *lapbeth; |
351638e7d net: pass info st... |
365 |
struct net_device *dev = netdev_notifier_info_to_dev(ptr); |
1da177e4c Linux-2.6.12-rc2 |
366 |
|
c346dca10 [NET] NETNS: Omit... |
367 |
if (dev_net(dev) != &init_net) |
e9dc86534 [NET]: Make devic... |
368 |
return NOTIFY_DONE; |
1da177e4c Linux-2.6.12-rc2 |
369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 |
if (!dev_is_ethdev(dev)) return NOTIFY_DONE; switch (event) { case NETDEV_UP: /* New ethernet device -> new LAPB interface */ if (lapbeth_get_x25_dev(dev) == NULL) lapbeth_new_device(dev); break; case NETDEV_DOWN: /* ethernet device closed -> close LAPB interface */ lapbeth = lapbeth_get_x25_dev(dev); if (lapbeth) dev_close(lapbeth->axdev); break; case NETDEV_UNREGISTER: /* ethernet device disappears -> remove LAPB interface */ lapbeth = lapbeth_get_x25_dev(dev); if (lapbeth) lapbeth_free_device(lapbeth); break; } return NOTIFY_DONE; } /* ------------------------------------------------------------------------ */ |
7546dd97d net: convert usag... |
396 |
static struct packet_type lapbeth_packet_type __read_mostly = { |
09640e636 net: replace uses... |
397 |
.type = cpu_to_be16(ETH_P_DEC), |
1da177e4c Linux-2.6.12-rc2 |
398 399 400 401 402 403 |
.func = lapbeth_rcv, }; static struct notifier_block lapbeth_dev_notifier = { .notifier_call = lapbeth_device_event, }; |
81b700b1e lapb: get rid of ... |
404 |
static const char banner[] __initconst = |
5ee0d5933 drivers/net/wan: ... |
405 406 |
KERN_INFO "LAPB Ethernet driver version 0.02 "; |
1da177e4c Linux-2.6.12-rc2 |
407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 |
static int __init lapbeth_init_driver(void) { dev_add_pack(&lapbeth_packet_type); register_netdevice_notifier(&lapbeth_dev_notifier); printk(banner); return 0; } module_init(lapbeth_init_driver); static void __exit lapbeth_cleanup_driver(void) { struct lapbethdev *lapbeth; struct list_head *entry, *tmp; dev_remove_pack(&lapbeth_packet_type); unregister_netdevice_notifier(&lapbeth_dev_notifier); rtnl_lock(); list_for_each_safe(entry, tmp, &lapbeth_devices) { lapbeth = list_entry(entry, struct lapbethdev, node); |
e544ff00d lapbeth: Release ... |
431 |
dev_put(lapbeth->ethdev); |
1da177e4c Linux-2.6.12-rc2 |
432 433 434 435 436 437 438 439 440 |
unregister_netdevice(lapbeth->axdev); } rtnl_unlock(); } module_exit(lapbeth_cleanup_driver); MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>"); MODULE_DESCRIPTION("The unofficial LAPB over Ethernet driver"); MODULE_LICENSE("GPL"); |