Merge master.kernel.org:/home/rmk/linux-2.6-serial
[linux-2.6] / net / rose / rose_dev.c
1 /*
2  * This program is free software; you can redistribute it and/or modify
3  * it under the terms of the GNU General Public License as published by
4  * the Free Software Foundation; either version 2 of the License, or
5  * (at your option) any later version.
6  *
7  * Copyright (C) Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
8  */
9 #include <linux/config.h>
10 #include <linux/module.h>
11 #include <linux/proc_fs.h>
12 #include <linux/kernel.h>
13 #include <linux/sched.h>
14 #include <linux/interrupt.h>
15 #include <linux/fs.h>
16 #include <linux/types.h>
17 #include <linux/sysctl.h>
18 #include <linux/string.h>
19 #include <linux/socket.h>
20 #include <linux/errno.h>
21 #include <linux/fcntl.h>
22 #include <linux/in.h>
23 #include <linux/if_ether.h>
24
25 #include <asm/system.h>
26 #include <asm/io.h>
27
28 #include <linux/inet.h>
29 #include <linux/netdevice.h>
30 #include <linux/etherdevice.h>
31 #include <linux/if_arp.h>
32 #include <linux/skbuff.h>
33
34 #include <net/ip.h>
35 #include <net/arp.h>
36
37 #include <net/ax25.h>
38 #include <net/rose.h>
39
40 static int rose_header(struct sk_buff *skb, struct net_device *dev, unsigned short type,
41         void *daddr, void *saddr, unsigned len)
42 {
43         unsigned char *buff = skb_push(skb, ROSE_MIN_LEN + 2);
44
45         *buff++ = ROSE_GFI | ROSE_Q_BIT;
46         *buff++ = 0x00;
47         *buff++ = ROSE_DATA;
48         *buff++ = 0x7F;
49         *buff++ = AX25_P_IP;
50
51         if (daddr != NULL)
52                 return 37;
53
54         return -37;
55 }
56
57 static int rose_rebuild_header(struct sk_buff *skb)
58 {
59         struct net_device *dev = skb->dev;
60         struct net_device_stats *stats = netdev_priv(dev);
61         unsigned char *bp = (unsigned char *)skb->data;
62         struct sk_buff *skbn;
63
64 #ifdef CONFIG_INET
65         if (arp_find(bp + 7, skb)) {
66                 return 1;
67         }
68
69         if ((skbn = skb_clone(skb, GFP_ATOMIC)) == NULL) {
70                 kfree_skb(skb);
71                 return 1;
72         }
73
74         if (skb->sk != NULL)
75                 skb_set_owner_w(skbn, skb->sk);
76
77         kfree_skb(skb);
78
79         if (!rose_route_frame(skbn, NULL)) {
80                 kfree_skb(skbn);
81                 stats->tx_errors++;
82                 return 1;
83         }
84
85         stats->tx_packets++;
86         stats->tx_bytes += skbn->len;
87 #endif
88         return 1;
89 }
90
91 static int rose_set_mac_address(struct net_device *dev, void *addr)
92 {
93         struct sockaddr *sa = addr;
94
95         rose_del_loopback_node((rose_address *)dev->dev_addr);
96
97         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
98
99         rose_add_loopback_node((rose_address *)dev->dev_addr);
100
101         return 0;
102 }
103
104 static int rose_open(struct net_device *dev)
105 {
106         netif_start_queue(dev);
107         rose_add_loopback_node((rose_address *)dev->dev_addr);
108         return 0;
109 }
110
111 static int rose_close(struct net_device *dev)
112 {
113         netif_stop_queue(dev);
114         rose_del_loopback_node((rose_address *)dev->dev_addr);
115         return 0;
116 }
117
118 static int rose_xmit(struct sk_buff *skb, struct net_device *dev)
119 {
120         struct net_device_stats *stats = netdev_priv(dev);
121
122         if (!netif_running(dev)) {
123                 printk(KERN_ERR "ROSE: rose_xmit - called when iface is down\n");
124                 return 1;
125         }
126         dev_kfree_skb(skb);
127         stats->tx_errors++;
128         return 0;
129 }
130
131 static struct net_device_stats *rose_get_stats(struct net_device *dev)
132 {
133         return netdev_priv(dev);
134 }
135
136 void rose_setup(struct net_device *dev)
137 {
138         SET_MODULE_OWNER(dev);
139         dev->mtu                = ROSE_MAX_PACKET_SIZE - 2;
140         dev->hard_start_xmit    = rose_xmit;
141         dev->open               = rose_open;
142         dev->stop               = rose_close;
143
144         dev->hard_header        = rose_header;
145         dev->hard_header_len    = AX25_BPQ_HEADER_LEN + AX25_MAX_HEADER_LEN + ROSE_MIN_LEN;
146         dev->addr_len           = ROSE_ADDR_LEN;
147         dev->type               = ARPHRD_ROSE;
148         dev->rebuild_header     = rose_rebuild_header;
149         dev->set_mac_address    = rose_set_mac_address;
150
151         /* New-style flags. */
152         dev->flags              = IFF_NOARP;
153         dev->get_stats = rose_get_stats;
154 }