etherh.c 20 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866
  1. /*
  2. * linux/drivers/acorn/net/etherh.c
  3. *
  4. * Copyright (C) 2000-2002 Russell King
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License version 2 as
  8. * published by the Free Software Foundation.
  9. *
  10. * NS8390 I-cubed EtherH and ANT EtherM specific driver
  11. * Thanks to I-Cubed for information on their cards.
  12. * EtherM conversion (C) 1999 Chris Kemp and Tim Watterton
  13. * EtherM integration (C) 2000 Aleph One Ltd (Tak-Shing Chan)
  14. * EtherM integration re-engineered by Russell King.
  15. *
  16. * Changelog:
  17. * 08-12-1996 RMK 1.00 Created
  18. * RMK 1.03 Added support for EtherLan500 cards
  19. * 23-11-1997 RMK 1.04 Added media autodetection
  20. * 16-04-1998 RMK 1.05 Improved media autodetection
  21. * 10-02-2000 RMK 1.06 Updated for 2.3.43
  22. * 13-05-2000 RMK 1.07 Updated for 2.3.99-pre8
  23. * 12-10-1999 CK/TEW EtherM driver first release
  24. * 21-12-2000 TTC EtherH/EtherM integration
  25. * 25-12-2000 RMK 1.08 Clean integration of EtherM into this driver.
  26. * 03-01-2002 RMK 1.09 Always enable IRQs if we're in the nic slot.
  27. */
  28. #include <linux/module.h>
  29. #include <linux/kernel.h>
  30. #include <linux/types.h>
  31. #include <linux/fcntl.h>
  32. #include <linux/interrupt.h>
  33. #include <linux/ioport.h>
  34. #include <linux/in.h>
  35. #include <linux/slab.h>
  36. #include <linux/string.h>
  37. #include <linux/errno.h>
  38. #include <linux/netdevice.h>
  39. #include <linux/etherdevice.h>
  40. #include <linux/ethtool.h>
  41. #include <linux/skbuff.h>
  42. #include <linux/delay.h>
  43. #include <linux/device.h>
  44. #include <linux/init.h>
  45. #include <linux/bitops.h>
  46. #include <linux/jiffies.h>
  47. #include <asm/system.h>
  48. #include <asm/ecard.h>
  49. #include <asm/io.h>
  50. #define EI_SHIFT(x) (ei_local->reg_offset[x])
  51. #define ei_inb(_p) readb((void __iomem *)_p)
  52. #define ei_outb(_v,_p) writeb(_v,(void __iomem *)_p)
  53. #define ei_inb_p(_p) readb((void __iomem *)_p)
  54. #define ei_outb_p(_v,_p) writeb(_v,(void __iomem *)_p)
  55. #define NET_DEBUG 0
  56. #define DEBUG_INIT 2
  57. #define DRV_NAME "etherh"
  58. #define DRV_VERSION "1.11"
  59. static char version[] __initdata =
  60. "EtherH/EtherM Driver (c) 2002-2004 Russell King " DRV_VERSION "\n";
  61. #include "../lib8390.c"
  62. static unsigned int net_debug = NET_DEBUG;
  63. struct etherh_priv {
  64. void __iomem *ioc_fast;
  65. void __iomem *memc;
  66. void __iomem *dma_base;
  67. unsigned int id;
  68. void __iomem *ctrl_port;
  69. unsigned char ctrl;
  70. u32 supported;
  71. };
  72. struct etherh_data {
  73. unsigned long ns8390_offset;
  74. unsigned long dataport_offset;
  75. unsigned long ctrlport_offset;
  76. int ctrl_ioc;
  77. const char name[16];
  78. u32 supported;
  79. unsigned char tx_start_page;
  80. unsigned char stop_page;
  81. };
  82. MODULE_AUTHOR("Russell King");
  83. MODULE_DESCRIPTION("EtherH/EtherM driver");
  84. MODULE_LICENSE("GPL");
  85. #define ETHERH500_DATAPORT 0x800 /* MEMC */
  86. #define ETHERH500_NS8390 0x000 /* MEMC */
  87. #define ETHERH500_CTRLPORT 0x800 /* IOC */
  88. #define ETHERH600_DATAPORT 0x040 /* MEMC */
  89. #define ETHERH600_NS8390 0x800 /* MEMC */
  90. #define ETHERH600_CTRLPORT 0x200 /* MEMC */
  91. #define ETHERH_CP_IE 1
  92. #define ETHERH_CP_IF 2
  93. #define ETHERH_CP_HEARTBEAT 2
  94. #define ETHERH_TX_START_PAGE 1
  95. #define ETHERH_STOP_PAGE 127
  96. /*
  97. * These came from CK/TEW
  98. */
  99. #define ETHERM_DATAPORT 0x200 /* MEMC */
  100. #define ETHERM_NS8390 0x800 /* MEMC */
  101. #define ETHERM_CTRLPORT 0x23c /* MEMC */
  102. #define ETHERM_TX_START_PAGE 64
  103. #define ETHERM_STOP_PAGE 127
  104. /* ------------------------------------------------------------------------ */
  105. #define etherh_priv(dev) \
  106. ((struct etherh_priv *)(((char *)netdev_priv(dev)) + sizeof(struct ei_device)))
  107. static inline void etherh_set_ctrl(struct etherh_priv *eh, unsigned char mask)
  108. {
  109. unsigned char ctrl = eh->ctrl | mask;
  110. eh->ctrl = ctrl;
  111. writeb(ctrl, eh->ctrl_port);
  112. }
  113. static inline void etherh_clr_ctrl(struct etherh_priv *eh, unsigned char mask)
  114. {
  115. unsigned char ctrl = eh->ctrl & ~mask;
  116. eh->ctrl = ctrl;
  117. writeb(ctrl, eh->ctrl_port);
  118. }
  119. static inline unsigned int etherh_get_stat(struct etherh_priv *eh)
  120. {
  121. return readb(eh->ctrl_port);
  122. }
  123. static void etherh_irq_enable(ecard_t *ec, int irqnr)
  124. {
  125. struct etherh_priv *eh = ec->irq_data;
  126. etherh_set_ctrl(eh, ETHERH_CP_IE);
  127. }
  128. static void etherh_irq_disable(ecard_t *ec, int irqnr)
  129. {
  130. struct etherh_priv *eh = ec->irq_data;
  131. etherh_clr_ctrl(eh, ETHERH_CP_IE);
  132. }
  133. static expansioncard_ops_t etherh_ops = {
  134. .irqenable = etherh_irq_enable,
  135. .irqdisable = etherh_irq_disable,
  136. };
  137. static void
  138. etherh_setif(struct net_device *dev)
  139. {
  140. struct ei_device *ei_local = netdev_priv(dev);
  141. unsigned long flags;
  142. void __iomem *addr;
  143. local_irq_save(flags);
  144. /* set the interface type */
  145. switch (etherh_priv(dev)->id) {
  146. case PROD_I3_ETHERLAN600:
  147. case PROD_I3_ETHERLAN600A:
  148. addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
  149. switch (dev->if_port) {
  150. case IF_PORT_10BASE2:
  151. writeb((readb(addr) & 0xf8) | 1, addr);
  152. break;
  153. case IF_PORT_10BASET:
  154. writeb((readb(addr) & 0xf8), addr);
  155. break;
  156. }
  157. break;
  158. case PROD_I3_ETHERLAN500:
  159. switch (dev->if_port) {
  160. case IF_PORT_10BASE2:
  161. etherh_clr_ctrl(etherh_priv(dev), ETHERH_CP_IF);
  162. break;
  163. case IF_PORT_10BASET:
  164. etherh_set_ctrl(etherh_priv(dev), ETHERH_CP_IF);
  165. break;
  166. }
  167. break;
  168. default:
  169. break;
  170. }
  171. local_irq_restore(flags);
  172. }
  173. static int
  174. etherh_getifstat(struct net_device *dev)
  175. {
  176. struct ei_device *ei_local = netdev_priv(dev);
  177. void __iomem *addr;
  178. int stat = 0;
  179. switch (etherh_priv(dev)->id) {
  180. case PROD_I3_ETHERLAN600:
  181. case PROD_I3_ETHERLAN600A:
  182. addr = (void __iomem *)dev->base_addr + EN0_RCNTHI;
  183. switch (dev->if_port) {
  184. case IF_PORT_10BASE2:
  185. stat = 1;
  186. break;
  187. case IF_PORT_10BASET:
  188. stat = readb(addr) & 4;
  189. break;
  190. }
  191. break;
  192. case PROD_I3_ETHERLAN500:
  193. switch (dev->if_port) {
  194. case IF_PORT_10BASE2:
  195. stat = 1;
  196. break;
  197. case IF_PORT_10BASET:
  198. stat = etherh_get_stat(etherh_priv(dev)) & ETHERH_CP_HEARTBEAT;
  199. break;
  200. }
  201. break;
  202. default:
  203. stat = 0;
  204. break;
  205. }
  206. return stat != 0;
  207. }
  208. /*
  209. * Configure the interface. Note that we ignore the other
  210. * parts of ifmap, since its mostly meaningless for this driver.
  211. */
  212. static int etherh_set_config(struct net_device *dev, struct ifmap *map)
  213. {
  214. switch (map->port) {
  215. case IF_PORT_10BASE2:
  216. case IF_PORT_10BASET:
  217. /*
  218. * If the user explicitly sets the interface
  219. * media type, turn off automedia detection.
  220. */
  221. dev->flags &= ~IFF_AUTOMEDIA;
  222. dev->if_port = map->port;
  223. break;
  224. default:
  225. return -EINVAL;
  226. }
  227. etherh_setif(dev);
  228. return 0;
  229. }
  230. /*
  231. * Reset the 8390 (hard reset). Note that we can't actually do this.
  232. */
  233. static void
  234. etherh_reset(struct net_device *dev)
  235. {
  236. struct ei_device *ei_local = netdev_priv(dev);
  237. void __iomem *addr = (void __iomem *)dev->base_addr;
  238. writeb(E8390_NODMA+E8390_PAGE0+E8390_STOP, addr);
  239. /*
  240. * See if we need to change the interface type.
  241. * Note that we use 'interface_num' as a flag
  242. * to indicate that we need to change the media.
  243. */
  244. if (dev->flags & IFF_AUTOMEDIA && ei_local->interface_num) {
  245. ei_local->interface_num = 0;
  246. if (dev->if_port == IF_PORT_10BASET)
  247. dev->if_port = IF_PORT_10BASE2;
  248. else
  249. dev->if_port = IF_PORT_10BASET;
  250. etherh_setif(dev);
  251. }
  252. }
  253. /*
  254. * Write a block of data out to the 8390
  255. */
  256. static void
  257. etherh_block_output (struct net_device *dev, int count, const unsigned char *buf, int start_page)
  258. {
  259. struct ei_device *ei_local = netdev_priv(dev);
  260. unsigned long dma_start;
  261. void __iomem *dma_base, *addr;
  262. if (ei_local->dmaing) {
  263. printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
  264. " DMAstat %d irqlock %d\n", dev->name,
  265. ei_local->dmaing, ei_local->irqlock);
  266. return;
  267. }
  268. /*
  269. * Make sure we have a round number of bytes if we're in word mode.
  270. */
  271. if (count & 1 && ei_local->word16)
  272. count++;
  273. ei_local->dmaing = 1;
  274. addr = (void __iomem *)dev->base_addr;
  275. dma_base = etherh_priv(dev)->dma_base;
  276. count = (count + 1) & ~1;
  277. writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
  278. writeb (0x42, addr + EN0_RCNTLO);
  279. writeb (0x00, addr + EN0_RCNTHI);
  280. writeb (0x42, addr + EN0_RSARLO);
  281. writeb (0x00, addr + EN0_RSARHI);
  282. writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
  283. udelay (1);
  284. writeb (ENISR_RDC, addr + EN0_ISR);
  285. writeb (count, addr + EN0_RCNTLO);
  286. writeb (count >> 8, addr + EN0_RCNTHI);
  287. writeb (0, addr + EN0_RSARLO);
  288. writeb (start_page, addr + EN0_RSARHI);
  289. writeb (E8390_RWRITE | E8390_START, addr + E8390_CMD);
  290. if (ei_local->word16)
  291. writesw (dma_base, buf, count >> 1);
  292. else
  293. writesb (dma_base, buf, count);
  294. dma_start = jiffies;
  295. while ((readb (addr + EN0_ISR) & ENISR_RDC) == 0)
  296. if (time_after(jiffies, dma_start + 2*HZ/100)) { /* 20ms */
  297. printk(KERN_ERR "%s: timeout waiting for TX RDC\n",
  298. dev->name);
  299. etherh_reset (dev);
  300. __NS8390_init (dev, 1);
  301. break;
  302. }
  303. writeb (ENISR_RDC, addr + EN0_ISR);
  304. ei_local->dmaing = 0;
  305. }
  306. /*
  307. * Read a block of data from the 8390
  308. */
  309. static void
  310. etherh_block_input (struct net_device *dev, int count, struct sk_buff *skb, int ring_offset)
  311. {
  312. struct ei_device *ei_local = netdev_priv(dev);
  313. unsigned char *buf;
  314. void __iomem *dma_base, *addr;
  315. if (ei_local->dmaing) {
  316. printk(KERN_ERR "%s: DMAing conflict in etherh_block_input: "
  317. " DMAstat %d irqlock %d\n", dev->name,
  318. ei_local->dmaing, ei_local->irqlock);
  319. return;
  320. }
  321. ei_local->dmaing = 1;
  322. addr = (void __iomem *)dev->base_addr;
  323. dma_base = etherh_priv(dev)->dma_base;
  324. buf = skb->data;
  325. writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
  326. writeb (count, addr + EN0_RCNTLO);
  327. writeb (count >> 8, addr + EN0_RCNTHI);
  328. writeb (ring_offset, addr + EN0_RSARLO);
  329. writeb (ring_offset >> 8, addr + EN0_RSARHI);
  330. writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
  331. if (ei_local->word16) {
  332. readsw (dma_base, buf, count >> 1);
  333. if (count & 1)
  334. buf[count - 1] = readb (dma_base);
  335. } else
  336. readsb (dma_base, buf, count);
  337. writeb (ENISR_RDC, addr + EN0_ISR);
  338. ei_local->dmaing = 0;
  339. }
  340. /*
  341. * Read a header from the 8390
  342. */
  343. static void
  344. etherh_get_header (struct net_device *dev, struct e8390_pkt_hdr *hdr, int ring_page)
  345. {
  346. struct ei_device *ei_local = netdev_priv(dev);
  347. void __iomem *dma_base, *addr;
  348. if (ei_local->dmaing) {
  349. printk(KERN_ERR "%s: DMAing conflict in etherh_get_header: "
  350. " DMAstat %d irqlock %d\n", dev->name,
  351. ei_local->dmaing, ei_local->irqlock);
  352. return;
  353. }
  354. ei_local->dmaing = 1;
  355. addr = (void __iomem *)dev->base_addr;
  356. dma_base = etherh_priv(dev)->dma_base;
  357. writeb (E8390_NODMA | E8390_PAGE0 | E8390_START, addr + E8390_CMD);
  358. writeb (sizeof (*hdr), addr + EN0_RCNTLO);
  359. writeb (0, addr + EN0_RCNTHI);
  360. writeb (0, addr + EN0_RSARLO);
  361. writeb (ring_page, addr + EN0_RSARHI);
  362. writeb (E8390_RREAD | E8390_START, addr + E8390_CMD);
  363. if (ei_local->word16)
  364. readsw (dma_base, hdr, sizeof (*hdr) >> 1);
  365. else
  366. readsb (dma_base, hdr, sizeof (*hdr));
  367. writeb (ENISR_RDC, addr + EN0_ISR);
  368. ei_local->dmaing = 0;
  369. }
  370. /*
  371. * Open/initialize the board. This is called (in the current kernel)
  372. * sometime after booting when the 'ifconfig' program is run.
  373. *
  374. * This routine should set everything up anew at each open, even
  375. * registers that "should" only need to be set once at boot, so that
  376. * there is non-reboot way to recover if something goes wrong.
  377. */
  378. static int
  379. etherh_open(struct net_device *dev)
  380. {
  381. struct ei_device *ei_local = netdev_priv(dev);
  382. if (!is_valid_ether_addr(dev->dev_addr)) {
  383. printk(KERN_WARNING "%s: invalid ethernet MAC address\n",
  384. dev->name);
  385. return -EINVAL;
  386. }
  387. if (request_irq(dev->irq, __ei_interrupt, 0, dev->name, dev))
  388. return -EAGAIN;
  389. /*
  390. * Make sure that we aren't going to change the
  391. * media type on the next reset - we are about to
  392. * do automedia manually now.
  393. */
  394. ei_local->interface_num = 0;
  395. /*
  396. * If we are doing automedia detection, do it now.
  397. * This is more reliable than the 8390's detection.
  398. */
  399. if (dev->flags & IFF_AUTOMEDIA) {
  400. dev->if_port = IF_PORT_10BASET;
  401. etherh_setif(dev);
  402. mdelay(1);
  403. if (!etherh_getifstat(dev)) {
  404. dev->if_port = IF_PORT_10BASE2;
  405. etherh_setif(dev);
  406. }
  407. } else
  408. etherh_setif(dev);
  409. etherh_reset(dev);
  410. __ei_open(dev);
  411. return 0;
  412. }
  413. /*
  414. * The inverse routine to etherh_open().
  415. */
  416. static int
  417. etherh_close(struct net_device *dev)
  418. {
  419. __ei_close (dev);
  420. free_irq (dev->irq, dev);
  421. return 0;
  422. }
  423. /*
  424. * Initialisation
  425. */
  426. static void __init etherh_banner(void)
  427. {
  428. static int version_printed;
  429. if (net_debug && version_printed++ == 0)
  430. printk(KERN_INFO "%s", version);
  431. }
  432. /*
  433. * Read the ethernet address string from the on board rom.
  434. * This is an ascii string...
  435. */
  436. static int __init etherh_addr(char *addr, struct expansion_card *ec)
  437. {
  438. struct in_chunk_dir cd;
  439. char *s;
  440. if (!ecard_readchunk(&cd, ec, 0xf5, 0)) {
  441. printk(KERN_ERR "%s: unable to read podule description string\n",
  442. dev_name(&ec->dev));
  443. goto no_addr;
  444. }
  445. s = strchr(cd.d.string, '(');
  446. if (s) {
  447. int i;
  448. for (i = 0; i < 6; i++) {
  449. addr[i] = simple_strtoul(s + 1, &s, 0x10);
  450. if (*s != (i == 5? ')' : ':'))
  451. break;
  452. }
  453. if (i == 6)
  454. return 0;
  455. }
  456. printk(KERN_ERR "%s: unable to parse MAC address: %s\n",
  457. dev_name(&ec->dev), cd.d.string);
  458. no_addr:
  459. return -ENODEV;
  460. }
  461. /*
  462. * Create an ethernet address from the system serial number.
  463. */
  464. static int __init etherm_addr(char *addr)
  465. {
  466. unsigned int serial;
  467. if (system_serial_low == 0 && system_serial_high == 0)
  468. return -ENODEV;
  469. serial = system_serial_low | system_serial_high;
  470. addr[0] = 0;
  471. addr[1] = 0;
  472. addr[2] = 0xa4;
  473. addr[3] = 0x10 + (serial >> 24);
  474. addr[4] = serial >> 16;
  475. addr[5] = serial >> 8;
  476. return 0;
  477. }
  478. static void etherh_get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
  479. {
  480. strlcpy(info->driver, DRV_NAME, sizeof(info->driver));
  481. strlcpy(info->version, DRV_VERSION, sizeof(info->version));
  482. strlcpy(info->bus_info, dev_name(dev->dev.parent),
  483. sizeof(info->bus_info));
  484. }
  485. static int etherh_get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  486. {
  487. cmd->supported = etherh_priv(dev)->supported;
  488. cmd->speed = SPEED_10;
  489. cmd->duplex = DUPLEX_HALF;
  490. cmd->port = dev->if_port == IF_PORT_10BASET ? PORT_TP : PORT_BNC;
  491. cmd->autoneg = dev->flags & IFF_AUTOMEDIA ? AUTONEG_ENABLE : AUTONEG_DISABLE;
  492. return 0;
  493. }
  494. static int etherh_set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  495. {
  496. switch (cmd->autoneg) {
  497. case AUTONEG_ENABLE:
  498. dev->flags |= IFF_AUTOMEDIA;
  499. break;
  500. case AUTONEG_DISABLE:
  501. switch (cmd->port) {
  502. case PORT_TP:
  503. dev->if_port = IF_PORT_10BASET;
  504. break;
  505. case PORT_BNC:
  506. dev->if_port = IF_PORT_10BASE2;
  507. break;
  508. default:
  509. return -EINVAL;
  510. }
  511. dev->flags &= ~IFF_AUTOMEDIA;
  512. break;
  513. default:
  514. return -EINVAL;
  515. }
  516. etherh_setif(dev);
  517. return 0;
  518. }
  519. static const struct ethtool_ops etherh_ethtool_ops = {
  520. .get_settings = etherh_get_settings,
  521. .set_settings = etherh_set_settings,
  522. .get_drvinfo = etherh_get_drvinfo,
  523. };
  524. static const struct net_device_ops etherh_netdev_ops = {
  525. .ndo_open = etherh_open,
  526. .ndo_stop = etherh_close,
  527. .ndo_set_config = etherh_set_config,
  528. .ndo_start_xmit = __ei_start_xmit,
  529. .ndo_tx_timeout = __ei_tx_timeout,
  530. .ndo_get_stats = __ei_get_stats,
  531. .ndo_set_multicast_list = __ei_set_multicast_list,
  532. .ndo_validate_addr = eth_validate_addr,
  533. .ndo_set_mac_address = eth_mac_addr,
  534. .ndo_change_mtu = eth_change_mtu,
  535. #ifdef CONFIG_NET_POLL_CONTROLLER
  536. .ndo_poll_controller = __ei_poll,
  537. #endif
  538. };
  539. static u32 etherh_regoffsets[16];
  540. static u32 etherm_regoffsets[16];
  541. static int __init
  542. etherh_probe(struct expansion_card *ec, const struct ecard_id *id)
  543. {
  544. const struct etherh_data *data = id->data;
  545. struct ei_device *ei_local;
  546. struct net_device *dev;
  547. struct etherh_priv *eh;
  548. int ret;
  549. etherh_banner();
  550. ret = ecard_request_resources(ec);
  551. if (ret)
  552. goto out;
  553. dev = ____alloc_ei_netdev(sizeof(struct etherh_priv));
  554. if (!dev) {
  555. ret = -ENOMEM;
  556. goto release;
  557. }
  558. SET_NETDEV_DEV(dev, &ec->dev);
  559. dev->netdev_ops = &etherh_netdev_ops;
  560. dev->irq = ec->irq;
  561. dev->ethtool_ops = &etherh_ethtool_ops;
  562. if (data->supported & SUPPORTED_Autoneg)
  563. dev->flags |= IFF_AUTOMEDIA;
  564. if (data->supported & SUPPORTED_TP) {
  565. dev->flags |= IFF_PORTSEL;
  566. dev->if_port = IF_PORT_10BASET;
  567. } else if (data->supported & SUPPORTED_BNC) {
  568. dev->flags |= IFF_PORTSEL;
  569. dev->if_port = IF_PORT_10BASE2;
  570. } else
  571. dev->if_port = IF_PORT_UNKNOWN;
  572. eh = etherh_priv(dev);
  573. eh->supported = data->supported;
  574. eh->ctrl = 0;
  575. eh->id = ec->cid.product;
  576. eh->memc = ecardm_iomap(ec, ECARD_RES_MEMC, 0, PAGE_SIZE);
  577. if (!eh->memc) {
  578. ret = -ENOMEM;
  579. goto free;
  580. }
  581. eh->ctrl_port = eh->memc;
  582. if (data->ctrl_ioc) {
  583. eh->ioc_fast = ecardm_iomap(ec, ECARD_RES_IOCFAST, 0, PAGE_SIZE);
  584. if (!eh->ioc_fast) {
  585. ret = -ENOMEM;
  586. goto free;
  587. }
  588. eh->ctrl_port = eh->ioc_fast;
  589. }
  590. dev->base_addr = (unsigned long)eh->memc + data->ns8390_offset;
  591. eh->dma_base = eh->memc + data->dataport_offset;
  592. eh->ctrl_port += data->ctrlport_offset;
  593. /*
  594. * IRQ and control port handling - only for non-NIC slot cards.
  595. */
  596. if (ec->slot_no != 8) {
  597. ecard_setirq(ec, &etherh_ops, eh);
  598. } else {
  599. /*
  600. * If we're in the NIC slot, make sure the IRQ is enabled
  601. */
  602. etherh_set_ctrl(eh, ETHERH_CP_IE);
  603. }
  604. ei_local = netdev_priv(dev);
  605. spin_lock_init(&ei_local->page_lock);
  606. if (ec->cid.product == PROD_ANT_ETHERM) {
  607. etherm_addr(dev->dev_addr);
  608. ei_local->reg_offset = etherm_regoffsets;
  609. } else {
  610. etherh_addr(dev->dev_addr, ec);
  611. ei_local->reg_offset = etherh_regoffsets;
  612. }
  613. ei_local->name = dev->name;
  614. ei_local->word16 = 1;
  615. ei_local->tx_start_page = data->tx_start_page;
  616. ei_local->rx_start_page = ei_local->tx_start_page + TX_PAGES;
  617. ei_local->stop_page = data->stop_page;
  618. ei_local->reset_8390 = etherh_reset;
  619. ei_local->block_input = etherh_block_input;
  620. ei_local->block_output = etherh_block_output;
  621. ei_local->get_8390_hdr = etherh_get_header;
  622. ei_local->interface_num = 0;
  623. etherh_reset(dev);
  624. __NS8390_init(dev, 0);
  625. ret = register_netdev(dev);
  626. if (ret)
  627. goto free;
  628. printk(KERN_INFO "%s: %s in slot %d, %pM\n",
  629. dev->name, data->name, ec->slot_no, dev->dev_addr);
  630. ecard_set_drvdata(ec, dev);
  631. return 0;
  632. free:
  633. free_netdev(dev);
  634. release:
  635. ecard_release_resources(ec);
  636. out:
  637. return ret;
  638. }
  639. static void __devexit etherh_remove(struct expansion_card *ec)
  640. {
  641. struct net_device *dev = ecard_get_drvdata(ec);
  642. ecard_set_drvdata(ec, NULL);
  643. unregister_netdev(dev);
  644. free_netdev(dev);
  645. ecard_release_resources(ec);
  646. }
  647. static struct etherh_data etherm_data = {
  648. .ns8390_offset = ETHERM_NS8390,
  649. .dataport_offset = ETHERM_NS8390 + ETHERM_DATAPORT,
  650. .ctrlport_offset = ETHERM_NS8390 + ETHERM_CTRLPORT,
  651. .name = "ANT EtherM",
  652. .supported = SUPPORTED_10baseT_Half,
  653. .tx_start_page = ETHERM_TX_START_PAGE,
  654. .stop_page = ETHERM_STOP_PAGE,
  655. };
  656. static struct etherh_data etherlan500_data = {
  657. .ns8390_offset = ETHERH500_NS8390,
  658. .dataport_offset = ETHERH500_NS8390 + ETHERH500_DATAPORT,
  659. .ctrlport_offset = ETHERH500_CTRLPORT,
  660. .ctrl_ioc = 1,
  661. .name = "i3 EtherH 500",
  662. .supported = SUPPORTED_10baseT_Half,
  663. .tx_start_page = ETHERH_TX_START_PAGE,
  664. .stop_page = ETHERH_STOP_PAGE,
  665. };
  666. static struct etherh_data etherlan600_data = {
  667. .ns8390_offset = ETHERH600_NS8390,
  668. .dataport_offset = ETHERH600_NS8390 + ETHERH600_DATAPORT,
  669. .ctrlport_offset = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
  670. .name = "i3 EtherH 600",
  671. .supported = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
  672. .tx_start_page = ETHERH_TX_START_PAGE,
  673. .stop_page = ETHERH_STOP_PAGE,
  674. };
  675. static struct etherh_data etherlan600a_data = {
  676. .ns8390_offset = ETHERH600_NS8390,
  677. .dataport_offset = ETHERH600_NS8390 + ETHERH600_DATAPORT,
  678. .ctrlport_offset = ETHERH600_NS8390 + ETHERH600_CTRLPORT,
  679. .name = "i3 EtherH 600A",
  680. .supported = SUPPORTED_10baseT_Half | SUPPORTED_TP | SUPPORTED_BNC | SUPPORTED_Autoneg,
  681. .tx_start_page = ETHERH_TX_START_PAGE,
  682. .stop_page = ETHERH_STOP_PAGE,
  683. };
  684. static const struct ecard_id etherh_ids[] = {
  685. { MANU_ANT, PROD_ANT_ETHERM, &etherm_data },
  686. { MANU_I3, PROD_I3_ETHERLAN500, &etherlan500_data },
  687. { MANU_I3, PROD_I3_ETHERLAN600, &etherlan600_data },
  688. { MANU_I3, PROD_I3_ETHERLAN600A, &etherlan600a_data },
  689. { 0xffff, 0xffff }
  690. };
  691. static struct ecard_driver etherh_driver = {
  692. .probe = etherh_probe,
  693. .remove = __devexit_p(etherh_remove),
  694. .id_table = etherh_ids,
  695. .drv = {
  696. .name = DRV_NAME,
  697. },
  698. };
  699. static int __init etherh_init(void)
  700. {
  701. int i;
  702. for (i = 0; i < 16; i++) {
  703. etherh_regoffsets[i] = i << 2;
  704. etherm_regoffsets[i] = i << 5;
  705. }
  706. return ecard_register_driver(&etherh_driver);
  707. }
  708. static void __exit etherh_exit(void)
  709. {
  710. ecard_remove_driver(&etherh_driver);
  711. }
  712. module_init(etherh_init);
  713. module_exit(etherh_exit);