1 /* drivers/net/ethernet/8390/ax88796.c
2 *
3 * Copyright 2005,2007 Simtec Electronics
4 * Ben Dooks <ben@simtec.co.uk>
5 *
6 * Asix AX88796 10/100 Ethernet controller support
7 * Based on ne.c, by Donald Becker, et-al.
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License version 2 as
11 * published by the Free Software Foundation.
12 */
13
14 #include <linux/module.h>
15 #include <linux/kernel.h>
16 #include <linux/errno.h>
17 #include <linux/isapnp.h>
18 #include <linux/init.h>
19 #include <linux/interrupt.h>
20 #include <linux/io.h>
21 #include <linux/platform_device.h>
22 #include <linux/delay.h>
23 #include <linux/timer.h>
24 #include <linux/netdevice.h>
25 #include <linux/etherdevice.h>
26 #include <linux/ethtool.h>
27 #include <linux/mdio-bitbang.h>
28 #include <linux/phy.h>
29 #include <linux/eeprom_93cx6.h>
30 #include <linux/slab.h>
31
32 #include <net/ax88796.h>
33
34
35 /* Rename the lib8390.c functions to show that they are in this driver */
36 #define __ei_open ax_ei_open
37 #define __ei_close ax_ei_close
38 #define __ei_poll ax_ei_poll
39 #define __ei_start_xmit ax_ei_start_xmit
40 #define __ei_tx_timeout ax_ei_tx_timeout
41 #define __ei_get_stats ax_ei_get_stats
42 #define __ei_set_multicast_list ax_ei_set_multicast_list
43 #define __ei_interrupt ax_ei_interrupt
44 #define ____alloc_ei_netdev ax__alloc_ei_netdev
45 #define __NS8390_init ax_NS8390_init
46
47 /* force unsigned long back to 'void __iomem *' */
48 #define ax_convert_addr(_a) ((void __force __iomem *)(_a))
49
50 #define ei_inb(_a) readb(ax_convert_addr(_a))
51 #define ei_outb(_v, _a) writeb(_v, ax_convert_addr(_a))
52
53 #define ei_inb_p(_a) ei_inb(_a)
54 #define ei_outb_p(_v, _a) ei_outb(_v, _a)
55
56 /* define EI_SHIFT() to take into account our register offsets */
57 #define EI_SHIFT(x) (ei_local->reg_offset[(x)])
58
59 /* Ensure we have our RCR base value */
60 #define AX88796_PLATFORM
61
62 static unsigned char version[] = "ax88796.c: Copyright 2005,2007 Simtec Electronics\n";
63
64 #include "lib8390.c"
65
66 #define DRV_NAME "ax88796"
67 #define DRV_VERSION "1.00"
68
69 /* from ne.c */
70 #define NE_CMD EI_SHIFT(0x00)
71 #define NE_RESET EI_SHIFT(0x1f)
72 #define NE_DATAPORT EI_SHIFT(0x10)
73
74 #define NE1SM_START_PG 0x20 /* First page of TX buffer */
75 #define NE1SM_STOP_PG 0x40 /* Last page +1 of RX ring */
76 #define NESM_START_PG 0x40 /* First page of TX buffer */
77 #define NESM_STOP_PG 0x80 /* Last page +1 of RX ring */
78
79 #define AX_GPOC_PPDSET BIT(6)
80
81 /* device private data */
82
83 struct ax_device {
84 struct mii_bus *mii_bus;
85 struct mdiobb_ctrl bb_ctrl;
86 struct phy_device *phy_dev;
87 void __iomem *addr_memr;
88 u8 reg_memr;
89 int link;
90 int speed;
91 int duplex;
92
93 void __iomem *map2;
94 const struct ax_plat_data *plat;
95
96 unsigned char running;
97 unsigned char resume_open;
98 unsigned int irqflags;
99
100 u32 reg_offsets[0x20];
101 };
102
to_ax_dev(struct net_device * dev)103 static inline struct ax_device *to_ax_dev(struct net_device *dev)
104 {
105 struct ei_device *ei_local = netdev_priv(dev);
106 return (struct ax_device *)(ei_local + 1);
107 }
108
109 /*
110 * ax_initial_check
111 *
112 * do an initial probe for the card to check wether it exists
113 * and is functional
114 */
ax_initial_check(struct net_device * dev)115 static int ax_initial_check(struct net_device *dev)
116 {
117 struct ei_device *ei_local = netdev_priv(dev);
118 void __iomem *ioaddr = ei_local->mem;
119 int reg0;
120 int regd;
121
122 reg0 = ei_inb(ioaddr);
123 if (reg0 == 0xFF)
124 return -ENODEV;
125
126 ei_outb(E8390_NODMA + E8390_PAGE1 + E8390_STOP, ioaddr + E8390_CMD);
127 regd = ei_inb(ioaddr + 0x0d);
128 ei_outb(0xff, ioaddr + 0x0d);
129 ei_outb(E8390_NODMA + E8390_PAGE0, ioaddr + E8390_CMD);
130 ei_inb(ioaddr + EN0_COUNTER0); /* Clear the counter by reading. */
131 if (ei_inb(ioaddr + EN0_COUNTER0) != 0) {
132 ei_outb(reg0, ioaddr);
133 ei_outb(regd, ioaddr + 0x0d); /* Restore the old values. */
134 return -ENODEV;
135 }
136
137 return 0;
138 }
139
140 /*
141 * Hard reset the card. This used to pause for the same period that a
142 * 8390 reset command required, but that shouldn't be necessary.
143 */
ax_reset_8390(struct net_device * dev)144 static void ax_reset_8390(struct net_device *dev)
145 {
146 struct ei_device *ei_local = netdev_priv(dev);
147 unsigned long reset_start_time = jiffies;
148 void __iomem *addr = (void __iomem *)dev->base_addr;
149
150 if (ei_debug > 1)
151 netdev_dbg(dev, "resetting the 8390 t=%ld\n", jiffies);
152
153 ei_outb(ei_inb(addr + NE_RESET), addr + NE_RESET);
154
155 ei_local->txing = 0;
156 ei_local->dmaing = 0;
157
158 /* This check _should_not_ be necessary, omit eventually. */
159 while ((ei_inb(addr + EN0_ISR) & ENISR_RESET) == 0) {
160 if (jiffies - reset_start_time > 2 * HZ / 100) {
161 netdev_warn(dev, "%s: did not complete.\n", __func__);
162 break;
163 }
164 }
165
166 ei_outb(ENISR_RESET, addr + EN0_ISR); /* Ack intr. */
167 }
168
169
ax_get_8390_hdr(struct net_device * dev,struct e8390_pkt_hdr * hdr,int ring_page)170 static void ax_get_8390_hdr(struct net_device *dev, struct e8390_pkt_hdr *hdr,
171 int ring_page)
172 {
173 struct ei_device *ei_local = netdev_priv(dev);
174 void __iomem *nic_base = ei_local->mem;
175
176 /* This *shouldn't* happen. If it does, it's the last thing you'll see */
177 if (ei_local->dmaing) {
178 netdev_err(dev, "DMAing conflict in %s "
179 "[DMAstat:%d][irqlock:%d].\n",
180 __func__,
181 ei_local->dmaing, ei_local->irqlock);
182 return;
183 }
184
185 ei_local->dmaing |= 0x01;
186 ei_outb(E8390_NODMA + E8390_PAGE0 + E8390_START, nic_base + NE_CMD);
187 ei_outb(sizeof(struct e8390_pkt_hdr), nic_base + EN0_RCNTLO);
188 ei_outb(0, nic_base + EN0_RCNTHI);
189 ei_outb(0, nic_base + EN0_RSARLO); /* On page boundary */
190 ei_outb(ring_page, nic_base + EN0_RSARHI);
191 ei_outb(E8390_RREAD+E8390_START, nic_base + NE_CMD);
192
193 if (ei_local->word16)
194 readsw(nic_base + NE_DATAPORT, hdr,
195 sizeof(struct e8390_pkt_hdr) >> 1);
196 else
197 readsb(nic_base + NE_DATAPORT, hdr,
198 sizeof(struct e8390_pkt_hdr));
199
200 ei_outb(ENISR_RDC, nic_base + EN0_ISR); /* Ack intr. */
201 ei_local->dmaing &= ~0x01;
202
203 le16_to_cpus(&hdr->count);
204 }
205
206
207 /*
208 * Block input and output, similar to the Crynwr packet driver. If
209 * you are porting to a new ethercard, look at the packet driver
210 * source for hints. The NEx000 doesn't share the on-board packet
211 * memory -- you have to put the packet out through the "remote DMA"
212 * dataport using ei_outb.
213 */
ax_block_input(struct net_device * dev,int count,struct sk_buff * skb,int ring_offset)214 static void ax_block_input(struct net_device *dev, int count,
215 struct sk_buff *skb, int ring_offset)
216 {
217 struct ei_device *ei_local = netdev_priv(dev);
218 void __iomem *nic_base = ei_local->mem;
219 char *buf = skb->data;
220
221 if (ei_local->dmaing) {
222 netdev_err(dev,
223 "DMAing conflict in %s "
224 "[DMAstat:%d][irqlock:%d].\n",
225 __func__,
226 ei_local->dmaing, ei_local->irqlock);
227 return;
228 }
229
230 ei_local->dmaing |= 0x01;
231
232 ei_outb(E8390_NODMA+E8390_PAGE0+E8390_START, nic_base + NE_CMD);
233 ei_outb(count & 0xff, nic_base + EN0_RCNTLO);
234 ei_outb(count >> 8, nic_base + EN0_RCNTHI);
235 ei_outb(ring_offset & 0xff, nic_base + EN0_RSARLO);
236 ei_outb(ring_offset >> 8, nic_base + EN0_RSARHI);
237 ei_outb(E8390_RREAD+E8390_START, nic_base + NE_CMD);
238
239 if (ei_local->word16) {
240 readsw(nic_base + NE_DATAPORT, buf, count >> 1);
241 if (count & 0x01)
242 buf[count-1] = ei_inb(nic_base + NE_DATAPORT);
243
244 } else {
245 readsb(nic_base + NE_DATAPORT, buf, count);
246 }
247
248 ei_local->dmaing &= ~1;
249 }
250
ax_block_output(struct net_device * dev,int count,const unsigned char * buf,const int start_page)251 static void ax_block_output(struct net_device *dev, int count,
252 const unsigned char *buf, const int start_page)
253 {
254 struct ei_device *ei_local = netdev_priv(dev);
255 void __iomem *nic_base = ei_local->mem;
256 unsigned long dma_start;
257
258 /*
259 * Round the count up for word writes. Do we need to do this?
260 * What effect will an odd byte count have on the 8390? I
261 * should check someday.
262 */
263 if (ei_local->word16 && (count & 0x01))
264 count++;
265
266 /* This *shouldn't* happen. If it does, it's the last thing you'll see */
267 if (ei_local->dmaing) {
268 netdev_err(dev, "DMAing conflict in %s."
269 "[DMAstat:%d][irqlock:%d]\n",
270 __func__,
271 ei_local->dmaing, ei_local->irqlock);
272 return;
273 }
274
275 ei_local->dmaing |= 0x01;
276 /* We should already be in page 0, but to be safe... */
277 ei_outb(E8390_PAGE0+E8390_START+E8390_NODMA, nic_base + NE_CMD);
278
279 ei_outb(ENISR_RDC, nic_base + EN0_ISR);
280
281 /* Now the normal output. */
282 ei_outb(count & 0xff, nic_base + EN0_RCNTLO);
283 ei_outb(count >> 8, nic_base + EN0_RCNTHI);
284 ei_outb(0x00, nic_base + EN0_RSARLO);
285 ei_outb(start_page, nic_base + EN0_RSARHI);
286
287 ei_outb(E8390_RWRITE+E8390_START, nic_base + NE_CMD);
288 if (ei_local->word16)
289 writesw(nic_base + NE_DATAPORT, buf, count >> 1);
290 else
291 writesb(nic_base + NE_DATAPORT, buf, count);
292
293 dma_start = jiffies;
294
295 while ((ei_inb(nic_base + EN0_ISR) & ENISR_RDC) == 0) {
296 if (jiffies - dma_start > 2 * HZ / 100) { /* 20ms */
297 netdev_warn(dev, "timeout waiting for Tx RDC.\n");
298 ax_reset_8390(dev);
299 ax_NS8390_init(dev, 1);
300 break;
301 }
302 }
303
304 ei_outb(ENISR_RDC, nic_base + EN0_ISR); /* Ack intr. */
305 ei_local->dmaing &= ~0x01;
306 }
307
308 /* definitions for accessing MII/EEPROM interface */
309
310 #define AX_MEMR EI_SHIFT(0x14)
311 #define AX_MEMR_MDC BIT(0)
312 #define AX_MEMR_MDIR BIT(1)
313 #define AX_MEMR_MDI BIT(2)
314 #define AX_MEMR_MDO BIT(3)
315 #define AX_MEMR_EECS BIT(4)
316 #define AX_MEMR_EEI BIT(5)
317 #define AX_MEMR_EEO BIT(6)
318 #define AX_MEMR_EECLK BIT(7)
319
ax_handle_link_change(struct net_device * dev)320 static void ax_handle_link_change(struct net_device *dev)
321 {
322 struct ax_device *ax = to_ax_dev(dev);
323 struct phy_device *phy_dev = ax->phy_dev;
324 int status_change = 0;
325
326 if (phy_dev->link && ((ax->speed != phy_dev->speed) ||
327 (ax->duplex != phy_dev->duplex))) {
328
329 ax->speed = phy_dev->speed;
330 ax->duplex = phy_dev->duplex;
331 status_change = 1;
332 }
333
334 if (phy_dev->link != ax->link) {
335 if (!phy_dev->link) {
336 ax->speed = 0;
337 ax->duplex = -1;
338 }
339 ax->link = phy_dev->link;
340
341 status_change = 1;
342 }
343
344 if (status_change)
345 phy_print_status(phy_dev);
346 }
347
ax_mii_probe(struct net_device * dev)348 static int ax_mii_probe(struct net_device *dev)
349 {
350 struct ax_device *ax = to_ax_dev(dev);
351 struct phy_device *phy_dev = NULL;
352 int ret;
353
354 /* find the first phy */
355 phy_dev = phy_find_first(ax->mii_bus);
356 if (!phy_dev) {
357 netdev_err(dev, "no PHY found\n");
358 return -ENODEV;
359 }
360
361 ret = phy_connect_direct(dev, phy_dev, ax_handle_link_change, 0,
362 PHY_INTERFACE_MODE_MII);
363 if (ret) {
364 netdev_err(dev, "Could not attach to PHY\n");
365 return ret;
366 }
367
368 /* mask with MAC supported features */
369 phy_dev->supported &= PHY_BASIC_FEATURES;
370 phy_dev->advertising = phy_dev->supported;
371
372 ax->phy_dev = phy_dev;
373
374 netdev_info(dev, "PHY driver [%s] (mii_bus:phy_addr=%s, irq=%d)\n",
375 phy_dev->drv->name, dev_name(&phy_dev->dev), phy_dev->irq);
376
377 return 0;
378 }
379
ax_phy_switch(struct net_device * dev,int on)380 static void ax_phy_switch(struct net_device *dev, int on)
381 {
382 struct ei_device *ei_local = netdev_priv(dev);
383 struct ax_device *ax = to_ax_dev(dev);
384
385 u8 reg_gpoc = ax->plat->gpoc_val;
386
387 if (!!on)
388 reg_gpoc &= ~AX_GPOC_PPDSET;
389 else
390 reg_gpoc |= AX_GPOC_PPDSET;
391
392 ei_outb(reg_gpoc, ei_local->mem + EI_SHIFT(0x17));
393 }
394
ax_open(struct net_device * dev)395 static int ax_open(struct net_device *dev)
396 {
397 struct ax_device *ax = to_ax_dev(dev);
398 int ret;
399
400 netdev_dbg(dev, "open\n");
401
402 ret = request_irq(dev->irq, ax_ei_interrupt, ax->irqflags,
403 dev->name, dev);
404 if (ret)
405 goto failed_request_irq;
406
407 /* turn the phy on (if turned off) */
408 ax_phy_switch(dev, 1);
409
410 ret = ax_mii_probe(dev);
411 if (ret)
412 goto failed_mii_probe;
413 phy_start(ax->phy_dev);
414
415 ret = ax_ei_open(dev);
416 if (ret)
417 goto failed_ax_ei_open;
418
419 ax->running = 1;
420
421 return 0;
422
423 failed_ax_ei_open:
424 phy_disconnect(ax->phy_dev);
425 failed_mii_probe:
426 ax_phy_switch(dev, 0);
427 free_irq(dev->irq, dev);
428 failed_request_irq:
429 return ret;
430 }
431
ax_close(struct net_device * dev)432 static int ax_close(struct net_device *dev)
433 {
434 struct ax_device *ax = to_ax_dev(dev);
435
436 netdev_dbg(dev, "close\n");
437
438 ax->running = 0;
439 wmb();
440
441 ax_ei_close(dev);
442
443 /* turn the phy off */
444 ax_phy_switch(dev, 0);
445 phy_disconnect(ax->phy_dev);
446
447 free_irq(dev->irq, dev);
448 return 0;
449 }
450
ax_ioctl(struct net_device * dev,struct ifreq * req,int cmd)451 static int ax_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
452 {
453 struct ax_device *ax = to_ax_dev(dev);
454 struct phy_device *phy_dev = ax->phy_dev;
455
456 if (!netif_running(dev))
457 return -EINVAL;
458
459 if (!phy_dev)
460 return -ENODEV;
461
462 return phy_mii_ioctl(phy_dev, req, cmd);
463 }
464
465 /* ethtool ops */
466
ax_get_drvinfo(struct net_device * dev,struct ethtool_drvinfo * info)467 static void ax_get_drvinfo(struct net_device *dev,
468 struct ethtool_drvinfo *info)
469 {
470 struct platform_device *pdev = to_platform_device(dev->dev.parent);
471
472 strcpy(info->driver, DRV_NAME);
473 strcpy(info->version, DRV_VERSION);
474 strcpy(info->bus_info, pdev->name);
475 }
476
ax_get_settings(struct net_device * dev,struct ethtool_cmd * cmd)477 static int ax_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
478 {
479 struct ax_device *ax = to_ax_dev(dev);
480 struct phy_device *phy_dev = ax->phy_dev;
481
482 if (!phy_dev)
483 return -ENODEV;
484
485 return phy_ethtool_gset(phy_dev, cmd);
486 }
487
ax_set_settings(struct net_device * dev,struct ethtool_cmd * cmd)488 static int ax_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
489 {
490 struct ax_device *ax = to_ax_dev(dev);
491 struct phy_device *phy_dev = ax->phy_dev;
492
493 if (!phy_dev)
494 return -ENODEV;
495
496 return phy_ethtool_sset(phy_dev, cmd);
497 }
498
499 static const struct ethtool_ops ax_ethtool_ops = {
500 .get_drvinfo = ax_get_drvinfo,
501 .get_settings = ax_get_settings,
502 .set_settings = ax_set_settings,
503 .get_link = ethtool_op_get_link,
504 };
505
506 #ifdef CONFIG_AX88796_93CX6
ax_eeprom_register_read(struct eeprom_93cx6 * eeprom)507 static void ax_eeprom_register_read(struct eeprom_93cx6 *eeprom)
508 {
509 struct ei_device *ei_local = eeprom->data;
510 u8 reg = ei_inb(ei_local->mem + AX_MEMR);
511
512 eeprom->reg_data_in = reg & AX_MEMR_EEI;
513 eeprom->reg_data_out = reg & AX_MEMR_EEO; /* Input pin */
514 eeprom->reg_data_clock = reg & AX_MEMR_EECLK;
515 eeprom->reg_chip_select = reg & AX_MEMR_EECS;
516 }
517
ax_eeprom_register_write(struct eeprom_93cx6 * eeprom)518 static void ax_eeprom_register_write(struct eeprom_93cx6 *eeprom)
519 {
520 struct ei_device *ei_local = eeprom->data;
521 u8 reg = ei_inb(ei_local->mem + AX_MEMR);
522
523 reg &= ~(AX_MEMR_EEI | AX_MEMR_EECLK | AX_MEMR_EECS);
524
525 if (eeprom->reg_data_in)
526 reg |= AX_MEMR_EEI;
527 if (eeprom->reg_data_clock)
528 reg |= AX_MEMR_EECLK;
529 if (eeprom->reg_chip_select)
530 reg |= AX_MEMR_EECS;
531
532 ei_outb(reg, ei_local->mem + AX_MEMR);
533 udelay(10);
534 }
535 #endif
536
537 static const struct net_device_ops ax_netdev_ops = {
538 .ndo_open = ax_open,
539 .ndo_stop = ax_close,
540 .ndo_do_ioctl = ax_ioctl,
541
542 .ndo_start_xmit = ax_ei_start_xmit,
543 .ndo_tx_timeout = ax_ei_tx_timeout,
544 .ndo_get_stats = ax_ei_get_stats,
545 .ndo_set_rx_mode = ax_ei_set_multicast_list,
546 .ndo_validate_addr = eth_validate_addr,
547 .ndo_set_mac_address = eth_mac_addr,
548 .ndo_change_mtu = eth_change_mtu,
549 #ifdef CONFIG_NET_POLL_CONTROLLER
550 .ndo_poll_controller = ax_ei_poll,
551 #endif
552 };
553
ax_bb_mdc(struct mdiobb_ctrl * ctrl,int level)554 static void ax_bb_mdc(struct mdiobb_ctrl *ctrl, int level)
555 {
556 struct ax_device *ax = container_of(ctrl, struct ax_device, bb_ctrl);
557
558 if (level)
559 ax->reg_memr |= AX_MEMR_MDC;
560 else
561 ax->reg_memr &= ~AX_MEMR_MDC;
562
563 ei_outb(ax->reg_memr, ax->addr_memr);
564 }
565
ax_bb_dir(struct mdiobb_ctrl * ctrl,int output)566 static void ax_bb_dir(struct mdiobb_ctrl *ctrl, int output)
567 {
568 struct ax_device *ax = container_of(ctrl, struct ax_device, bb_ctrl);
569
570 if (output)
571 ax->reg_memr &= ~AX_MEMR_MDIR;
572 else
573 ax->reg_memr |= AX_MEMR_MDIR;
574
575 ei_outb(ax->reg_memr, ax->addr_memr);
576 }
577
ax_bb_set_data(struct mdiobb_ctrl * ctrl,int value)578 static void ax_bb_set_data(struct mdiobb_ctrl *ctrl, int value)
579 {
580 struct ax_device *ax = container_of(ctrl, struct ax_device, bb_ctrl);
581
582 if (value)
583 ax->reg_memr |= AX_MEMR_MDO;
584 else
585 ax->reg_memr &= ~AX_MEMR_MDO;
586
587 ei_outb(ax->reg_memr, ax->addr_memr);
588 }
589
ax_bb_get_data(struct mdiobb_ctrl * ctrl)590 static int ax_bb_get_data(struct mdiobb_ctrl *ctrl)
591 {
592 struct ax_device *ax = container_of(ctrl, struct ax_device, bb_ctrl);
593 int reg_memr = ei_inb(ax->addr_memr);
594
595 return reg_memr & AX_MEMR_MDI ? 1 : 0;
596 }
597
598 static struct mdiobb_ops bb_ops = {
599 .owner = THIS_MODULE,
600 .set_mdc = ax_bb_mdc,
601 .set_mdio_dir = ax_bb_dir,
602 .set_mdio_data = ax_bb_set_data,
603 .get_mdio_data = ax_bb_get_data,
604 };
605
606 /* setup code */
607
ax_mii_init(struct net_device * dev)608 static int ax_mii_init(struct net_device *dev)
609 {
610 struct platform_device *pdev = to_platform_device(dev->dev.parent);
611 struct ei_device *ei_local = netdev_priv(dev);
612 struct ax_device *ax = to_ax_dev(dev);
613 int err, i;
614
615 ax->bb_ctrl.ops = &bb_ops;
616 ax->addr_memr = ei_local->mem + AX_MEMR;
617 ax->mii_bus = alloc_mdio_bitbang(&ax->bb_ctrl);
618 if (!ax->mii_bus) {
619 err = -ENOMEM;
620 goto out;
621 }
622
623 ax->mii_bus->name = "ax88796_mii_bus";
624 ax->mii_bus->parent = dev->dev.parent;
625 snprintf(ax->mii_bus->id, MII_BUS_ID_SIZE, "%s-%x",
626 pdev->name, pdev->id);
627
628 ax->mii_bus->irq = kmalloc(sizeof(int) * PHY_MAX_ADDR, GFP_KERNEL);
629 if (!ax->mii_bus->irq) {
630 err = -ENOMEM;
631 goto out_free_mdio_bitbang;
632 }
633
634 for (i = 0; i < PHY_MAX_ADDR; i++)
635 ax->mii_bus->irq[i] = PHY_POLL;
636
637 err = mdiobus_register(ax->mii_bus);
638 if (err)
639 goto out_free_irq;
640
641 return 0;
642
643 out_free_irq:
644 kfree(ax->mii_bus->irq);
645 out_free_mdio_bitbang:
646 free_mdio_bitbang(ax->mii_bus);
647 out:
648 return err;
649 }
650
ax_initial_setup(struct net_device * dev,struct ei_device * ei_local)651 static void ax_initial_setup(struct net_device *dev, struct ei_device *ei_local)
652 {
653 void __iomem *ioaddr = ei_local->mem;
654 struct ax_device *ax = to_ax_dev(dev);
655
656 /* Select page 0 */
657 ei_outb(E8390_NODMA + E8390_PAGE0 + E8390_STOP, ioaddr + E8390_CMD);
658
659 /* set to byte access */
660 ei_outb(ax->plat->dcr_val & ~1, ioaddr + EN0_DCFG);
661 ei_outb(ax->plat->gpoc_val, ioaddr + EI_SHIFT(0x17));
662 }
663
664 /*
665 * ax_init_dev
666 *
667 * initialise the specified device, taking care to note the MAC
668 * address it may already have (if configured), ensure
669 * the device is ready to be used by lib8390.c and registerd with
670 * the network layer.
671 */
ax_init_dev(struct net_device * dev)672 static int ax_init_dev(struct net_device *dev)
673 {
674 struct ei_device *ei_local = netdev_priv(dev);
675 struct ax_device *ax = to_ax_dev(dev);
676 void __iomem *ioaddr = ei_local->mem;
677 unsigned int start_page;
678 unsigned int stop_page;
679 int ret;
680 int i;
681
682 ret = ax_initial_check(dev);
683 if (ret)
684 goto err_out;
685
686 /* setup goes here */
687
688 ax_initial_setup(dev, ei_local);
689
690 /* read the mac from the card prom if we need it */
691
692 if (ax->plat->flags & AXFLG_HAS_EEPROM) {
693 unsigned char SA_prom[32];
694
695 for (i = 0; i < sizeof(SA_prom); i += 2) {
696 SA_prom[i] = ei_inb(ioaddr + NE_DATAPORT);
697 SA_prom[i + 1] = ei_inb(ioaddr + NE_DATAPORT);
698 }
699
700 if (ax->plat->wordlength == 2)
701 for (i = 0; i < 16; i++)
702 SA_prom[i] = SA_prom[i+i];
703
704 memcpy(dev->dev_addr, SA_prom, 6);
705 }
706
707 #ifdef CONFIG_AX88796_93CX6
708 if (ax->plat->flags & AXFLG_HAS_93CX6) {
709 unsigned char mac_addr[6];
710 struct eeprom_93cx6 eeprom;
711
712 eeprom.data = ei_local;
713 eeprom.register_read = ax_eeprom_register_read;
714 eeprom.register_write = ax_eeprom_register_write;
715 eeprom.width = PCI_EEPROM_WIDTH_93C56;
716
717 eeprom_93cx6_multiread(&eeprom, 0,
718 (__le16 __force *)mac_addr,
719 sizeof(mac_addr) >> 1);
720
721 memcpy(dev->dev_addr, mac_addr, 6);
722 }
723 #endif
724 if (ax->plat->wordlength == 2) {
725 /* We must set the 8390 for word mode. */
726 ei_outb(ax->plat->dcr_val, ei_local->mem + EN0_DCFG);
727 start_page = NESM_START_PG;
728 stop_page = NESM_STOP_PG;
729 } else {
730 start_page = NE1SM_START_PG;
731 stop_page = NE1SM_STOP_PG;
732 }
733
734 /* load the mac-address from the device */
735 if (ax->plat->flags & AXFLG_MAC_FROMDEV) {
736 ei_outb(E8390_NODMA + E8390_PAGE1 + E8390_STOP,
737 ei_local->mem + E8390_CMD); /* 0x61 */
738 for (i = 0; i < ETH_ALEN; i++)
739 dev->dev_addr[i] =
740 ei_inb(ioaddr + EN1_PHYS_SHIFT(i));
741 }
742
743 if ((ax->plat->flags & AXFLG_MAC_FROMPLATFORM) &&
744 ax->plat->mac_addr)
745 memcpy(dev->dev_addr, ax->plat->mac_addr, ETH_ALEN);
746
747 ax_reset_8390(dev);
748
749 ei_local->name = "AX88796";
750 ei_local->tx_start_page = start_page;
751 ei_local->stop_page = stop_page;
752 ei_local->word16 = (ax->plat->wordlength == 2);
753 ei_local->rx_start_page = start_page + TX_PAGES;
754
755 #ifdef PACKETBUF_MEMSIZE
756 /* Allow the packet buffer size to be overridden by know-it-alls. */
757 ei_local->stop_page = ei_local->tx_start_page + PACKETBUF_MEMSIZE;
758 #endif
759
760 ei_local->reset_8390 = &ax_reset_8390;
761 ei_local->block_input = &ax_block_input;
762 ei_local->block_output = &ax_block_output;
763 ei_local->get_8390_hdr = &ax_get_8390_hdr;
764 ei_local->priv = 0;
765
766 dev->netdev_ops = &ax_netdev_ops;
767 dev->ethtool_ops = &ax_ethtool_ops;
768
769 ret = ax_mii_init(dev);
770 if (ret)
771 goto out_irq;
772
773 ax_NS8390_init(dev, 0);
774
775 ret = register_netdev(dev);
776 if (ret)
777 goto out_irq;
778
779 netdev_info(dev, "%dbit, irq %d, %lx, MAC: %pM\n",
780 ei_local->word16 ? 16 : 8, dev->irq, dev->base_addr,
781 dev->dev_addr);
782
783 return 0;
784
785 out_irq:
786 /* cleanup irq */
787 free_irq(dev->irq, dev);
788 err_out:
789 return ret;
790 }
791
ax_remove(struct platform_device * pdev)792 static int ax_remove(struct platform_device *pdev)
793 {
794 struct net_device *dev = platform_get_drvdata(pdev);
795 struct ei_device *ei_local = netdev_priv(dev);
796 struct ax_device *ax = to_ax_dev(dev);
797 struct resource *mem;
798
799 unregister_netdev(dev);
800 free_irq(dev->irq, dev);
801
802 iounmap(ei_local->mem);
803 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
804 release_mem_region(mem->start, resource_size(mem));
805
806 if (ax->map2) {
807 iounmap(ax->map2);
808 mem = platform_get_resource(pdev, IORESOURCE_MEM, 1);
809 release_mem_region(mem->start, resource_size(mem));
810 }
811
812 free_netdev(dev);
813
814 return 0;
815 }
816
817 /*
818 * ax_probe
819 *
820 * This is the entry point when the platform device system uses to
821 * notify us of a new device to attach to. Allocate memory, find the
822 * resources and information passed, and map the necessary registers.
823 */
ax_probe(struct platform_device * pdev)824 static int ax_probe(struct platform_device *pdev)
825 {
826 struct net_device *dev;
827 struct ei_device *ei_local;
828 struct ax_device *ax;
829 struct resource *irq, *mem, *mem2;
830 resource_size_t mem_size, mem2_size = 0;
831 int ret = 0;
832
833 dev = ax__alloc_ei_netdev(sizeof(struct ax_device));
834 if (dev == NULL)
835 return -ENOMEM;
836
837 /* ok, let's setup our device */
838 SET_NETDEV_DEV(dev, &pdev->dev);
839 ei_local = netdev_priv(dev);
840 ax = to_ax_dev(dev);
841
842 ax->plat = pdev->dev.platform_data;
843 platform_set_drvdata(pdev, dev);
844
845 ei_local->rxcr_base = ax->plat->rcr_val;
846
847 /* find the platform resources */
848 irq = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
849 if (!irq) {
850 dev_err(&pdev->dev, "no IRQ specified\n");
851 ret = -ENXIO;
852 goto exit_mem;
853 }
854
855 dev->irq = irq->start;
856 ax->irqflags = irq->flags & IRQF_TRIGGER_MASK;
857
858 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
859 if (!mem) {
860 dev_err(&pdev->dev, "no MEM specified\n");
861 ret = -ENXIO;
862 goto exit_mem;
863 }
864
865 mem_size = resource_size(mem);
866
867 /*
868 * setup the register offsets from either the platform data or
869 * by using the size of the resource provided
870 */
871 if (ax->plat->reg_offsets)
872 ei_local->reg_offset = ax->plat->reg_offsets;
873 else {
874 ei_local->reg_offset = ax->reg_offsets;
875 for (ret = 0; ret < 0x18; ret++)
876 ax->reg_offsets[ret] = (mem_size / 0x18) * ret;
877 }
878
879 if (!request_mem_region(mem->start, mem_size, pdev->name)) {
880 dev_err(&pdev->dev, "cannot reserve registers\n");
881 ret = -ENXIO;
882 goto exit_mem;
883 }
884
885 ei_local->mem = ioremap(mem->start, mem_size);
886 dev->base_addr = (unsigned long)ei_local->mem;
887
888 if (ei_local->mem == NULL) {
889 dev_err(&pdev->dev, "Cannot ioremap area %pR\n", mem);
890
891 ret = -ENXIO;
892 goto exit_req;
893 }
894
895 /* look for reset area */
896 mem2 = platform_get_resource(pdev, IORESOURCE_MEM, 1);
897 if (!mem2) {
898 if (!ax->plat->reg_offsets) {
899 for (ret = 0; ret < 0x20; ret++)
900 ax->reg_offsets[ret] = (mem_size / 0x20) * ret;
901 }
902 } else {
903 mem2_size = resource_size(mem2);
904
905 if (!request_mem_region(mem2->start, mem2_size, pdev->name)) {
906 dev_err(&pdev->dev, "cannot reserve registers\n");
907 ret = -ENXIO;
908 goto exit_mem1;
909 }
910
911 ax->map2 = ioremap(mem2->start, mem2_size);
912 if (!ax->map2) {
913 dev_err(&pdev->dev, "cannot map reset register\n");
914 ret = -ENXIO;
915 goto exit_mem2;
916 }
917
918 ei_local->reg_offset[0x1f] = ax->map2 - ei_local->mem;
919 }
920
921 /* got resources, now initialise and register device */
922 ret = ax_init_dev(dev);
923 if (!ret)
924 return 0;
925
926 if (!ax->map2)
927 goto exit_mem1;
928
929 iounmap(ax->map2);
930
931 exit_mem2:
932 release_mem_region(mem2->start, mem2_size);
933
934 exit_mem1:
935 iounmap(ei_local->mem);
936
937 exit_req:
938 release_mem_region(mem->start, mem_size);
939
940 exit_mem:
941 free_netdev(dev);
942
943 return ret;
944 }
945
946 /* suspend and resume */
947
948 #ifdef CONFIG_PM
ax_suspend(struct platform_device * dev,pm_message_t state)949 static int ax_suspend(struct platform_device *dev, pm_message_t state)
950 {
951 struct net_device *ndev = platform_get_drvdata(dev);
952 struct ax_device *ax = to_ax_dev(ndev);
953
954 ax->resume_open = ax->running;
955
956 netif_device_detach(ndev);
957 ax_close(ndev);
958
959 return 0;
960 }
961
ax_resume(struct platform_device * pdev)962 static int ax_resume(struct platform_device *pdev)
963 {
964 struct net_device *ndev = platform_get_drvdata(pdev);
965 struct ax_device *ax = to_ax_dev(ndev);
966
967 ax_initial_setup(ndev, netdev_priv(ndev));
968 ax_NS8390_init(ndev, ax->resume_open);
969 netif_device_attach(ndev);
970
971 if (ax->resume_open)
972 ax_open(ndev);
973
974 return 0;
975 }
976
977 #else
978 #define ax_suspend NULL
979 #define ax_resume NULL
980 #endif
981
982 static struct platform_driver axdrv = {
983 .driver = {
984 .name = "ax88796",
985 .owner = THIS_MODULE,
986 },
987 .probe = ax_probe,
988 .remove = ax_remove,
989 .suspend = ax_suspend,
990 .resume = ax_resume,
991 };
992
993 module_platform_driver(axdrv);
994
995 MODULE_DESCRIPTION("AX88796 10/100 Ethernet platform driver");
996 MODULE_AUTHOR("Ben Dooks, <ben@simtec.co.uk>");
997 MODULE_LICENSE("GPL v2");
998 MODULE_ALIAS("platform:ax88796");
999