drivers/net: Move a dereference below a NULL test
[linux-2.6] / drivers / net / hydra.c
1 /* New Hydra driver using generic 8390 core */
2 /* Based on old hydra driver by Topi Kanerva (topi@susanna.oulu.fi) */
3
4 /* This file is subject to the terms and conditions of the GNU General      */
5 /* Public License.  See the file COPYING in the main directory of the       */
6 /* Linux distribution for more details.                                     */
7
8 /* Peter De Schrijver (p2@mind.be) */
9 /* Oldenburg 2000 */
10
11 /* The Amiganet is a Zorro-II board made by Hydra Systems. It contains a    */
12 /* NS8390 NIC (network interface controller) clone, 16 or 64K on-board RAM  */
13 /* and 10BASE-2 (thin coax) and AUI connectors.                             */
14
15 #include <linux/module.h>
16 #include <linux/kernel.h>
17 #include <linux/string.h>
18 #include <linux/errno.h>
19 #include <linux/ioport.h>
20 #include <linux/slab.h>
21 #include <linux/interrupt.h>
22 #include <linux/netdevice.h>
23 #include <linux/etherdevice.h>
24 #include <linux/skbuff.h>
25 #include <linux/init.h>
26 #include <linux/bitops.h>
27
28 #include <asm/io.h>
29 #include <asm/irq.h>
30 #include <asm/amigaints.h>
31 #include <asm/amigahw.h>
32 #include <linux/zorro.h>
33
34 #define EI_SHIFT(x)     (ei_local->reg_offset[x])
35 #define ei_inb(port)   in_8(port)
36 #define ei_outb(val,port)  out_8(port,val)
37 #define ei_inb_p(port)   in_8(port)
38 #define ei_outb_p(val,port)  out_8(port,val)
39
40 static const char version[] =
41     "8390.c:v1.10cvs 9/23/94 Donald Becker (becker@cesdis.gsfc.nasa.gov)\n";
42
43 #include "lib8390.c"
44
45 #define NE_EN0_DCFG     (0x0e*2)
46
47 #define NESM_START_PG   0x0    /* First page of TX buffer */
48 #define NESM_STOP_PG    0x40    /* Last page +1 of RX ring */
49
50 #define HYDRA_NIC_BASE 0xffe1
51 #define HYDRA_ADDRPROM 0xffc0
52 #define HYDRA_VERSION "v3.0alpha"
53
54 #define WORDSWAP(a)     ((((a)>>8)&0xff) | ((a)<<8))
55
56
57 static int __devinit hydra_init_one(struct zorro_dev *z,
58                                     const struct zorro_device_id *ent);
59 static int __devinit hydra_init(struct zorro_dev *z);
60 static int hydra_open(struct net_device *dev);
61 static int hydra_close(struct net_device *dev);
62 static void hydra_reset_8390(struct net_device *dev);
63 static void hydra_get_8390_hdr(struct net_device *dev,
64                                struct e8390_pkt_hdr *hdr, int ring_page);
65 static void hydra_block_input(struct net_device *dev, int count,
66                               struct sk_buff *skb, int ring_offset);
67 static void hydra_block_output(struct net_device *dev, int count,
68                                const unsigned char *buf, int start_page);
69 static void __devexit hydra_remove_one(struct zorro_dev *z);
70
71 static struct zorro_device_id hydra_zorro_tbl[] __devinitdata = {
72     { ZORRO_PROD_HYDRA_SYSTEMS_AMIGANET },
73     { 0 }
74 };
75
76 static struct zorro_driver hydra_driver = {
77     .name       = "hydra",
78     .id_table   = hydra_zorro_tbl,
79     .probe      = hydra_init_one,
80     .remove     = __devexit_p(hydra_remove_one),
81 };
82
83 static int __devinit hydra_init_one(struct zorro_dev *z,
84                                     const struct zorro_device_id *ent)
85 {
86     int err;
87
88     if (!request_mem_region(z->resource.start, 0x10000, "Hydra"))
89         return -EBUSY;
90     if ((err = hydra_init(z))) {
91         release_mem_region(z->resource.start, 0x10000);
92         return -EBUSY;
93     }
94     return 0;
95 }
96
97 static const struct net_device_ops hydra_netdev_ops = {
98         .ndo_open               = hydra_open,
99         .ndo_stop               = hydra_close,
100
101         .ndo_start_xmit         = ei_start_xmit,
102         .ndo_tx_timeout         = ei_tx_timeout,
103         .ndo_get_stats          = ei_get_stats,
104         .ndo_set_multicast_list = ei_set_multicast_list,
105         .ndo_validate_addr      = eth_validate_addr,
106         .ndo_set_mac_address    = eth_mac_addr,
107         .ndo_change_mtu         = eth_change_mtu,
108 #ifdef CONFIG_NET_POLL_CONTROLLER
109         .ndo_poll_controller    = ei_poll,
110 #endif
111 };
112
113 static int __devinit hydra_init(struct zorro_dev *z)
114 {
115     struct net_device *dev;
116     unsigned long board = ZTWO_VADDR(z->resource.start);
117     unsigned long ioaddr = board+HYDRA_NIC_BASE;
118     const char name[] = "NE2000";
119     int start_page, stop_page;
120     int j;
121     int err;
122
123     static u32 hydra_offsets[16] = {
124         0x00, 0x02, 0x04, 0x06, 0x08, 0x0a, 0x0c, 0x0e,
125         0x10, 0x12, 0x14, 0x16, 0x18, 0x1a, 0x1c, 0x1e,
126     };
127
128     dev = alloc_ei_netdev();
129     if (!dev)
130         return -ENOMEM;
131
132     for(j = 0; j < ETHER_ADDR_LEN; j++)
133         dev->dev_addr[j] = *((u8 *)(board + HYDRA_ADDRPROM + 2*j));
134
135     /* We must set the 8390 for word mode. */
136     z_writeb(0x4b, ioaddr + NE_EN0_DCFG);
137     start_page = NESM_START_PG;
138     stop_page = NESM_STOP_PG;
139
140     dev->base_addr = ioaddr;
141     dev->irq = IRQ_AMIGA_PORTS;
142
143     /* Install the Interrupt handler */
144     if (request_irq(IRQ_AMIGA_PORTS, __ei_interrupt, IRQF_SHARED, "Hydra Ethernet",
145                     dev)) {
146         free_netdev(dev);
147         return -EAGAIN;
148     }
149
150     ei_status.name = name;
151     ei_status.tx_start_page = start_page;
152     ei_status.stop_page = stop_page;
153     ei_status.word16 = 1;
154     ei_status.bigendian = 1;
155
156     ei_status.rx_start_page = start_page + TX_PAGES;
157
158     ei_status.reset_8390 = &hydra_reset_8390;
159     ei_status.block_input = &hydra_block_input;
160     ei_status.block_output = &hydra_block_output;
161     ei_status.get_8390_hdr = &hydra_get_8390_hdr;
162     ei_status.reg_offset = hydra_offsets;
163
164     dev->netdev_ops = &hydra_netdev_ops;
165     __NS8390_init(dev, 0);
166
167     err = register_netdev(dev);
168     if (err) {
169         free_irq(IRQ_AMIGA_PORTS, dev);
170         free_netdev(dev);
171         return err;
172     }
173
174     zorro_set_drvdata(z, dev);
175
176     printk(KERN_INFO "%s: Hydra at 0x%08lx, address "
177            "%pM (hydra.c " HYDRA_VERSION ")\n",
178            dev->name, z->resource.start, dev->dev_addr);
179
180     return 0;
181 }
182
183 static int hydra_open(struct net_device *dev)
184 {
185     __ei_open(dev);
186     return 0;
187 }
188
189 static int hydra_close(struct net_device *dev)
190 {
191     if (ei_debug > 1)
192         printk(KERN_DEBUG "%s: Shutting down ethercard.\n", dev->name);
193     __ei_close(dev);
194     return 0;
195 }
196
197 static void hydra_reset_8390(struct net_device *dev)
198 {
199     printk(KERN_INFO "Hydra hw reset not there\n");
200 }
201
202 static void hydra_get_8390_hdr(struct net_device *dev,
203                                struct e8390_pkt_hdr *hdr, int ring_page)
204 {
205     int nic_base = dev->base_addr;
206     short *ptrs;
207     unsigned long hdr_start= (nic_base-HYDRA_NIC_BASE) +
208                              ((ring_page - NESM_START_PG)<<8);
209     ptrs = (short *)hdr;
210
211     *(ptrs++) = z_readw(hdr_start);
212     *((short *)hdr) = WORDSWAP(*((short *)hdr));
213     hdr_start += 2;
214     *(ptrs++) = z_readw(hdr_start);
215     *((short *)hdr+1) = WORDSWAP(*((short *)hdr+1));
216 }
217
218 static void hydra_block_input(struct net_device *dev, int count,
219                               struct sk_buff *skb, int ring_offset)
220 {
221     unsigned long nic_base = dev->base_addr;
222     unsigned long mem_base = nic_base - HYDRA_NIC_BASE;
223     unsigned long xfer_start = mem_base + ring_offset - (NESM_START_PG<<8);
224
225     if (count&1)
226         count++;
227
228     if (xfer_start+count >  mem_base + (NESM_STOP_PG<<8)) {
229         int semi_count = (mem_base + (NESM_STOP_PG<<8)) - xfer_start;
230
231         z_memcpy_fromio(skb->data,xfer_start,semi_count);
232         count -= semi_count;
233         z_memcpy_fromio(skb->data+semi_count, mem_base, count);
234     } else
235         z_memcpy_fromio(skb->data, xfer_start,count);
236
237 }
238
239 static void hydra_block_output(struct net_device *dev, int count,
240                                const unsigned char *buf, int start_page)
241 {
242     unsigned long nic_base = dev->base_addr;
243     unsigned long mem_base = nic_base - HYDRA_NIC_BASE;
244
245     if (count&1)
246         count++;
247
248     z_memcpy_toio(mem_base+((start_page - NESM_START_PG)<<8), buf, count);
249 }
250
251 static void __devexit hydra_remove_one(struct zorro_dev *z)
252 {
253     struct net_device *dev = zorro_get_drvdata(z);
254
255     unregister_netdev(dev);
256     free_irq(IRQ_AMIGA_PORTS, dev);
257     release_mem_region(ZTWO_PADDR(dev->base_addr)-HYDRA_NIC_BASE, 0x10000);
258     free_netdev(dev);
259 }
260
261 static int __init hydra_init_module(void)
262 {
263     return zorro_register_driver(&hydra_driver);
264 }
265
266 static void __exit hydra_cleanup_module(void)
267 {
268     zorro_unregister_driver(&hydra_driver);
269 }
270
271 module_init(hydra_init_module);
272 module_exit(hydra_cleanup_module);
273
274 MODULE_LICENSE("GPL");