macmace.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:19k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Driver for the Macintosh 68K onboard MACE controller with PSC
  3.  * driven DMA. The MACE driver code is derived from mace.c. The
  4.  * Mac68k theory of operation is courtesy of the MacBSD wizards.
  5.  *
  6.  * This program is free software; you can redistribute it and/or
  7.  * modify it under the terms of the GNU General Public License
  8.  * as published by the Free Software Foundation; either version
  9.  * 2 of the License, or (at your option) any later version.
  10.  *
  11.  * Copyright (C) 1996 Paul Mackerras.
  12.  * Copyright (C) 1998 Alan Cox <alan@redhat.com>
  13.  */
  14. #include <linux/kernel.h>
  15. #include <linux/netdevice.h>
  16. #include <linux/etherdevice.h>
  17. #include <linux/delay.h>
  18. #include <linux/string.h>
  19. #include <linux/timer.h>
  20. #include <asm/io.h>
  21. #include <asm/pgtable.h>
  22. #include <asm/irq.h>
  23. #include <asm/macintosh.h>
  24. #include <asm/macints.h>
  25. #include <asm/mac_psc.h>
  26. #include "mace.h"
  27. #define N_RX_RING 8
  28. #define N_TX_RING 2
  29. #define MAX_TX_ACTIVE 1
  30. #define NCMDS_TX 1 /* dma commands per element in tx ring */
  31. #define RX_BUFLEN (ETH_FRAME_LEN + 8)
  32. #define TX_TIMEOUT HZ /* 1 second */
  33. /* Bits in transmit DMA status */
  34. #define TX_DMA_ERR 0x80
  35. /* The MACE is simply wired down on a Mac68K box */
  36. #define MACE_BASE (void *)(0x50F1C000)
  37. #define MACE_PROM (void *)(0x50F08001)
  38. struct mace68k_data
  39. {
  40. volatile struct mace *mace;
  41. volatile unsigned char *tx_ring;
  42. volatile unsigned char *rx_ring;
  43. int dma_intr;
  44. unsigned char maccc;
  45. struct net_device_stats stats;
  46. struct timer_list tx_timeout;
  47. int timeout_active;
  48. int rx_slot, rx_done;
  49. int tx_slot, tx_count;
  50. };
  51. struct mace_frame
  52. {
  53. u16 len;
  54. u16 status;
  55. u16 rntpc;
  56. u16 rcvcc;
  57. u32 pad1;
  58. u32 pad2;
  59. u8 data[1];
  60. /* And frame continues.. */
  61. };
  62. #define PRIV_BYTES sizeof(struct mace68k_data)
  63. extern void psc_debug_dump(void);
  64. static int mace68k_open(struct net_device *dev);
  65. static int mace68k_close(struct net_device *dev);
  66. static int mace68k_xmit_start(struct sk_buff *skb, struct net_device *dev);
  67. static struct net_device_stats *mace68k_stats(struct net_device *dev);
  68. static void mace68k_set_multicast(struct net_device *dev);
  69. static void mace68k_reset(struct net_device *dev);
  70. static int mace68k_set_address(struct net_device *dev, void *addr);
  71. static void mace68k_interrupt(int irq, void *dev_id, struct pt_regs *regs);
  72. static void mace68k_dma_intr(int irq, void *dev_id, struct pt_regs *regs);
  73. static void mace68k_set_timeout(struct net_device *dev);
  74. static void mace68k_tx_timeout(unsigned long data);
  75. /*
  76.  * PSC DMA engine control. As you'd expect on a macintosh its
  77.  * more like a lawnmower engine supplied without instructions
  78.  *
  79.  * The basic theory of operation appears to be as follows.
  80.  *
  81.  * There are two sets of receive DMA registers and two sets
  82.  * of transmit DMA registers. Instead of the more traditional
  83.  * "ring buffer" approach the Mac68K DMA engine expects you
  84.  * to be loading one chain while the other runs, and then
  85.  * to flip register set. Each entry in the chain is a fixed 
  86.  * length.
  87.  */
  88. /*
  89.  * Load a receive DMA channel with a base address and ring length
  90.  */
  91.   
  92. static void psc_load_rxdma_base(int set, void *base)
  93. {
  94. psc_write_word(PSC_ENETRD_CMD + set, 0x0100);
  95. psc_write_long(PSC_ENETRD_ADDR + set, (u32)base);
  96. psc_write_long(PSC_ENETRD_LEN + set, N_RX_RING);
  97. psc_write_word(PSC_ENETRD_CMD + set, 0x9800);
  98. }
  99. /*
  100.  * Reset the receive DMA subsystem
  101.  */
  102.   
  103. static void mace68k_rxdma_reset(struct net_device *dev)
  104. {
  105. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  106. volatile struct mace *mace = mp->mace;
  107. u8 mcc = mace->maccc;
  108. /*
  109.  * Turn off receive
  110.  */
  111.  
  112. mcc&=~ENRCV;
  113. mace->maccc=mcc;
  114. /*
  115.  * Program the DMA
  116.  */
  117. psc_write_word(PSC_ENETRD_CTL, 0x8800);
  118. psc_load_rxdma_base(0x0, (void *)virt_to_bus(mp->rx_ring));
  119. psc_write_word(PSC_ENETRD_CTL, 0x0400);
  120. psc_write_word(PSC_ENETRD_CTL, 0x8800);
  121. psc_load_rxdma_base(0x10, (void *)virt_to_bus(mp->rx_ring));
  122. psc_write_word(PSC_ENETRD_CTL, 0x0400);
  123. mace->maccc=mcc|ENRCV;
  124. #if 0
  125. psc_write_word(PSC_ENETRD_CTL, 0x9800);
  126. psc_write_word(PSC_ENETRD_CTL+0x10, 0x9800);
  127. #endif
  128. }
  129. /*
  130.  * Reset the transmit DMA subsystem
  131.  */
  132.  
  133. static void mace68k_txdma_reset(struct net_device *dev)
  134. {
  135. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  136. volatile struct mace *mace = mp->mace;
  137. u8 mcc = mace->maccc;
  138. psc_write_word(PSC_ENETWR_CTL,0x8800);
  139. mace->maccc = mcc&~ENXMT;
  140. psc_write_word(PSC_ENETWR_CTL,0x0400);
  141. mace->maccc = mcc;
  142. }
  143. /*
  144.  * Disable DMA
  145.  */
  146.  
  147. static void mace68k_dma_off(struct net_device *dev)
  148. {
  149. psc_write_word(PSC_ENETRD_CTL, 0x8800);
  150. psc_write_word(PSC_ENETRD_CTL, 0x1000);
  151. psc_write_word(PSC_ENETRD_CMD, 0x1100);
  152. psc_write_word(PSC_ENETRD_CMD+0x10, 0x1100);
  153.                                         
  154. psc_write_word(PSC_ENETWR_CTL, 0x8800);
  155. psc_write_word(PSC_ENETWR_CTL, 0x1000);
  156. psc_write_word(PSC_ENETWR_CMD, 0x1100);
  157. psc_write_word(PSC_ENETWR_CMD+0x10, 0x1100);
  158. }
  159. /* Bit-reverse one byte of an ethernet hardware address. */
  160. static int bitrev(int b)
  161. {
  162.     int d = 0, i;
  163.     for (i = 0; i < 8; ++i, b >>= 1)
  164. d = (d << 1) | (b & 1);
  165.     return d;
  166. }
  167. /*
  168.  *  Not really much of a probe. The hardware table tells us if this
  169.  * model of Macintrash has a MACE (AV macintoshes)
  170.  */
  171.  
  172. int mace68k_probe(struct net_device *unused)
  173. {
  174. int j;
  175. static int once;
  176. struct mace68k_data *mp;
  177. unsigned char *addr;
  178. struct net_device *dev;
  179. unsigned char checksum = 0;
  180. /*
  181.  * There can be only one...
  182.  */
  183.  
  184. if (once) return -ENODEV;
  185. once = 1;
  186. if (macintosh_config->ether_type != MAC_ETHER_MACE) return -ENODEV;
  187. printk("MACE ethernet should be present ");
  188. dev = init_etherdev(0, PRIV_BYTES);
  189. if(dev==NULL)
  190. {
  191. printk("no free memory.n");
  192. return -ENOMEM;
  193. }
  194. mp = (struct mace68k_data *) dev->priv;
  195. dev->base_addr = (u32)MACE_BASE;
  196. mp->mace = (volatile struct mace *) MACE_BASE;
  197. printk("at 0x%p", mp->mace);
  198. /*
  199.  * 16K RX ring and 4K TX ring should do nicely
  200.  */
  201. mp->rx_ring=(void *)__get_free_pages(GFP_KERNEL, 2);
  202. mp->tx_ring=(void *)__get_free_page(GFP_KERNEL);
  203. printk(".");
  204. if(mp->tx_ring==NULL || mp->rx_ring==NULL)
  205. {
  206. if(mp->tx_ring)
  207. free_page((u32)mp->tx_ring);
  208. // if(mp->rx_ring)
  209. // __free_pages(mp->rx_ring,2);
  210. printk("nNo memory for ring buffers.n");
  211. return -ENOMEM;
  212. }
  213. /* We want the receive data to be uncached. We dont care about the
  214.    byte reading order */
  215. printk(".");
  216. kernel_set_cachemode((void *)mp->rx_ring, 16384, IOMAP_NOCACHE_NONSER);
  217. printk(".");
  218. /* The transmit buffer needs to be write through */
  219. kernel_set_cachemode((void *)mp->tx_ring, 4096, IOMAP_WRITETHROUGH);
  220. printk(" Okn");
  221. dev->irq = IRQ_MAC_MACE;
  222. printk(KERN_INFO "%s: MACE at", dev->name);
  223. /*
  224.  * The PROM contains 8 bytes which total 0xFF when XOR'd
  225.  * together. Due to the usual peculiar apple brain damage
  226.  * the bytes are spaced out in a strange boundary and the
  227.  *  bits are reversed.
  228.  */
  229. addr = (void *)MACE_PROM;
  230.  
  231. for (j = 0; j < 6; ++j)
  232. {
  233. u8 v=bitrev(addr[j<<4]);
  234. checksum^=v;
  235. dev->dev_addr[j] = v;
  236. printk("%c%.2x", (j ? ':' : ' '), dev->dev_addr[j]);
  237. }
  238. for (; j < 8; ++j)
  239. {
  240. checksum^=bitrev(addr[j<<4]);
  241. }
  242. if(checksum!=0xFF)
  243. {
  244. printk(" (invalid checksum)n");
  245. return -ENODEV;
  246. }
  247. printk("n");
  248. memset(&mp->stats, 0, sizeof(mp->stats));
  249. init_timer(&mp->tx_timeout);
  250. mp->timeout_active = 0;
  251. dev->open = mace68k_open;
  252. dev->stop = mace68k_close;
  253. dev->hard_start_xmit = mace68k_xmit_start;
  254. dev->get_stats = mace68k_stats;
  255. dev->set_multicast_list = mace68k_set_multicast;
  256. dev->set_mac_address = mace68k_set_address;
  257. ether_setup(dev);
  258. mp = (struct mace68k_data *) dev->priv;
  259. mp->maccc = ENXMT | ENRCV;
  260. mp->dma_intr = IRQ_MAC_MACE_DMA;
  261. psc_write_word(PSC_ENETWR_CTL, 0x9000);
  262. psc_write_word(PSC_ENETRD_CTL, 0x9000);
  263. psc_write_word(PSC_ENETWR_CTL, 0x0400);
  264. psc_write_word(PSC_ENETRD_CTL, 0x0400);
  265.                                         
  266. /* apple's driver doesn't seem to do this */
  267. /* except at driver shutdown time...      */
  268. #if 0
  269. mace68k_dma_off(dev);
  270. #endif
  271. return 0;
  272. }
  273. /*
  274.  * Reset a MACE controller
  275.  */
  276.  
  277. static void mace68k_reset(struct net_device *dev)
  278. {
  279. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  280. volatile struct mace *mb = mp->mace;
  281. int i;
  282. /* soft-reset the chip */
  283. i = 200;
  284. while (--i) {
  285. mb->biucc = SWRST;
  286. if (mb->biucc & SWRST) {
  287. udelay(10);
  288. continue;
  289. }
  290. break;
  291. }
  292. if (!i) {
  293. printk(KERN_ERR "mace: cannot reset chip!n");
  294. return;
  295. }
  296. mb->biucc = XMTSP_64;
  297. mb->imr = 0xff; /* disable all intrs for now */
  298. i = mb->ir;
  299. mb->maccc = 0; /* turn off tx, rx */
  300. mb->utr = RTRD;
  301. mb->fifocc = RCVFW_64;
  302. mb->xmtfc = AUTO_PAD_XMIT; /* auto-pad short frames */
  303. /* load up the hardware address */
  304. mb->iac = ADDRCHG | PHYADDR;
  305. while ((mb->iac & ADDRCHG) != 0);
  306. for (i = 0; i < 6; ++i)
  307. mb->padr = dev->dev_addr[i];
  308. /* clear the multicast filter */
  309. mb->iac = ADDRCHG | LOGADDR;
  310. while ((mb->iac & ADDRCHG) != 0);
  311. for (i = 0; i < 8; ++i)
  312. mb->ladrf = 0;
  313. mb->plscc = PORTSEL_GPSI + ENPLSIO;
  314. }
  315. /*
  316.  * Load the address on a mace controller.
  317.  */
  318.  
  319. static int mace68k_set_address(struct net_device *dev, void *addr)
  320. {
  321. unsigned char *p = addr;
  322. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  323. volatile struct mace *mb = mp->mace;
  324. int i;
  325. unsigned long flags;
  326. save_flags(flags);
  327. cli();
  328. /* load up the hardware address */
  329. mb->iac = ADDRCHG | PHYADDR;
  330. while ((mb->iac & ADDRCHG) != 0);
  331. for (i = 0; i < 6; ++i)
  332. mb->padr = dev->dev_addr[i] = p[i];
  333. /* note: setting ADDRCHG clears ENRCV */
  334. mb->maccc = mp->maccc;
  335. restore_flags(flags);
  336. return 0;
  337. }
  338. /*
  339.  * Open the Macintosh MACE. Most of this is playing with the DMA
  340.  * engine. The ethernet chip is quite friendly.
  341.  */
  342.  
  343. static int mace68k_open(struct net_device *dev)
  344. {
  345. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  346. volatile struct mace *mb = mp->mace;
  347. /* reset the chip */
  348. mace68k_reset(dev);
  349. mp->rx_done = 0;
  350. mace68k_rxdma_reset(dev);
  351. /*
  352.  * The interrupt is fixed and comes off the PSC.
  353.  */
  354.  
  355. if (request_irq(dev->irq, mace68k_interrupt, 0, "68K MACE", dev))
  356. {
  357. printk(KERN_ERR "MACE: can't get irq %dn", dev->irq);
  358. return -EAGAIN;
  359. }
  360. /*
  361.  * Ditto the DMA interrupt.
  362.  */
  363.  
  364. if (request_irq(IRQ_MAC_MACE_DMA, mace68k_dma_intr, 0, "68K MACE DMA",
  365. dev))
  366. {
  367. printk(KERN_ERR "MACE: can't get irq %dn", IRQ_MAC_MACE_DMA);
  368. return -EAGAIN;
  369. }
  370. /* Activate the Mac DMA engine */
  371. mp->tx_slot = 0; /* Using register set 0 */
  372. mp->tx_count = 1; /* 1 Buffer ready for use */
  373. mace68k_txdma_reset(dev);
  374. /* turn it on! */
  375. mb->maccc = mp->maccc;
  376. /* enable all interrupts except receive interrupts */
  377. mb->imr = RCVINT;
  378. return 0;
  379. }
  380. /*
  381.  * Shut down the mace and its interrupt channel
  382.  */
  383.  
  384. static int mace68k_close(struct net_device *dev)
  385. {
  386. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  387. volatile struct mace *mb = mp->mace;
  388. /* disable rx and tx */
  389. mb->maccc = 0;
  390. mb->imr = 0xff; /* disable all intrs */
  391. /* disable rx and tx dma */
  392. mace68k_dma_off(dev);
  393. free_irq(dev->irq, dev);
  394. free_irq(IRQ_MAC_MACE_DMA, dev);
  395. return 0;
  396. }
  397. static inline void mace68k_set_timeout(struct net_device *dev)
  398. {
  399. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  400. unsigned long flags;
  401. save_flags(flags);
  402. cli();
  403. if (mp->timeout_active)
  404. del_timer(&mp->tx_timeout);
  405. mp->tx_timeout.expires = jiffies + TX_TIMEOUT;
  406. mp->tx_timeout.function = mace68k_tx_timeout;
  407. mp->tx_timeout.data = (unsigned long) dev;
  408. add_timer(&mp->tx_timeout);
  409. mp->timeout_active = 1;
  410. restore_flags(flags);
  411. }
  412. /*
  413.  * Transmit a frame
  414.  */
  415.  
  416. static int mace68k_xmit_start(struct sk_buff *skb, struct net_device *dev)
  417. {
  418. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  419. /*
  420.  * This may need atomic types ???
  421.  */
  422. printk("mace68k_xmit_start: mp->tx_count = %d, dev->tbusy = %d, mp->tx_ring = %p (%p)n",
  423. mp->tx_count, dev->tbusy,
  424. mp->tx_ring, virt_to_bus(mp->tx_ring));
  425. psc_debug_dump();
  426. if(mp->tx_count == 0)
  427. {
  428. dev->tbusy=1;
  429. mace68k_dma_intr(IRQ_MAC_MACE_DMA, dev, NULL);
  430. return 1;
  431. }
  432. mp->tx_count--;
  433. /*
  434.  * FIXME:
  435.  * This is hackish. The memcpy probably isnt needed but
  436.  * the rules for alignment are not known. Ideally we'd like
  437.  * to just blast the skb directly to ethernet. We also don't
  438.  * use the ring properly - just a one frame buffer. That
  439.  * also requires cache pushes ;).
  440.  */
  441. memcpy((void *)mp->tx_ring, skb, skb->len);
  442. psc_write_long(PSC_ENETWR_ADDR + mp->tx_slot, virt_to_bus(mp->tx_ring));
  443.         psc_write_long(PSC_ENETWR_LEN + mp->tx_slot, skb->len);
  444.         psc_write_word(PSC_ENETWR_CMD + mp->tx_slot, 0x9800);                       
  445. mp->stats.tx_packets++;
  446. mp->stats.tx_bytes+=skb->len;
  447.         dev_kfree_skb(skb);
  448. return 0;
  449. }
  450. static struct net_device_stats *mace68k_stats(struct net_device *dev)
  451. {
  452. struct mace68k_data *p = (struct mace68k_data *) dev->priv;
  453. return &p->stats;
  454. }
  455. /*
  456.  * CRC polynomial - used in working out multicast filter bits.
  457.  */
  458. #define CRC_POLY 0xedb88320
  459. static void mace68k_set_multicast(struct net_device *dev)
  460. {
  461. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  462. volatile struct mace *mb = mp->mace;
  463. int i, j, k, b;
  464. unsigned long crc;
  465. mp->maccc &= ~PROM;
  466. if (dev->flags & IFF_PROMISC)
  467. {
  468. mp->maccc |= PROM;
  469. } else
  470. {
  471. unsigned char multicast_filter[8];
  472. struct dev_mc_list *dmi = dev->mc_list;
  473. if (dev->flags & IFF_ALLMULTI)
  474. {
  475. for (i = 0; i < 8; i++)
  476. multicast_filter[i] = 0xff;
  477. } else
  478. {
  479. for (i = 0; i < 8; i++)
  480. multicast_filter[i] = 0;
  481. for (i = 0; i < dev->mc_count; i++)
  482. {
  483. crc = ~0;
  484. for (j = 0; j < 6; ++j)
  485. {
  486. b = dmi->dmi_addr[j];
  487. for (k = 0; k < 8; ++k)
  488. {
  489. if ((crc ^ b) & 1)
  490. crc = (crc >> 1) ^ CRC_POLY;
  491. else
  492. crc >>= 1;
  493. b >>= 1;
  494. }
  495. }
  496. j = crc >> 26; /* bit number in multicast_filter */
  497. multicast_filter[j >> 3] |= 1 << (j & 7);
  498. dmi = dmi->next;
  499. }
  500. }
  501. #if 0
  502. printk("Multicast filter :");
  503. for (i = 0; i < 8; i++)
  504. printk("%02x ", multicast_filter[i]);
  505. printk("n");
  506. #endif
  507. mb->iac = ADDRCHG | LOGADDR;
  508. while ((mb->iac & ADDRCHG) != 0);
  509. for (i = 0; i < 8; ++i)
  510. mb->ladrf = multicast_filter[i];
  511. }
  512. /* reset maccc */
  513. mb->maccc = mp->maccc;
  514. }
  515. /*
  516.  * Miscellaneous interrupts are handled here. We may end up 
  517.  * having to bash the chip on the head for bad errors
  518.  */
  519.  
  520. static void mace68k_handle_misc_intrs(struct mace68k_data *mp, int intr)
  521. {
  522. volatile struct mace *mb = mp->mace;
  523. static int mace68k_babbles, mace68k_jabbers;
  524. if (intr & MPCO)
  525. mp->stats.rx_missed_errors += 256;
  526. mp->stats.rx_missed_errors += mb->mpc; /* reading clears it */
  527. if (intr & RNTPCO)
  528. mp->stats.rx_length_errors += 256;
  529. mp->stats.rx_length_errors += mb->rntpc; /* reading clears it */
  530. if (intr & CERR)
  531. ++mp->stats.tx_heartbeat_errors;
  532. if (intr & BABBLE)
  533. if (mace68k_babbles++ < 4)
  534. printk(KERN_DEBUG "mace: babbling transmittern");
  535. if (intr & JABBER)
  536. if (mace68k_jabbers++ < 4)
  537. printk(KERN_DEBUG "mace: jabbering transceivern");
  538. }
  539. /*
  540.  * A transmit error has occurred. (We kick the transmit side from
  541.  * the DMA completion)
  542.  */
  543.  
  544. static void mace68k_xmit_error(struct net_device *dev)
  545. {
  546. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  547. volatile struct mace *mb = mp->mace;
  548. u8 xmtfs, xmtrc;
  549. xmtfs = mb->xmtfs;
  550. xmtrc = mb->xmtrc;
  551. if(xmtfs & XMTSV)
  552. {
  553. if(xmtfs & UFLO)
  554. {
  555. printk("%s: DMA underrun.n", dev->name);
  556. mp->stats.tx_errors++;
  557. mp->stats.tx_fifo_errors++;
  558. mace68k_reset(dev);
  559. }
  560. if(xmtfs & RTRY)
  561. mp->stats.collisions++;
  562. }
  563. mark_bh(NET_BH);
  564. }
  565. /*
  566.  * A receive interrupt occurred.
  567.  */
  568.  
  569. static void mace68k_recv_interrupt(struct net_device *dev)
  570. {
  571. // struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  572. // volatile struct mace *mb = mp->mace;
  573. }
  574. /*
  575.  * Process the chip interrupt
  576.  */
  577.  
  578. static void mace68k_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  579. {
  580. struct net_device *dev = (struct net_device *) dev_id;
  581. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  582. volatile struct mace *mb = mp->mace;
  583. u8 ir;
  584. ir = mb->ir;
  585. mace68k_handle_misc_intrs(mp, ir);
  586. if(ir&XMTINT)
  587. mace68k_xmit_error(dev);
  588. if(ir&RCVINT)
  589. mace68k_recv_interrupt(dev);
  590. }
  591. static void mace68k_tx_timeout(unsigned long data)
  592. {
  593. // struct net_device *dev = (struct net_device *) data;
  594. // struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  595. // volatile struct mace *mb = mp->mace;
  596. }
  597. /*
  598.  * Handle a newly arrived frame
  599.  */
  600.  
  601. static void mace_dma_rx_frame(struct net_device *dev, struct mace_frame *mf)
  602. {
  603. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  604. struct sk_buff *skb;
  605. if(mf->status&RS_OFLO)
  606. {
  607. printk("%s: fifo overflow.n", dev->name);
  608. mp->stats.rx_errors++;
  609. mp->stats.rx_fifo_errors++;
  610. }
  611. if(mf->status&(RS_CLSN|RS_FRAMERR|RS_FCSERR))
  612. mp->stats.rx_errors++;
  613. if(mf->status&RS_CLSN)
  614. mp->stats.collisions++;
  615. if(mf->status&RS_FRAMERR)
  616. mp->stats.rx_frame_errors++;
  617. if(mf->status&RS_FCSERR)
  618. mp->stats.rx_crc_errors++;
  619. skb = dev_alloc_skb(mf->len+2);
  620. if(skb==NULL)
  621. {
  622. mp->stats.rx_dropped++;
  623. return;
  624. }
  625. skb_reserve(skb,2);
  626. memcpy(skb_put(skb, mf->len), mf->data, mf->len);
  627. skb->protocol = eth_type_trans(skb, dev);
  628. netif_rx(skb);
  629. dev->last_rx = jiffies;
  630. mp->stats.rx_packets++;
  631. mp->stats.rx_bytes+=mf->len;
  632. }
  633. /*
  634.  * The PSC has passed us a DMA interrupt event.
  635.  */
  636.  
  637. static void mace68k_dma_intr(int irq, void *dev_id, struct pt_regs *regs)
  638. {
  639. struct net_device *dev = (struct net_device *) dev_id;
  640. struct mace68k_data *mp = (struct mace68k_data *) dev->priv;
  641. #if 0
  642. u32 psc_status;
  643. /* It seems this must be allowed to stabilise ?? */
  644. while((psc_status=psc_read_long(0x0804))!=psc_read_long(0x0804));
  645. /*
  646.  * Was this an ethernet event ?
  647.  */
  648.  
  649. if(psc_status&0x60000000)
  650. {
  651. #endif
  652. /*
  653.  * Process the read queue
  654.  */
  655.  
  656. u16 psc_status = psc_read_word(PSC_ENETRD_CTL);
  657. printk("mace68k_dma_intr: PSC_ENETRD_CTL = %04Xn", (uint) psc_status);
  658. if (psc_status & 0x2000) {
  659. mace68k_rxdma_reset(dev);
  660. mp->rx_done = 0;
  661. } else if (psc_status & 0x100) {
  662. int left;
  663. psc_write_word(PSC_ENETRD_CMD + mp->rx_slot, 0x1100);
  664. left=psc_read_long(PSC_ENETRD_LEN + mp->rx_slot);
  665. /* read packets */
  666. while(mp->rx_done < left)
  667. {
  668. struct mace_frame *mf=((struct mace_frame *)
  669. mp->rx_ring)+mp->rx_done++;
  670. mace_dma_rx_frame(dev, mf);
  671. }
  672. if(left == 0) /* Out of DMA room */
  673. {
  674. psc_load_rxdma_base(mp->rx_slot, 
  675. (void *)virt_to_phys(mp->rx_ring));
  676. mp->rx_slot^=16;
  677. mp->rx_done = 0;
  678. }
  679. else
  680. {
  681. psc_write_word(PSC_ENETRD_CMD+mp->rx_slot,
  682. 0x9800);
  683. }
  684. }
  685. /*
  686.  * Process the write queue
  687.  */
  688.  
  689. psc_status = psc_read_word(PSC_ENETWR_CTL);
  690. printk("mace68k_dma_intr: PSC_ENETWR_CTL = %04Xn", (uint) psc_status);
  691. /* apple's driver seems to loop over this until neither */
  692. /* condition is true.    - jmt                          */
  693. if (psc_status & 0x2000) {
  694. mace68k_txdma_reset(dev);
  695. } else if (psc_status & 0x0100) {
  696. psc_write_word(PSC_ENETWR_CMD + mp->tx_slot, 0x0100);
  697. mp->tx_slot ^=16;
  698. mp->tx_count++;
  699. dev->tbusy = 0;
  700. mark_bh(NET_BH);
  701. }
  702. #if 0
  703. }
  704. #endif
  705. }