Merge rsync://rsync.kernel.org/pub/scm/linux/kernel/git/torvalds/linux-2.6
[linux-2.6] / net / netrom / nr_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 Jonathan Naylor G4KLX (g4klx@g4klx.demon.co.uk)
8  */
9 #include <linux/module.h>
10 #include <linux/proc_fs.h>
11 #include <linux/kernel.h>
12 #include <linux/sched.h>
13 #include <linux/interrupt.h>
14 #include <linux/fs.h>
15 #include <linux/types.h>
16 #include <linux/sysctl.h>
17 #include <linux/string.h>
18 #include <linux/socket.h>
19 #include <linux/errno.h>
20 #include <linux/fcntl.h>
21 #include <linux/in.h>
22 #include <linux/if_ether.h>     /* For the statistics structure. */
23
24 #include <asm/system.h>
25 #include <asm/uaccess.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/netrom.h>
39
40 /*
41  *      Only allow IP over NET/ROM frames through if the netrom device is up.
42  */
43
44 int nr_rx_ip(struct sk_buff *skb, struct net_device *dev)
45 {
46         struct net_device_stats *stats = netdev_priv(dev);
47
48         if (!netif_running(dev)) {
49                 stats->rx_dropped++;
50                 return 0;
51         }
52
53         stats->rx_packets++;
54         stats->rx_bytes += skb->len;
55
56         skb->protocol = htons(ETH_P_IP);
57
58         /* Spoof incoming device */
59         skb->dev      = dev;
60         skb->mac.raw  = skb->nh.raw;
61         skb->nh.raw   = skb->data;
62         skb->pkt_type = PACKET_HOST;
63
64         netif_rx(skb);
65
66         return 1;
67 }
68
69 #ifdef CONFIG_INET
70
71 static int nr_rebuild_header(struct sk_buff *skb)
72 {
73         unsigned char *bp = skb->data;
74
75         if (arp_find(bp + 7, skb))
76                 return 1;
77
78         bp[6] &= ~AX25_CBIT;
79         bp[6] &= ~AX25_EBIT;
80         bp[6] |= AX25_SSSID_SPARE;
81         bp    += AX25_ADDR_LEN;
82
83         bp[6] &= ~AX25_CBIT;
84         bp[6] |= AX25_EBIT;
85         bp[6] |= AX25_SSSID_SPARE;
86
87         return 0;
88 }
89
90 #else
91
92 static int nr_rebuild_header(struct sk_buff *skb)
93 {
94         return 1;
95 }
96
97 #endif
98
99 static int nr_header(struct sk_buff *skb, struct net_device *dev, unsigned short type,
100         void *daddr, void *saddr, unsigned len)
101 {
102         unsigned char *buff = skb_push(skb, NR_NETWORK_LEN + NR_TRANSPORT_LEN);
103
104         memcpy(buff, (saddr != NULL) ? saddr : dev->dev_addr, dev->addr_len);
105         buff[6] &= ~AX25_CBIT;
106         buff[6] &= ~AX25_EBIT;
107         buff[6] |= AX25_SSSID_SPARE;
108         buff    += AX25_ADDR_LEN;
109
110         if (daddr != NULL)
111                 memcpy(buff, daddr, dev->addr_len);
112         buff[6] &= ~AX25_CBIT;
113         buff[6] |= AX25_EBIT;
114         buff[6] |= AX25_SSSID_SPARE;
115         buff    += AX25_ADDR_LEN;
116
117         *buff++ = sysctl_netrom_network_ttl_initialiser;
118
119         *buff++ = NR_PROTO_IP;
120         *buff++ = NR_PROTO_IP;
121         *buff++ = 0;
122         *buff++ = 0;
123         *buff++ = NR_PROTOEXT;
124
125         if (daddr != NULL)
126                 return 37;
127
128         return -37;
129 }
130
131 static int __must_check nr_set_mac_address(struct net_device *dev, void *addr)
132 {
133         struct sockaddr *sa = addr;
134         int err;
135
136         if (!memcmp(dev->dev_addr, sa->sa_data, dev->addr_len))
137                 return 0;
138
139         if (dev->flags & IFF_UP) {
140                 err = ax25_listen_register((ax25_address *)sa->sa_data, NULL);
141                 if (err)
142                         return err;
143
144                 ax25_listen_release((ax25_address *)dev->dev_addr, NULL);
145         }
146
147         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
148
149         return 0;
150 }
151
152 static int nr_open(struct net_device *dev)
153 {
154         int err;
155
156         err = ax25_listen_register((ax25_address *)dev->dev_addr, NULL);
157         if (err)
158                 return err;
159
160         netif_start_queue(dev);
161
162         return 0;
163 }
164
165 static int nr_close(struct net_device *dev)
166 {
167         ax25_listen_release((ax25_address *)dev->dev_addr, NULL);
168         netif_stop_queue(dev);
169         return 0;
170 }
171
172 static int nr_xmit(struct sk_buff *skb, struct net_device *dev)
173 {
174         struct nr_private *nr = netdev_priv(dev);
175         struct net_device_stats *stats = &nr->stats;
176         unsigned int len = skb->len;
177
178         if (!nr_route_frame(skb, NULL)) {
179                 kfree_skb(skb);
180                 stats->tx_errors++;
181                 return 0;
182         }
183
184         stats->tx_packets++;
185         stats->tx_bytes += len;
186
187         return 0;
188 }
189
190 static struct net_device_stats *nr_get_stats(struct net_device *dev)
191 {
192         struct nr_private *nr = netdev_priv(dev);
193
194         return &nr->stats;
195 }
196
197 void nr_setup(struct net_device *dev)
198 {
199         dev->mtu                = NR_MAX_PACKET_SIZE;
200         dev->hard_start_xmit    = nr_xmit;
201         dev->open               = nr_open;
202         dev->stop               = nr_close;
203
204         dev->hard_header        = nr_header;
205         dev->hard_header_len    = NR_NETWORK_LEN + NR_TRANSPORT_LEN;
206         dev->addr_len           = AX25_ADDR_LEN;
207         dev->type               = ARPHRD_NETROM;
208         dev->rebuild_header     = nr_rebuild_header;
209         dev->set_mac_address    = nr_set_mac_address;
210
211         /* New-style flags. */
212         dev->flags              = IFF_NOARP;
213
214         dev->get_stats          = nr_get_stats;
215 }