ni65.c
上传用户:jlfgdled
上传日期:2013-04-10
资源大小:33168k
文件大小:29k
源码类别:

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * ni6510 (am7990 'lance' chip) driver for Linux-net-3
  3.  * BETAcode v0.71 (96/09/29) for 2.0.0 (or later)
  4.  * copyrights (c) 1994,1995,1996 by M.Hipp
  5.  *
  6.  * This driver can handle the old ni6510 board and the newer ni6510
  7.  * EtherBlaster. (probably it also works with every full NE2100
  8.  * compatible card)
  9.  *
  10.  * To compile as module, type:
  11.  *     gcc -O2 -fomit-frame-pointer -m486 -D__KERNEL__ -DMODULE -c ni65.c
  12.  * driver probes: io: 0x360,0x300,0x320,0x340 / dma: 3,5,6,7
  13.  *
  14.  * This is an extension to the Linux operating system, and is covered by the
  15.  * same GNU General Public License that covers the Linux-kernel.
  16.  *
  17.  * comments/bugs/suggestions can be sent to:
  18.  *   Michael Hipp
  19.  *   email: hippm@informatik.uni-tuebingen.de
  20.  *
  21.  * sources:
  22.  *   some things are from the 'ni6510-packet-driver for dos by Russ Nelson'
  23.  *   and from the original drivers by D.Becker
  24.  *
  25.  * known problems:
  26.  *   - on some PCI boards (including my own) the card/board/ISA-bridge has
  27.  *     problems with bus master DMA. This results in lotsa overruns.
  28.  *     It may help to '#define RCV_PARANOIA_CHECK' or try to #undef
  29.  *     the XMT and RCV_VIA_SKB option .. this reduces driver performance.
  30.  *     Or just play with your BIOS options to optimize ISA-DMA access.
  31.  *     Maybe you also wanna play with the LOW_PERFORAMCE and MID_PERFORMANCE
  32.  *     defines -> please report me your experience then
  33.  *   - Harald reported for ASUS SP3G mainboards, that you should use
  34.  *     the 'optimal settings' from the user's manual on page 3-12!
  35.  *
  36.  * credits:
  37.  *   thanx to Jason Sullivan for sending me a ni6510 card!
  38.  *   lot of debug runs with ASUS SP3G Boards (Intel Saturn) by Harald Koenig
  39.  *
  40.  * simple performance test: (486DX-33/Ni6510-EB receives from 486DX4-100/Ni6510-EB)
  41.  *    average: FTP -> 8384421 bytes received in 8.5 seconds
  42.  *           (no RCV_VIA_SKB,no XMT_VIA_SKB,PARANOIA_CHECK,4 XMIT BUFS, 8 RCV_BUFFS)
  43.  *    peak: FTP -> 8384421 bytes received in 7.5 seconds
  44.  *           (RCV_VIA_SKB,XMT_VIA_SKB,no PARANOIA_CHECK,1(!) XMIT BUF, 16 RCV BUFFS)
  45.  */
  46. /*
  47.  * 99.Jun.8: added support for /proc/net/dev byte count for xosview (HK)
  48.  * 96.Sept.29: virt_to_bus stuff added for new memory modell
  49.  * 96.April.29: Added Harald Koenig's Patches (MH)
  50.  * 96.April.13: enhanced error handling .. more tests (MH)
  51.  * 96.April.5/6: a lot of performance tests. Got it stable now (hopefully) (MH)
  52.  * 96.April.1: (no joke ;) .. added EtherBlaster and Module support (MH)
  53.  * 96.Feb.19: fixed a few bugs .. cleanups .. tested for 1.3.66 (MH)
  54.  *            hopefully no more 16MB limit
  55.  *
  56.  * 95.Nov.18: multicast tweaked (AC).
  57.  *
  58.  * 94.Aug.22: changes in xmit_intr (ack more than one xmitted-packet), ni65_send_packet (p->lock) (MH)
  59.  *
  60.  * 94.July.16: fixed bugs in recv_skb and skb-alloc stuff  (MH)
  61.  */
  62. #include <linux/kernel.h>
  63. #include <linux/sched.h>
  64. #include <linux/string.h>
  65. #include <linux/ptrace.h>
  66. #include <linux/errno.h>
  67. #include <linux/ioport.h>
  68. #include <linux/slab.h>
  69. #include <linux/interrupt.h>
  70. #include <linux/delay.h>
  71. #include <linux/init.h>
  72. #include <asm/bitops.h>
  73. #include <asm/io.h>
  74. #include <asm/dma.h>
  75. #include <linux/netdevice.h>
  76. #include <linux/etherdevice.h>
  77. #include <linux/skbuff.h>
  78. #include <linux/version.h>
  79. #include <linux/module.h>
  80. #include "ni65.h"
  81. /*
  82.  * the current setting allows an acceptable performance
  83.  * for 'RCV_PARANOIA_CHECK' read the 'known problems' part in
  84.  * the header of this file
  85.  * 'invert' the defines for max. performance. This may cause DMA problems
  86.  * on some boards (e.g on my ASUS SP3G)
  87.  */
  88. #undef XMT_VIA_SKB
  89. #undef RCV_VIA_SKB
  90. #define RCV_PARANOIA_CHECK
  91. #define MID_PERFORMANCE
  92. #if   defined( LOW_PERFORMANCE )
  93.  static int isa0=7,isa1=7,csr80=0x0c10;
  94. #elif defined( MID_PERFORMANCE )
  95.  static int isa0=5,isa1=5,csr80=0x2810;
  96. #else /* high performance */
  97.  static int isa0=4,isa1=4,csr80=0x0017;
  98. #endif
  99. /*
  100.  * a few card/vendor specific defines
  101.  */
  102. #define NI65_ID0    0x00
  103. #define NI65_ID1    0x55
  104. #define NI65_EB_ID0 0x52
  105. #define NI65_EB_ID1 0x44
  106. #define NE2100_ID0  0x57
  107. #define NE2100_ID1  0x57
  108. #define PORT p->cmdr_addr
  109. /*
  110.  * buffer configuration
  111.  */
  112. #if 1
  113. #define RMDNUM 16
  114. #define RMDNUMMASK 0x80000000
  115. #else
  116. #define RMDNUM 8
  117. #define RMDNUMMASK 0x60000000 /* log2(RMDNUM)<<29 */
  118. #endif
  119. #if 0
  120. #define TMDNUM 1
  121. #define TMDNUMMASK 0x00000000
  122. #else
  123. #define TMDNUM 4
  124. #define TMDNUMMASK 0x40000000 /* log2(TMDNUM)<<29 */
  125. #endif
  126. /* slightly oversized */
  127. #define R_BUF_SIZE 1544
  128. #define T_BUF_SIZE 1544
  129. /*
  130.  * lance register defines
  131.  */
  132. #define L_DATAREG 0x00
  133. #define L_ADDRREG 0x02
  134. #define L_RESET   0x04
  135. #define L_CONFIG  0x05
  136. #define L_BUSIF   0x06
  137. /*
  138.  * to access the lance/am7990-regs, you have to write
  139.  * reg-number into L_ADDRREG, then you can access it using L_DATAREG
  140.  */
  141. #define CSR0  0x00
  142. #define CSR1  0x01
  143. #define CSR2  0x02
  144. #define CSR3  0x03
  145. #define INIT_RING_BEFORE_START 0x1
  146. #define FULL_RESET_ON_ERROR 0x2
  147. #if 0
  148. #define writereg(val,reg) {outw(reg,PORT+L_ADDRREG);inw(PORT+L_ADDRREG); 
  149.                            outw(val,PORT+L_DATAREG);inw(PORT+L_DATAREG);}
  150. #define readreg(reg) (outw(reg,PORT+L_ADDRREG),inw(PORT+L_ADDRREG),
  151.                        inw(PORT+L_DATAREG))
  152. #if 0
  153. #define writedatareg(val) {outw(val,PORT+L_DATAREG);inw(PORT+L_DATAREG);}
  154. #else
  155. #define writedatareg(val) {  writereg(val,CSR0); }
  156. #endif
  157. #else
  158. #define writereg(val,reg) {outw(reg,PORT+L_ADDRREG);outw(val,PORT+L_DATAREG);}
  159. #define readreg(reg) (outw(reg,PORT+L_ADDRREG),inw(PORT+L_DATAREG))
  160. #define writedatareg(val) { writereg(val,CSR0); }
  161. #endif
  162. static unsigned char ni_vendor[] = { 0x02,0x07,0x01 };
  163. static struct card {
  164. unsigned char id0,id1;
  165. short id_offset;
  166. short total_size;
  167. short cmd_offset;
  168. short addr_offset;
  169. unsigned char *vendor_id;
  170. char *cardname;
  171. unsigned char config;
  172. } cards[] = {
  173. { NI65_ID0,NI65_ID1,0x0e,0x10,0x0,0x8,ni_vendor,"ni6510", 0x1 } ,
  174. { NI65_EB_ID0,NI65_EB_ID1,0x0e,0x18,0x10,0x0,ni_vendor,"ni6510 EtherBlaster", 0x2 } ,
  175. { NE2100_ID0,NE2100_ID1,0x0e,0x18,0x10,0x0,NULL,"generic NE2100", 0x0 }
  176. };
  177. #define NUM_CARDS 3
  178. struct priv
  179. {
  180. struct rmd rmdhead[RMDNUM];
  181. struct tmd tmdhead[TMDNUM];
  182. struct init_block ib;
  183. int rmdnum;
  184. int tmdnum,tmdlast;
  185. #ifdef RCV_VIA_SKB
  186. struct sk_buff *recv_skb[RMDNUM];
  187. #else
  188. void *recvbounce[RMDNUM];
  189. #endif
  190. #ifdef XMT_VIA_SKB
  191. struct sk_buff *tmd_skb[TMDNUM];
  192. #endif
  193. void *tmdbounce[TMDNUM];
  194. int tmdbouncenum;
  195. int lock,xmit_queued;
  196. struct net_device_stats stats;
  197. void *self;
  198. int cmdr_addr;
  199. int cardno;
  200. int features;
  201. };
  202. static int  ni65_probe1(struct net_device *dev,int);
  203. static void ni65_interrupt(int irq, void * dev_id, struct pt_regs *regs);
  204. static void ni65_recv_intr(struct net_device *dev,int);
  205. static void ni65_xmit_intr(struct net_device *dev,int);
  206. static int  ni65_open(struct net_device *dev);
  207. static int  ni65_lance_reinit(struct net_device *dev);
  208. static void ni65_init_lance(struct priv *p,unsigned char*,int,int);
  209. static int  ni65_send_packet(struct sk_buff *skb, struct net_device *dev);
  210. static void  ni65_timeout(struct net_device *dev);
  211. static int  ni65_close(struct net_device *dev);
  212. static int  ni65_alloc_buffer(struct net_device *dev);
  213. static void ni65_free_buffer(struct priv *p);
  214. static struct net_device_stats *ni65_get_stats(struct net_device *);
  215. static void set_multicast_list(struct net_device *dev);
  216. static int irqtab[] __initdata = { 9,12,15,5 }; /* irq config-translate */
  217. static int dmatab[] __initdata = { 0,3,5,6,7 }; /* dma config-translate and autodetect */
  218. static int debuglevel = 1;
  219. /*
  220.  * set 'performance' registers .. we must STOP lance for that
  221.  */
  222. static void ni65_set_performance(struct priv *p)
  223. {
  224. writereg(CSR0_STOP | CSR0_CLRALL,CSR0); /* STOP */
  225. if( !(cards[p->cardno].config & 0x02) )
  226. return;
  227. outw(80,PORT+L_ADDRREG);
  228. if(inw(PORT+L_ADDRREG) != 80)
  229. return;
  230. writereg( (csr80 & 0x3fff) ,80); /* FIFO watermarks */
  231. outw(0,PORT+L_ADDRREG);
  232. outw((short)isa0,PORT+L_BUSIF); /* write ISA 0: DMA_R : isa0 * 50ns */
  233. outw(1,PORT+L_ADDRREG);
  234. outw((short)isa1,PORT+L_BUSIF); /* write ISA 1: DMA_W : isa1 * 50ns */
  235. outw(CSR0,PORT+L_ADDRREG); /* switch back to CSR0 */
  236. }
  237. /*
  238.  * open interface (up)
  239.  */
  240. static int ni65_open(struct net_device *dev)
  241. {
  242. struct priv *p = (struct priv *) dev->priv;
  243. int irqval = request_irq(dev->irq, &ni65_interrupt,0,
  244.                         cards[p->cardno].cardname,dev);
  245. if (irqval) {
  246. printk ("%s: unable to get IRQ %d (irqval=%d).n",
  247.           dev->name,dev->irq, irqval);
  248. return -EAGAIN;
  249. }
  250. if(ni65_lance_reinit(dev))
  251. {
  252. netif_start_queue(dev);
  253. MOD_INC_USE_COUNT;
  254. return 0;
  255. }
  256. else
  257. {
  258. free_irq(dev->irq,dev);
  259. return -EAGAIN;
  260. }
  261. }
  262. /*
  263.  * close interface (down)
  264.  */
  265. static int ni65_close(struct net_device *dev)
  266. {
  267. struct priv *p = (struct priv *) dev->priv;
  268. netif_stop_queue(dev);
  269. outw(inw(PORT+L_RESET),PORT+L_RESET); /* that's the hard way */
  270. #ifdef XMT_VIA_SKB
  271. {
  272. int i;
  273. for(i=0;i<TMDNUM;i++)
  274. {
  275. if(p->tmd_skb[i]) {
  276. dev_kfree_skb(p->tmd_skb[i]);
  277. p->tmd_skb[i] = NULL;
  278. }
  279. }
  280. }
  281. #endif
  282. free_irq(dev->irq,dev);
  283. MOD_DEC_USE_COUNT;
  284. return 0;
  285. }
  286. /*
  287.  * Probe The Card (not the lance-chip)
  288.  */
  289. #ifdef MODULE
  290. static
  291. #endif
  292. int __init ni65_probe(struct net_device *dev)
  293. {
  294. int *port;
  295. static int ports[] = {0x360,0x300,0x320,0x340, 0};
  296. if (dev->base_addr > 0x1ff)          /* Check a single specified location. */
  297.  return ni65_probe1(dev, dev->base_addr);
  298. else if (dev->base_addr > 0)         /* Don't probe at all. */
  299.  return -ENXIO;
  300. for (port = ports; *port; port++)
  301. {
  302. if (ni65_probe1(dev, *port) == 0)
  303.  return 0;
  304. }
  305. return -ENODEV;
  306. }
  307. /*
  308.  * this is the real card probe ..
  309.  */
  310. static int __init ni65_probe1(struct net_device *dev,int ioaddr)
  311. {
  312. int i,j;
  313. struct priv *p;
  314. unsigned long flags;
  315. for(i=0;i<NUM_CARDS;i++) {
  316. if(!request_region(ioaddr, cards[i].total_size, cards[i].cardname))
  317. continue;
  318. if(cards[i].id_offset >= 0) {
  319. if(inb(ioaddr+cards[i].id_offset+0) != cards[i].id0 ||
  320.  inb(ioaddr+cards[i].id_offset+1) != cards[i].id1) {
  321.  release_region(ioaddr, cards[i].total_size);
  322.  continue;
  323. }
  324. }
  325. if(cards[i].vendor_id) {
  326. for(j=0;j<3;j++)
  327. if(inb(ioaddr+cards[i].addr_offset+j) != cards[i].vendor_id[j]) {
  328. release_region(ioaddr, cards[i].total_size);
  329. continue;
  330.   }
  331. }
  332. break;
  333. }
  334. if(i == NUM_CARDS)
  335. return -ENODEV;
  336. for(j=0;j<6;j++)
  337. dev->dev_addr[j] = inb(ioaddr+cards[i].addr_offset+j);
  338. if( (j=ni65_alloc_buffer(dev)) < 0) {
  339. release_region(ioaddr, cards[i].total_size);
  340. return j;
  341. }
  342. p = (struct priv *) dev->priv;
  343. p->cmdr_addr = ioaddr + cards[i].cmd_offset;
  344. p->cardno = i;
  345. printk("%s: %s found at %#3x, ", dev->name, cards[p->cardno].cardname , ioaddr);
  346. outw(inw(PORT+L_RESET),PORT+L_RESET); /* first: reset the card */
  347. if( (j=readreg(CSR0)) != 0x4) {
  348.  printk(KERN_ERR "can't RESET card: %04xn",j);
  349.  ni65_free_buffer(p);
  350.  release_region(ioaddr, cards[p->cardno].total_size);
  351.  return -EAGAIN;
  352. }
  353. outw(88,PORT+L_ADDRREG);
  354. if(inw(PORT+L_ADDRREG) == 88) {
  355. unsigned long v;
  356. v = inw(PORT+L_DATAREG);
  357. v <<= 16;
  358. outw(89,PORT+L_ADDRREG);
  359. v |= inw(PORT+L_DATAREG);
  360. printk("Version %#08lx, ",v);
  361. p->features = INIT_RING_BEFORE_START;
  362. }
  363. else {
  364. printk("ancient LANCE, ");
  365. p->features = 0x0;
  366. }
  367. if(test_bit(0,&cards[i].config)) {
  368. dev->irq = irqtab[(inw(ioaddr+L_CONFIG)>>2)&3];
  369. dev->dma = dmatab[inw(ioaddr+L_CONFIG)&3];
  370. printk("IRQ %d (from card), DMA %d (from card).n",dev->irq,dev->dma);
  371. }
  372. else {
  373. if(dev->dma == 0) {
  374. /* 'stuck test' from lance.c */
  375. int dma_channels = ((inb(DMA1_STAT_REG) >> 4) & 0x0f) | (inb(DMA2_STAT_REG) & 0xf0);
  376. for(i=1;i<5;i++) {
  377. int dma = dmatab[i];
  378. if(test_bit(dma,&dma_channels) || request_dma(dma,"ni6510"))
  379. continue;
  380. flags=claim_dma_lock();
  381. disable_dma(dma);
  382. set_dma_mode(dma,DMA_MODE_CASCADE);
  383. enable_dma(dma);
  384. release_dma_lock(flags);
  385. ni65_init_lance(p,dev->dev_addr,0,0); /* trigger memory access */
  386. flags=claim_dma_lock();
  387. disable_dma(dma);
  388. free_dma(dma);
  389. release_dma_lock(flags);
  390. if(readreg(CSR0) & CSR0_IDON)
  391. break;
  392. }
  393. if(i == 5) {
  394. printk("Can't detect DMA channel!n");
  395. ni65_free_buffer(p);
  396. release_region(ioaddr, cards[p->cardno].total_size);
  397. return -EAGAIN;
  398. }
  399. dev->dma = dmatab[i];
  400. printk("DMA %d (autodetected), ",dev->dma);
  401. }
  402. else
  403. printk("DMA %d (assigned), ",dev->dma);
  404. if(dev->irq < 2)
  405. {
  406. ni65_init_lance(p,dev->dev_addr,0,0);
  407. autoirq_setup(0);
  408. writereg(CSR0_INIT|CSR0_INEA,CSR0); /* trigger interrupt */
  409. if(!(dev->irq = autoirq_report(2)))
  410. {
  411. printk("Failed to detect IRQ line!n");
  412. ni65_free_buffer(p);
  413. release_region(ioaddr, cards[p->cardno].total_size);
  414. return -EAGAIN;
  415. }
  416. printk("IRQ %d (autodetected).n",dev->irq);
  417. }
  418. else
  419. printk("IRQ %d (assigned).n",dev->irq);
  420. }
  421. if(request_dma(dev->dma, cards[p->cardno].cardname ) != 0)
  422. {
  423. printk("%s: Can't request dma-channel %dn",dev->name,(int) dev->dma);
  424. ni65_free_buffer(p);
  425. release_region(ioaddr, cards[p->cardno].total_size);
  426. return -EAGAIN;
  427. }
  428. dev->base_addr = ioaddr;
  429. dev->open = ni65_open;
  430. dev->stop = ni65_close;
  431. dev->hard_start_xmit = ni65_send_packet;
  432. dev->tx_timeout = ni65_timeout;
  433. dev->watchdog_timeo = HZ/2;
  434. dev->get_stats = ni65_get_stats;
  435. dev->set_multicast_list = set_multicast_list;
  436. ether_setup(dev);
  437. return 0; /* everything is OK */
  438. }
  439. /*
  440.  * set lance register and trigger init
  441.  */
  442. static void ni65_init_lance(struct priv *p,unsigned char *daddr,int filter,int mode)
  443. {
  444. int i;
  445. u32 pib;
  446. writereg(CSR0_CLRALL|CSR0_STOP,CSR0);
  447. for(i=0;i<6;i++)
  448. p->ib.eaddr[i] = daddr[i];
  449. for(i=0;i<8;i++)
  450. p->ib.filter[i] = filter;
  451. p->ib.mode = mode;
  452. p->ib.trp = (u32) virt_to_bus(p->tmdhead) | TMDNUMMASK;
  453. p->ib.rrp = (u32) virt_to_bus(p->rmdhead) | RMDNUMMASK;
  454. writereg(0,CSR3); /* busmaster/no word-swap */
  455. pib = (u32) virt_to_bus(&p->ib);
  456. writereg(pib & 0xffff,CSR1);
  457. writereg(pib >> 16,CSR2);
  458. writereg(CSR0_INIT,CSR0); /* this changes L_ADDRREG to CSR0 */
  459. for(i=0;i<32;i++)
  460. {
  461. mdelay(4);
  462. if(inw(PORT+L_DATAREG) & (CSR0_IDON | CSR0_MERR) )
  463. break; /* init ok ? */
  464. }
  465. }
  466. /*
  467.  * allocate memory area and check the 16MB border
  468.  */
  469. static void *ni65_alloc_mem(struct net_device *dev,char *what,int size,int type)
  470. {
  471. struct sk_buff *skb=NULL;
  472. unsigned char *ptr;
  473. void *ret;
  474. if(type) {
  475. ret = skb = alloc_skb(2+16+size,GFP_KERNEL|GFP_DMA);
  476. if(!skb) {
  477. printk("%s: unable to allocate %s memory.n",dev->name,what);
  478. return NULL;
  479. }
  480. skb->dev = dev;
  481. skb_reserve(skb,2+16);
  482. skb_put(skb,R_BUF_SIZE);  /* grab the whole space .. (not necessary) */
  483. ptr = skb->data;
  484. }
  485. else {
  486. ret = ptr = kmalloc(T_BUF_SIZE,GFP_KERNEL | GFP_DMA);
  487. if(!ret) {
  488. printk("%s: unable to allocate %s memory.n",dev->name,what);
  489. return NULL;
  490. }
  491. }
  492. if( (u32) virt_to_bus(ptr+size) > 0x1000000) {
  493. printk("%s: unable to allocate %s memory in lower 16MB!n",dev->name,what);
  494. if(type)
  495. kfree_skb(skb);
  496. else
  497. kfree(ptr);
  498. return NULL;
  499. }
  500. return ret;
  501. }
  502. /*
  503.  * allocate all memory structures .. send/recv buffers etc ...
  504.  */
  505. static int ni65_alloc_buffer(struct net_device *dev)
  506. {
  507. unsigned char *ptr;
  508. struct priv *p;
  509. int i;
  510. /*
  511.  * we need 8-aligned memory ..
  512.  */
  513. ptr = ni65_alloc_mem(dev,"BUFFER",sizeof(struct priv)+8,0);
  514. if(!ptr)
  515. return -ENOMEM;
  516. p = dev->priv = (struct priv *) (((unsigned long) ptr + 7) & ~0x7);
  517. memset((char *) dev->priv,0,sizeof(struct priv));
  518. p->self = ptr;
  519. for(i=0;i<TMDNUM;i++)
  520. {
  521. #ifdef XMT_VIA_SKB
  522. p->tmd_skb[i] = NULL;
  523. #endif
  524. p->tmdbounce[i] = ni65_alloc_mem(dev,"XMIT",T_BUF_SIZE,0);
  525. if(!p->tmdbounce[i]) {
  526. ni65_free_buffer(p);
  527. return -ENOMEM;
  528. }
  529. }
  530. for(i=0;i<RMDNUM;i++)
  531. {
  532. #ifdef RCV_VIA_SKB
  533. p->recv_skb[i] = ni65_alloc_mem(dev,"RECV",R_BUF_SIZE,1);
  534. if(!p->recv_skb[i]) {
  535. ni65_free_buffer(p);
  536. return -ENOMEM;
  537. }
  538. #else
  539. p->recvbounce[i] = ni65_alloc_mem(dev,"RECV",R_BUF_SIZE,0);
  540. if(!p->recvbounce[i]) {
  541. ni65_free_buffer(p);
  542. return -ENOMEM;
  543. }
  544. #endif
  545. }
  546. return 0; /* everything is OK */
  547. }
  548. /*
  549.  * free buffers and private struct
  550.  */
  551. static void ni65_free_buffer(struct priv *p)
  552. {
  553. int i;
  554. if(!p)
  555. return;
  556. for(i=0;i<TMDNUM;i++) {
  557. if(p->tmdbounce[i])
  558. kfree(p->tmdbounce[i]);
  559. #ifdef XMT_VIA_SKB
  560. if(p->tmd_skb[i])
  561. dev_kfree_skb(p->tmd_skb[i]);
  562. #endif
  563. }
  564. for(i=0;i<RMDNUM;i++)
  565. {
  566. #ifdef RCV_VIA_SKB
  567. if(p->recv_skb[i])
  568. dev_kfree_skb(p->recv_skb[i]);
  569. #else
  570. if(p->recvbounce[i])
  571. kfree(p->recvbounce[i]);
  572. #endif
  573. }
  574. if(p->self)
  575. kfree(p->self);
  576. }
  577. /*
  578.  * stop and (re)start lance .. e.g after an error
  579.  */
  580. static void ni65_stop_start(struct net_device *dev,struct priv *p)
  581. {
  582. int csr0 = CSR0_INEA;
  583. writedatareg(CSR0_STOP);
  584. if(debuglevel > 1)
  585. printk("ni65_stop_startn");
  586. if(p->features & INIT_RING_BEFORE_START) {
  587. int i;
  588. #ifdef XMT_VIA_SKB
  589. struct sk_buff *skb_save[TMDNUM];
  590. #endif
  591. unsigned long buffer[TMDNUM];
  592. short blen[TMDNUM];
  593. if(p->xmit_queued) {
  594. while(1) {
  595. if((p->tmdhead[p->tmdlast].u.s.status & XMIT_OWN))
  596. break;
  597. p->tmdlast = (p->tmdlast + 1) & (TMDNUM-1);
  598. if(p->tmdlast == p->tmdnum)
  599. break;
  600. }
  601. }
  602. for(i=0;i<TMDNUM;i++) {
  603. struct tmd *tmdp = p->tmdhead + i;
  604. #ifdef XMT_VIA_SKB
  605. skb_save[i] = p->tmd_skb[i];
  606. #endif
  607. buffer[i] = (u32) bus_to_virt(tmdp->u.buffer);
  608. blen[i] = tmdp->blen;
  609. tmdp->u.s.status = 0x0;
  610. }
  611. for(i=0;i<RMDNUM;i++) {
  612. struct rmd *rmdp = p->rmdhead + i;
  613. rmdp->u.s.status = RCV_OWN;
  614. }
  615. p->tmdnum = p->xmit_queued = 0;
  616. writedatareg(CSR0_STRT | csr0);
  617. for(i=0;i<TMDNUM;i++) {
  618. int num = (i + p->tmdlast) & (TMDNUM-1);
  619. p->tmdhead[i].u.buffer = (u32) virt_to_bus((char *)buffer[num]); /* status is part of buffer field */
  620. p->tmdhead[i].blen = blen[num];
  621. if(p->tmdhead[i].u.s.status & XMIT_OWN) {
  622.  p->tmdnum = (p->tmdnum + 1) & (TMDNUM-1);
  623.  p->xmit_queued = 1;
  624.  writedatareg(CSR0_TDMD | CSR0_INEA | csr0);
  625. }
  626. #ifdef XMT_VIA_SKB
  627. p->tmd_skb[i] = skb_save[num];
  628. #endif
  629. }
  630. p->rmdnum = p->tmdlast = 0;
  631. if(!p->lock)
  632. if (p->tmdnum || !p->xmit_queued)
  633. netif_wake_queue(dev);
  634. dev->trans_start = jiffies;
  635. }
  636. else
  637. writedatareg(CSR0_STRT | csr0);
  638. }
  639. /*
  640.  * init lance (write init-values .. init-buffers) (open-helper)
  641.  */
  642. static int ni65_lance_reinit(struct net_device *dev)
  643. {
  644.  int i;
  645.  struct priv *p = (struct priv *) dev->priv;
  646.  unsigned long flags;
  647.  p->lock = 0;
  648.  p->xmit_queued = 0;
  649.  flags=claim_dma_lock();
  650.  disable_dma(dev->dma); /* I've never worked with dma, but we do it like the packetdriver */
  651.  set_dma_mode(dev->dma,DMA_MODE_CASCADE);
  652.  enable_dma(dev->dma);
  653.  release_dma_lock(flags);
  654.  outw(inw(PORT+L_RESET),PORT+L_RESET); /* first: reset the card */
  655.  if( (i=readreg(CSR0) ) != 0x4)
  656.  {
  657.  printk(KERN_ERR "%s: can't RESET %s card: %04xn",dev->name,
  658. cards[p->cardno].cardname,(int) i);
  659.  flags=claim_dma_lock();
  660.  disable_dma(dev->dma);
  661.  release_dma_lock(flags);
  662.  return 0;
  663.  }
  664.  p->rmdnum = p->tmdnum = p->tmdlast = p->tmdbouncenum = 0;
  665.  for(i=0;i<TMDNUM;i++)
  666.  {
  667.  struct tmd *tmdp = p->tmdhead + i;
  668. #ifdef XMT_VIA_SKB
  669.  if(p->tmd_skb[i]) {
  670.  dev_kfree_skb(p->tmd_skb[i]);
  671.  p->tmd_skb[i] = NULL;
  672.  }
  673. #endif
  674.  tmdp->u.buffer = 0x0;
  675.  tmdp->u.s.status = XMIT_START | XMIT_END;
  676.  tmdp->blen = tmdp->status2 = 0;
  677.  }
  678.  for(i=0;i<RMDNUM;i++)
  679.  {
  680.  struct rmd *rmdp = p->rmdhead + i;
  681. #ifdef RCV_VIA_SKB
  682.  rmdp->u.buffer = (u32) virt_to_bus(p->recv_skb[i]->data);
  683. #else
  684.  rmdp->u.buffer = (u32) virt_to_bus(p->recvbounce[i]);
  685. #endif
  686.  rmdp->blen = -(R_BUF_SIZE-8);
  687.  rmdp->mlen = 0;
  688.  rmdp->u.s.status = RCV_OWN;
  689.  }
  690.  if(dev->flags & IFF_PROMISC)
  691.  ni65_init_lance(p,dev->dev_addr,0x00,M_PROM);
  692.  else if(dev->mc_count || dev->flags & IFF_ALLMULTI)
  693.  ni65_init_lance(p,dev->dev_addr,0xff,0x0);
  694.  else
  695.  ni65_init_lance(p,dev->dev_addr,0x00,0x00);
  696. /*
  697.  * ni65_set_lance_mem() sets L_ADDRREG to CSR0
  698.  * NOW, WE WILL NEVER CHANGE THE L_ADDRREG, CSR0 IS ALWAYS SELECTED
  699.  */
  700.  if(inw(PORT+L_DATAREG) & CSR0_IDON) {
  701.  ni65_set_performance(p);
  702.  /* init OK: start lance , enable interrupts */
  703.  writedatareg(CSR0_CLRALL | CSR0_INEA | CSR0_STRT);
  704.  return 1; /* ->OK */
  705.  }
  706.  printk(KERN_ERR "%s: can't init lance, status: %04xn",dev->name,(int) inw(PORT+L_DATAREG));
  707.  flags=claim_dma_lock();
  708.  disable_dma(dev->dma);
  709.  release_dma_lock(flags);
  710.  return 0; /* ->Error */
  711. }
  712. /*
  713.  * interrupt handler
  714.  */
  715. static void ni65_interrupt(int irq, void * dev_id, struct pt_regs * regs)
  716. {
  717. int csr0 = 0;
  718. struct net_device *dev = dev_id;
  719. struct priv *p;
  720. int bcnt = 32;
  721. p = (struct priv *) dev->priv;
  722. while(--bcnt) {
  723. csr0 = inw(PORT+L_DATAREG);
  724. #if 0
  725. writedatareg( (csr0 & CSR0_CLRALL) ); /* ack interrupts, disable int. */
  726. #else
  727. writedatareg( (csr0 & CSR0_CLRALL) | CSR0_INEA ); /* ack interrupts, interrupts enabled */
  728. #endif
  729. if(!(csr0 & (CSR0_ERR | CSR0_RINT | CSR0_TINT)))
  730. break;
  731. if(csr0 & CSR0_RINT) /* RECV-int? */
  732. ni65_recv_intr(dev,csr0);
  733. if(csr0 & CSR0_TINT) /* XMIT-int? */
  734. ni65_xmit_intr(dev,csr0);
  735. if(csr0 & CSR0_ERR)
  736. {
  737. struct priv *p = (struct priv *) dev->priv;
  738. if(debuglevel > 1)
  739. printk("%s: general error: %04x.n",dev->name,csr0);
  740. if(csr0 & CSR0_BABL)
  741. p->stats.tx_errors++;
  742. if(csr0 & CSR0_MISS) {
  743. int i;
  744. for(i=0;i<RMDNUM;i++)
  745. printk("%02x ",p->rmdhead[i].u.s.status);
  746. printk("n");
  747. p->stats.rx_errors++;
  748. }
  749. if(csr0 & CSR0_MERR) {
  750. if(debuglevel > 1)
  751. printk("%s: Ooops .. memory error: %04x.n",dev->name,csr0);
  752. ni65_stop_start(dev,p);
  753. }
  754. }
  755. }
  756. #ifdef RCV_PARANOIA_CHECK
  757. {
  758.  int j;
  759.  for(j=0;j<RMDNUM;j++)
  760.  {
  761. struct priv *p = (struct priv *) dev->priv;
  762. int i,k,num1,num2;
  763. for(i=RMDNUM-1;i>0;i--) {
  764.  num2 = (p->rmdnum + i) & (RMDNUM-1);
  765.  if(!(p->rmdhead[num2].u.s.status & RCV_OWN))
  766. break;
  767. }
  768. if(i) {
  769. for(k=0;k<RMDNUM;k++) {
  770. num1 = (p->rmdnum + k) & (RMDNUM-1);
  771. if(!(p->rmdhead[num1].u.s.status & RCV_OWN))
  772. break;
  773. }
  774. if(!k)
  775. break;
  776. if(debuglevel > 0)
  777. {
  778. char buf[256],*buf1;
  779. int k;
  780. buf1 = buf;
  781. for(k=0;k<RMDNUM;k++) {
  782. sprintf(buf1,"%02x ",(p->rmdhead[k].u.s.status)); /* & RCV_OWN) ); */
  783. buf1 += 3;
  784. }
  785. *buf1 = 0;
  786. printk(KERN_ERR "%s: Ooops, receive ring corrupted %2d %2d | %sn",dev->name,p->rmdnum,i,buf);
  787. }
  788. p->rmdnum = num1;
  789. ni65_recv_intr(dev,csr0);
  790. if((p->rmdhead[num2].u.s.status & RCV_OWN))
  791. break; /* ok, we are 'in sync' again */
  792. }
  793. else
  794. break;
  795.  }
  796. }
  797. #endif
  798. if( (csr0 & (CSR0_RXON | CSR0_TXON)) != (CSR0_RXON | CSR0_TXON) ) {
  799. printk("%s: RX or TX was offline -> restartn",dev->name);
  800. ni65_stop_start(dev,p);
  801. }
  802. else
  803. writedatareg(CSR0_INEA);
  804. return;
  805. }
  806. /*
  807.  * We have received an Xmit-Interrupt ..
  808.  * send a new packet if necessary
  809.  */
  810. static void ni65_xmit_intr(struct net_device *dev,int csr0)
  811. {
  812. struct priv *p = (struct priv *) dev->priv;
  813. while(p->xmit_queued)
  814. {
  815. struct tmd *tmdp = p->tmdhead + p->tmdlast;
  816. int tmdstat = tmdp->u.s.status;
  817. if(tmdstat & XMIT_OWN)
  818. break;
  819. if(tmdstat & XMIT_ERR)
  820. {
  821. #if 0
  822. if(tmdp->status2 & XMIT_TDRMASK && debuglevel > 3)
  823. printk(KERN_ERR "%s: tdr-problems (e.g. no resistor)n",dev->name);
  824. #endif
  825.  /* checking some errors */
  826. if(tmdp->status2 & XMIT_RTRY)
  827. p->stats.tx_aborted_errors++;
  828. if(tmdp->status2 & XMIT_LCAR)
  829. p->stats.tx_carrier_errors++;
  830. if(tmdp->status2 & (XMIT_BUFF | XMIT_UFLO )) {
  831. /* this stops the xmitter */
  832. p->stats.tx_fifo_errors++;
  833. if(debuglevel > 0)
  834. printk(KERN_ERR "%s: Xmit FIFO/BUFF errorn",dev->name);
  835. if(p->features & INIT_RING_BEFORE_START) {
  836. tmdp->u.s.status = XMIT_OWN | XMIT_START | XMIT_END; /* test: resend this frame */
  837. ni65_stop_start(dev,p);
  838. break; /* no more Xmit processing .. */
  839. }
  840. else
  841.  ni65_stop_start(dev,p);
  842. }
  843. if(debuglevel > 2)
  844. printk(KERN_ERR "%s: xmit-error: %04x %02x-%04xn",dev->name,csr0,(int) tmdstat,(int) tmdp->status2);
  845. if(!(csr0 & CSR0_BABL)) /* don't count errors twice */
  846. p->stats.tx_errors++;
  847. tmdp->status2 = 0;
  848. }
  849. else {
  850. p->stats.tx_bytes -= (short)(tmdp->blen);
  851. p->stats.tx_packets++;
  852. }
  853. #ifdef XMT_VIA_SKB
  854. if(p->tmd_skb[p->tmdlast]) {
  855.  dev_kfree_skb_irq(p->tmd_skb[p->tmdlast]);
  856.  p->tmd_skb[p->tmdlast] = NULL;
  857. }
  858. #endif
  859. p->tmdlast = (p->tmdlast + 1) & (TMDNUM-1);
  860. if(p->tmdlast == p->tmdnum)
  861. p->xmit_queued = 0;
  862. }
  863. netif_wake_queue(dev);
  864. }
  865. /*
  866.  * We have received a packet
  867.  */
  868. static void ni65_recv_intr(struct net_device *dev,int csr0)
  869. {
  870. struct rmd *rmdp;
  871. int rmdstat,len;
  872. int cnt=0;
  873. struct priv *p = (struct priv *) dev->priv;
  874. rmdp = p->rmdhead + p->rmdnum;
  875. while(!( (rmdstat = rmdp->u.s.status) & RCV_OWN))
  876. {
  877. cnt++;
  878. if( (rmdstat & (RCV_START | RCV_END | RCV_ERR)) != (RCV_START | RCV_END) ) /* error or oversized? */
  879. {
  880. if(!(rmdstat & RCV_ERR)) {
  881. if(rmdstat & RCV_START)
  882. {
  883. p->stats.rx_length_errors++;
  884. printk(KERN_ERR "%s: recv, packet too long: %dn",dev->name,rmdp->mlen & 0x0fff);
  885. }
  886. }
  887. else {
  888. if(debuglevel > 2)
  889. printk(KERN_ERR "%s: receive-error: %04x, lance-status: %04x/%04xn",
  890. dev->name,(int) rmdstat,csr0,(int) inw(PORT+L_DATAREG) );
  891. if(rmdstat & RCV_FRAM)
  892. p->stats.rx_frame_errors++;
  893. if(rmdstat & RCV_OFLO)
  894. p->stats.rx_over_errors++;
  895. if(rmdstat & RCV_CRC)
  896. p->stats.rx_crc_errors++;
  897. if(rmdstat & RCV_BUF_ERR)
  898. p->stats.rx_fifo_errors++;
  899. }
  900. if(!(csr0 & CSR0_MISS)) /* don't count errors twice */
  901. p->stats.rx_errors++;
  902. }
  903. else if( (len = (rmdp->mlen & 0x0fff) - 4) >= 60)
  904. {
  905. #ifdef RCV_VIA_SKB
  906. struct sk_buff *skb = alloc_skb(R_BUF_SIZE+2+16,GFP_ATOMIC);
  907. if (skb)
  908. skb_reserve(skb,16);
  909. #else
  910. struct sk_buff *skb = dev_alloc_skb(len+2);
  911. #endif
  912. if(skb)
  913. {
  914. skb_reserve(skb,2);
  915. skb->dev = dev;
  916. #ifdef RCV_VIA_SKB
  917. if( (unsigned long) (skb->data + R_BUF_SIZE) > 0x1000000) {
  918. skb_put(skb,len);
  919. eth_copy_and_sum(skb, (unsigned char *)(p->recv_skb[p->rmdnum]->data),len,0);
  920. }
  921. else {
  922. struct sk_buff *skb1 = p->recv_skb[p->rmdnum];
  923. skb_put(skb,R_BUF_SIZE);
  924. p->recv_skb[p->rmdnum] = skb;
  925. rmdp->u.buffer = (u32) virt_to_bus(skb->data);
  926. skb = skb1;
  927. skb_trim(skb,len);
  928. }
  929. #else
  930. skb_put(skb,len);
  931. eth_copy_and_sum(skb, (unsigned char *) p->recvbounce[p->rmdnum],len,0);
  932. #endif
  933. p->stats.rx_packets++;
  934. p->stats.rx_bytes += len;
  935. skb->protocol=eth_type_trans(skb,dev);
  936. netif_rx(skb);
  937. dev->last_rx = jiffies;
  938. }
  939. else
  940. {
  941. printk(KERN_ERR "%s: can't alloc new sk_buffn",dev->name);
  942. p->stats.rx_dropped++;
  943. }
  944. }
  945. else {
  946. printk(KERN_INFO "%s: received runt packetn",dev->name);
  947. p->stats.rx_errors++;
  948. }
  949. rmdp->blen = -(R_BUF_SIZE-8);
  950. rmdp->mlen = 0;
  951. rmdp->u.s.status = RCV_OWN; /* change owner */
  952. p->rmdnum = (p->rmdnum + 1) & (RMDNUM-1);
  953. rmdp = p->rmdhead + p->rmdnum;
  954. }
  955. }
  956. /*
  957.  * kick xmitter ..
  958.  */
  959.  
  960. static void ni65_timeout(struct net_device *dev)
  961. {
  962. int i;
  963. struct priv *p = (struct priv *) dev->priv;
  964. printk(KERN_ERR "%s: xmitter timed out, try to restart!n",dev->name);
  965. for(i=0;i<TMDNUM;i++)
  966. printk("%02x ",p->tmdhead[i].u.s.status);
  967. printk("n");
  968. ni65_lance_reinit(dev);
  969. dev->trans_start = jiffies;
  970. netif_wake_queue(dev);
  971. }
  972. /*
  973.  * Send a packet
  974.  */
  975. static int ni65_send_packet(struct sk_buff *skb, struct net_device *dev)
  976. {
  977. struct priv *p = (struct priv *) dev->priv;
  978. netif_stop_queue(dev);
  979. if (test_and_set_bit(0, (void*)&p->lock)) {
  980. printk(KERN_ERR "%s: Queue was locked.n", dev->name);
  981. return 1;
  982. }
  983. {
  984. short len = ETH_ZLEN < skb->len ? skb->len : ETH_ZLEN;
  985. struct tmd *tmdp;
  986. unsigned long flags;
  987. #ifdef XMT_VIA_SKB
  988. if( (unsigned long) (skb->data + skb->len) > 0x1000000) {
  989. #endif
  990. memcpy((char *) p->tmdbounce[p->tmdbouncenum] ,(char *)skb->data,
  991.  (skb->len > T_BUF_SIZE) ? T_BUF_SIZE : skb->len);
  992. dev_kfree_skb (skb);
  993. save_flags(flags);
  994. cli();
  995. tmdp = p->tmdhead + p->tmdnum;
  996. tmdp->u.buffer = (u32) virt_to_bus(p->tmdbounce[p->tmdbouncenum]);
  997. p->tmdbouncenum = (p->tmdbouncenum + 1) & (TMDNUM - 1);
  998. #ifdef XMT_VIA_SKB
  999. }
  1000. else {
  1001. save_flags(flags);
  1002. cli();
  1003. tmdp = p->tmdhead + p->tmdnum;
  1004. tmdp->u.buffer = (u32) virt_to_bus(skb->data);
  1005. p->tmd_skb[p->tmdnum] = skb;
  1006. }
  1007. #endif
  1008. tmdp->blen = -len;
  1009. tmdp->u.s.status = XMIT_OWN | XMIT_START | XMIT_END;
  1010. writedatareg(CSR0_TDMD | CSR0_INEA); /* enable xmit & interrupt */
  1011. p->xmit_queued = 1;
  1012. p->tmdnum = (p->tmdnum + 1) & (TMDNUM-1);
  1013. if(p->tmdnum != p->tmdlast)
  1014. netif_wake_queue(dev);
  1015. p->lock = 0;
  1016. dev->trans_start = jiffies;
  1017. restore_flags(flags);
  1018. }
  1019. return 0;
  1020. }
  1021. static struct net_device_stats *ni65_get_stats(struct net_device *dev)
  1022. {
  1023. #if 0
  1024. int i;
  1025. struct priv *p = (struct priv *) dev->priv;
  1026. for(i=0;i<RMDNUM;i++)
  1027. {
  1028. struct rmd *rmdp = p->rmdhead + ((p->rmdnum + i) & (RMDNUM-1));
  1029. printk("%02x ",rmdp->u.s.status);
  1030. }
  1031. printk("n");
  1032. #endif
  1033. return &((struct priv *) dev->priv)->stats;
  1034. }
  1035. static void set_multicast_list(struct net_device *dev)
  1036. {
  1037. if(!ni65_lance_reinit(dev))
  1038. printk(KERN_ERR "%s: Can't switch card into MC mode!n",dev->name);
  1039. netif_wake_queue(dev);
  1040. }
  1041. #ifdef MODULE
  1042. static struct net_device dev_ni65 = { base_addr: 0x360, irq: 9, init: ni65_probe };
  1043. /* set: io,irq,dma or set it when calling insmod */
  1044. static int irq;
  1045. static int io;
  1046. static int dma;
  1047. MODULE_PARM(irq, "i");
  1048. MODULE_PARM(io, "i");
  1049. MODULE_PARM(dma, "i");
  1050. MODULE_PARM_DESC(irq, "ni6510 IRQ number (ignored for some cards)");
  1051. MODULE_PARM_DESC(io, "ni6510 I/O base address");
  1052. MODULE_PARM_DESC(dma, "ni6510 ISA DMA channel (ignored for some cards)");
  1053. int init_module(void)
  1054. {
  1055. dev_ni65.irq = irq;
  1056. dev_ni65.dma = dma;
  1057. dev_ni65.base_addr = io;
  1058. if (register_netdev(&dev_ni65) != 0)
  1059. return -EIO;
  1060. return 0;
  1061. }
  1062. void cleanup_module(void)
  1063. {
  1064. struct priv *p;
  1065. p = (struct priv *) dev_ni65.priv;
  1066. if(!p) {
  1067. printk("Ooops .. no private structn");
  1068. return;
  1069. }
  1070. disable_dma(dev_ni65.dma);
  1071. free_dma(dev_ni65.dma);
  1072. unregister_netdev(&dev_ni65);
  1073. release_region(dev_ni65.base_addr,cards[p->cardno].total_size);
  1074. ni65_free_buffer(p);
  1075. dev_ni65.priv = NULL;
  1076. }
  1077. #endif /* MODULE */
  1078. MODULE_LICENSE("GPL");
  1079. /*
  1080.  * END of ni65.c
  1081.  */