Merge branch 'upstream' of git://lost.foo-projects.org/~ahkok/git/netdev-2.6 into...
[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 nr_set_mac_address(struct net_device *dev, void *addr)
132 {
133         struct sockaddr *sa = addr;
134
135         if (dev->flags & IFF_UP)
136                 ax25_listen_release((ax25_address *)dev->dev_addr, NULL);
137
138         memcpy(dev->dev_addr, sa->sa_data, dev->addr_len);
139
140         if (dev->flags & IFF_UP)
141                 ax25_listen_register((ax25_address *)dev->dev_addr, NULL);
142
143         return 0;
144 }
145
146 static int nr_open(struct net_device *dev)
147 {
148         netif_start_queue(dev);
149         ax25_listen_register((ax25_address *)dev->dev_addr, NULL);
150         return 0;
151 }
152
153 static int nr_close(struct net_device *dev)
154 {
155         ax25_listen_release((ax25_address *)dev->dev_addr, NULL);
156         netif_stop_queue(dev);
157         return 0;
158 }
159
160 static int nr_xmit(struct sk_buff *skb, struct net_device *dev)
161 {
162         struct nr_private *nr = netdev_priv(dev);
163         struct net_device_stats *stats = &nr->stats;
164         unsigned int len = skb->len;
165
166         if (!nr_route_frame(skb, NULL)) {
167                 kfree_skb(skb);
168                 stats->tx_errors++;
169                 return 0;
170         }
171
172         stats->tx_packets++;
173         stats->tx_bytes += len;
174
175         return 0;
176 }
177
178 static struct net_device_stats *nr_get_stats(struct net_device *dev)
179 {
180         struct nr_private *nr = netdev_priv(dev);
181
182         return &nr->stats;
183 }
184
185 void nr_setup(struct net_device *dev)
186 {
187         dev->mtu                = NR_MAX_PACKET_SIZE;
188         dev->hard_start_xmit    = nr_xmit;
189         dev->open               = nr_open;
190         dev->stop               = nr_close;
191
192         dev->hard_header        = nr_header;
193         dev->hard_header_len    = NR_NETWORK_LEN + NR_TRANSPORT_LEN;
194         dev->addr_len           = AX25_ADDR_LEN;
195         dev->type               = ARPHRD_NETROM;
196         dev->rebuild_header     = nr_rebuild_header;
197         dev->set_mac_address    = nr_set_mac_address;
198
199         /* New-style flags. */
200         dev->flags              = IFF_NOARP;
201
202         dev->get_stats          = nr_get_stats;
203 }