2 * "LAPB via ethernet" driver release 001
4 * This code REQUIRES 2.1.15 or higher/ NET3.038
7 * This module is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * as published by the Free Software Foundation; either version
10 * 2 of the License, or (at your option) any later version.
12 * This is a "pseudo" network driver to allow LAPB over Ethernet.
14 * This driver can use any ethernet destination address, and can be
15 * limited to accept frames from one dedicated ethernet card only.
18 * LAPBETH 001 Jonathan Naylor Cloned from bpqether.c
19 * 2000-10-29 Henner Eisen lapb_data_indication() return status.
20 * 2000-11-14 Henner Eisen dev_hold/put, NETDEV_GOING_DOWN support
23 #include <linux/errno.h>
24 #include <linux/types.h>
25 #include <linux/socket.h>
27 #include <linux/kernel.h>
28 #include <linux/string.h>
29 #include <linux/net.h>
30 #include <linux/inet.h>
31 #include <linux/netdevice.h>
32 #include <linux/if_arp.h>
33 #include <linux/skbuff.h>
35 #include <asm/system.h>
36 #include <asm/uaccess.h>
38 #include <linux/interrupt.h>
39 #include <linux/notifier.h>
40 #include <linux/stat.h>
41 #include <linux/netfilter.h>
42 #include <linux/module.h>
43 #include <linux/lapb.h>
44 #include <linux/init.h>
46 static char bcast_addr[6] = { 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF };
48 /* If this number is made larger, check that the temporary string buffer
49 * in lapbeth_new_device is large enough to store the probe device name.*/
50 #define MAXLAPBDEV 100
53 struct list_head node;
54 struct net_device *ethdev; /* link to ethernet device */
55 struct net_device *axdev; /* lapbeth device (lapb#) */
56 struct net_device_stats stats; /* some statistics */
59 static struct list_head lapbeth_devices = LIST_HEAD_INIT(lapbeth_devices);
61 /* ------------------------------------------------------------------------ */
64 * Get the LAPB device for the ethernet device
66 static struct lapbethdev *lapbeth_get_x25_dev(struct net_device *dev)
68 struct lapbethdev *lapbeth;
70 list_for_each_entry_rcu(lapbeth, &lapbeth_devices, node) {
71 if (lapbeth->ethdev == dev)
77 static __inline__ int dev_is_ethdev(struct net_device *dev)
79 return dev->type == ARPHRD_ETHER && strncmp(dev->name, "dummy", 5);
82 /* ------------------------------------------------------------------------ */
85 * Receive a LAPB frame via an ethernet interface.
87 static int lapbeth_rcv(struct sk_buff *skb, struct net_device *dev, struct packet_type *ptype)
90 struct lapbethdev *lapbeth;
92 if ((skb = skb_share_check(skb, GFP_ATOMIC)) == NULL)
95 if (!pskb_may_pull(skb, 2))
99 lapbeth = lapbeth_get_x25_dev(dev);
102 if (!netif_running(lapbeth->axdev))
105 lapbeth->stats.rx_packets++;
107 len = skb->data[0] + skb->data[1] * 256;
108 lapbeth->stats.rx_bytes += len;
110 skb_pull(skb, 2); /* Remove the length bytes */
111 skb_trim(skb, len); /* Set the length of the data */
113 if ((err = lapb_data_received(lapbeth->axdev, skb)) != LAPB_OK) {
114 printk(KERN_DEBUG "lapbether: lapb_data_received err - %d\n", err);
128 static int lapbeth_data_indication(struct net_device *dev, struct sk_buff *skb)
141 skb->protocol = htons(ETH_P_X25);
142 skb->mac.raw = skb->data;
143 skb->pkt_type = PACKET_HOST;
145 skb->dev->last_rx = jiffies;
146 return netif_rx(skb);
150 * Send a LAPB frame via an ethernet interface
152 static int lapbeth_xmit(struct sk_buff *skb, struct net_device *dev)
157 * Just to be *really* sure not to send anything if the interface
158 * is down, the ethernet device may have gone.
160 if (!netif_running(dev)) {
164 switch (skb->data[0]) {
169 if ((err = lapb_connect_request(dev)) != LAPB_OK)
170 printk(KERN_ERR "lapbeth: lapb_connect_request "
174 if ((err = lapb_disconnect_request(dev)) != LAPB_OK)
175 printk(KERN_ERR "lapbeth: lapb_disconnect_request "
184 if ((err = lapb_data_request(dev, skb)) != LAPB_OK) {
185 printk(KERN_ERR "lapbeth: lapb_data_request error - %d\n", err);
199 static void lapbeth_data_transmit(struct net_device *ndev, struct sk_buff *skb)
201 struct lapbethdev *lapbeth = netdev_priv(ndev);
203 struct net_device *dev;
206 skb->protocol = htons(ETH_P_X25);
208 ptr = skb_push(skb, 2);
213 lapbeth->stats.tx_packets++;
214 lapbeth->stats.tx_bytes += size;
216 skb->dev = dev = lapbeth->ethdev;
218 dev->hard_header(skb, dev, ETH_P_DEC, bcast_addr, NULL, 0);
223 static void lapbeth_connected(struct net_device *dev, int reason)
226 struct sk_buff *skb = dev_alloc_skb(1);
229 printk(KERN_ERR "lapbeth: out of memory\n");
233 ptr = skb_put(skb, 1);
237 skb->protocol = htons(ETH_P_X25);
238 skb->mac.raw = skb->data;
239 skb->pkt_type = PACKET_HOST;
241 skb->dev->last_rx = jiffies;
245 static void lapbeth_disconnected(struct net_device *dev, int reason)
248 struct sk_buff *skb = dev_alloc_skb(1);
251 printk(KERN_ERR "lapbeth: out of memory\n");
255 ptr = skb_put(skb, 1);
259 skb->protocol = htons(ETH_P_X25);
260 skb->mac.raw = skb->data;
261 skb->pkt_type = PACKET_HOST;
263 skb->dev->last_rx = jiffies;
270 static struct net_device_stats *lapbeth_get_stats(struct net_device *dev)
272 struct lapbethdev *lapbeth = netdev_priv(dev);
273 return &lapbeth->stats;
279 static int lapbeth_set_mac_address(struct net_device *dev, void *addr)
281 struct sockaddr *sa = addr;
282 memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
287 static struct lapb_register_struct lapbeth_callbacks = {
288 .connect_confirmation = lapbeth_connected,
289 .connect_indication = lapbeth_connected,
290 .disconnect_confirmation = lapbeth_disconnected,
291 .disconnect_indication = lapbeth_disconnected,
292 .data_indication = lapbeth_data_indication,
293 .data_transmit = lapbeth_data_transmit,
298 * open/close a device
300 static int lapbeth_open(struct net_device *dev)
304 if ((err = lapb_register(dev, &lapbeth_callbacks)) != LAPB_OK) {
305 printk(KERN_ERR "lapbeth: lapb_register error - %d\n", err);
309 netif_start_queue(dev);
313 static int lapbeth_close(struct net_device *dev)
317 netif_stop_queue(dev);
319 if ((err = lapb_unregister(dev)) != LAPB_OK)
320 printk(KERN_ERR "lapbeth: lapb_unregister error - %d\n", err);
325 /* ------------------------------------------------------------------------ */
327 static void lapbeth_setup(struct net_device *dev)
329 dev->hard_start_xmit = lapbeth_xmit;
330 dev->open = lapbeth_open;
331 dev->stop = lapbeth_close;
332 dev->destructor = free_netdev;
333 dev->set_mac_address = lapbeth_set_mac_address;
334 dev->get_stats = lapbeth_get_stats;
335 dev->type = ARPHRD_X25;
336 dev->hard_header_len = 3;
339 SET_MODULE_OWNER(dev);
343 * Setup a new device.
345 static int lapbeth_new_device(struct net_device *dev)
347 struct net_device *ndev;
348 struct lapbethdev *lapbeth;
353 ndev = alloc_netdev(sizeof(*lapbeth), "lapb%d",
358 lapbeth = netdev_priv(ndev);
359 lapbeth->axdev = ndev;
362 lapbeth->ethdev = dev;
364 rc = dev_alloc_name(ndev, ndev->name);
369 if (register_netdevice(ndev))
372 list_add_rcu(&lapbeth->node, &lapbeth_devices);
384 * Free a lapb network device.
386 static void lapbeth_free_device(struct lapbethdev *lapbeth)
388 dev_put(lapbeth->ethdev);
389 list_del_rcu(&lapbeth->node);
390 unregister_netdevice(lapbeth->axdev);
394 * Handle device status changes.
396 * Called from notifier with RTNL held.
398 static int lapbeth_device_event(struct notifier_block *this,
399 unsigned long event, void *ptr)
401 struct lapbethdev *lapbeth;
402 struct net_device *dev = ptr;
404 if (!dev_is_ethdev(dev))
409 /* New ethernet device -> new LAPB interface */
410 if (lapbeth_get_x25_dev(dev) == NULL)
411 lapbeth_new_device(dev);
414 /* ethernet device closed -> close LAPB interface */
415 lapbeth = lapbeth_get_x25_dev(dev);
417 dev_close(lapbeth->axdev);
419 case NETDEV_UNREGISTER:
420 /* ethernet device disappears -> remove LAPB interface */
421 lapbeth = lapbeth_get_x25_dev(dev);
423 lapbeth_free_device(lapbeth);
430 /* ------------------------------------------------------------------------ */
432 static struct packet_type lapbeth_packet_type = {
433 .type = __constant_htons(ETH_P_DEC),
437 static struct notifier_block lapbeth_dev_notifier = {
438 .notifier_call = lapbeth_device_event,
441 static char banner[] __initdata = KERN_INFO "LAPB Ethernet driver version 0.02\n";
443 static int __init lapbeth_init_driver(void)
445 dev_add_pack(&lapbeth_packet_type);
447 register_netdevice_notifier(&lapbeth_dev_notifier);
453 module_init(lapbeth_init_driver);
455 static void __exit lapbeth_cleanup_driver(void)
457 struct lapbethdev *lapbeth;
458 struct list_head *entry, *tmp;
460 dev_remove_pack(&lapbeth_packet_type);
461 unregister_netdevice_notifier(&lapbeth_dev_notifier);
464 list_for_each_safe(entry, tmp, &lapbeth_devices) {
465 lapbeth = list_entry(entry, struct lapbethdev, node);
467 unregister_netdevice(lapbeth->axdev);
471 module_exit(lapbeth_cleanup_driver);
473 MODULE_AUTHOR("Jonathan Naylor <g4klx@g4klx.demon.co.uk>");
474 MODULE_DESCRIPTION("The unofficial LAPB over Ethernet driver");
475 MODULE_LICENSE("GPL");