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

Linux/Unix编程

开发平台:

Unix_Linux

  1. /*
  2.  * rrunner.c: Linux driver for the Essential RoadRunner HIPPI board.
  3.  *
  4.  * Copyright (C) 1998-2000 by Jes Sorensen, <Jes.Sorensen@cern.ch>.
  5.  *
  6.  * Thanks to Essential Communication for providing us with hardware
  7.  * and very comprehensive documentation without which I would not have
  8.  * been able to write this driver. A special thank you to John Gibbon
  9.  * for sorting out the legal issues, with the NDA, allowing the code to
  10.  * be released under the GPL.
  11.  *
  12.  * This program is free software; you can redistribute it and/or modify
  13.  * it under the terms of the GNU General Public License as published by
  14.  * the Free Software Foundation; either version 2 of the License, or
  15.  * (at your option) any later version.
  16.  *
  17.  * Thanks to Jayaram Bhat from ODS/Essential for fixing some of the
  18.  * stupid bugs in my code.
  19.  *
  20.  * Softnet support and various other patches from Val Henson of
  21.  * ODS/Essential.
  22.  */
  23. #define DEBUG 1
  24. #define RX_DMA_SKBUFF 1
  25. #define PKT_COPY_THRESHOLD 512
  26. #include <linux/config.h>
  27. #include <linux/module.h>
  28. #include <linux/version.h>
  29. #include <linux/types.h>
  30. #include <linux/errno.h>
  31. #include <linux/ioport.h>
  32. #include <linux/pci.h>
  33. #include <linux/kernel.h>
  34. #include <linux/netdevice.h>
  35. #include <linux/hippidevice.h>
  36. #include <linux/skbuff.h>
  37. #include <linux/init.h>
  38. #include <linux/delay.h>
  39. #include <linux/mm.h>
  40. #include <net/sock.h>
  41. #include <asm/system.h>
  42. #include <asm/cache.h>
  43. #include <asm/byteorder.h>
  44. #include <asm/io.h>
  45. #include <asm/irq.h>
  46. #include <asm/uaccess.h>
  47. #if (LINUX_VERSION_CODE < 0x02030e)
  48. #define net_device device
  49. #endif
  50. #if (LINUX_VERSION_CODE >= 0x02031b)
  51. #define NEW_NETINIT
  52. #endif
  53. #if (LINUX_VERSION_CODE < 0x02032b)
  54. /*
  55.  * SoftNet changes
  56.  */
  57. #define dev_kfree_skb_irq(a) dev_kfree_skb(a)
  58. #define netif_wake_queue(dev) clear_bit(0, &dev->tbusy)
  59. #define netif_stop_queue(dev) set_bit(0, &dev->tbusy)
  60. static inline void netif_start_queue(struct net_device *dev)
  61. {
  62. dev->tbusy = 0;
  63. dev->start = 1;
  64. }
  65. #define rr_mark_net_bh(foo) mark_bh(foo)
  66. #define rr_if_busy(dev)     dev->tbusy
  67. #define rr_if_running(dev)  dev->start /* Currently unused. */
  68. #define rr_if_down(dev)     do { dev->start = 0; } while (0)
  69. #else
  70. #define NET_BH              0
  71. #define rr_mark_net_bh(foo) do { } while(0)
  72. #define rr_if_busy(dev)     netif_queue_stopped(dev)
  73. #define rr_if_running(dev)  netif_running(dev)
  74. #define rr_if_down(dev)     do { } while(0)
  75. #endif
  76. #include "rrunner.h"
  77. #define RUN_AT(x) (jiffies + (x))
  78. /*
  79.  * Implementation notes:
  80.  *
  81.  * The DMA engine only allows for DMA within physical 64KB chunks of
  82.  * memory. The current approach of the driver (and stack) is to use
  83.  * linear blocks of memory for the skbuffs. However, as the data block
  84.  * is always the first part of the skb and skbs are 2^n aligned so we
  85.  * are guarantted to get the whole block within one 64KB align 64KB
  86.  * chunk.
  87.  *
  88.  * On the long term, relying on being able to allocate 64KB linear
  89.  * chunks of memory is not feasible and the skb handling code and the
  90.  * stack will need to know about I/O vectors or something similar.
  91.  */
  92. static char version[] __initdata = "rrunner.c: v0.22 03/01/2000  Jes Sorensen (Jes.Sorensen@cern.ch)n";
  93. static struct net_device *root_dev;
  94. /*
  95.  * These are checked at init time to see if they are at least 256KB
  96.  * and increased to 256KB if they are not. This is done to avoid ending
  97.  * up with socket buffers smaller than the MTU size,
  98.  */
  99. extern __u32 sysctl_wmem_max;
  100. extern __u32 sysctl_rmem_max;
  101. static int probed __initdata = 0;
  102. #if LINUX_VERSION_CODE >= 0x20400
  103. static struct pci_device_id rrunner_pci_tbl[] __initdata = {
  104. { PCI_VENDOR_ID_ESSENTIAL, PCI_DEVICE_ID_ESSENTIAL_ROADRUNNER, PCI_ANY_ID, PCI_ANY_ID, },
  105. { } /* Terminating entry */
  106. };
  107. MODULE_DEVICE_TABLE(pci, rrunner_pci_tbl);
  108. #endif /* LINUX_VERSION_CODE >= 0x20400 */
  109. #ifdef NEW_NETINIT
  110. int __init rr_hippi_probe (void)
  111. #else
  112. int __init rr_hippi_probe (struct net_device *dev)
  113. #endif
  114. {
  115. #ifdef NEW_NETINIT
  116. struct net_device *dev;
  117. #endif
  118. int boards_found = 0;
  119. int version_disp; /* was version info already displayed? */
  120. struct pci_dev *pdev = NULL;
  121. struct pci_dev *opdev = NULL;
  122. u8 pci_latency;
  123. struct rr_private *rrpriv;
  124. if (probed)
  125. return -ENODEV;
  126. probed++;
  127. version_disp = 0;
  128. while((pdev = pci_find_device(PCI_VENDOR_ID_ESSENTIAL,
  129.       PCI_DEVICE_ID_ESSENTIAL_ROADRUNNER,
  130.       pdev)))
  131. {
  132. if (pci_enable_device(pdev))
  133. continue;
  134. if (pdev == opdev)
  135. return 0;
  136. /*
  137.  * So we found our HIPPI ... time to tell the system.
  138.  */
  139. dev = init_hippi_dev(NULL, sizeof(struct rr_private));
  140. if (!dev)
  141. break;
  142. if (!dev->priv)
  143. dev->priv = kmalloc(sizeof(*rrpriv), GFP_KERNEL);
  144. if (!dev->priv)
  145. return -ENOMEM;
  146. rrpriv = (struct rr_private *)dev->priv;
  147. memset(rrpriv, 0, sizeof(*rrpriv));
  148. #ifdef CONFIG_SMP
  149. spin_lock_init(&rrpriv->lock);
  150. #endif
  151. sprintf(rrpriv->name, "RoadRunner serial HIPPI");
  152. dev->irq = pdev->irq;
  153. SET_MODULE_OWNER(dev);
  154. dev->open = &rr_open;
  155. dev->hard_start_xmit = &rr_start_xmit;
  156. dev->stop = &rr_close;
  157. dev->get_stats = &rr_get_stats;
  158. dev->do_ioctl = &rr_ioctl;
  159. #if (LINUX_VERSION_CODE < 0x02030d)
  160. dev->base_addr = pdev->base_address[0];
  161. #else
  162. dev->base_addr = pdev->resource[0].start;
  163. #endif
  164. /* display version info if adapter is found */
  165. if (!version_disp)
  166. {
  167. /* set display flag to TRUE so that */
  168. /* we only display this string ONCE */
  169. version_disp = 1;
  170. printk(version);
  171. }
  172. pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &pci_latency);
  173. if (pci_latency <= 0x58){
  174. pci_latency = 0x58;
  175. pci_write_config_byte(pdev, PCI_LATENCY_TIMER,
  176.       pci_latency);
  177. }
  178. pci_set_master(pdev);
  179. printk(KERN_INFO "%s: Essential RoadRunner serial HIPPI "
  180.        "at 0x%08lx, irq %i, PCI latency %in", dev->name,
  181.        dev->base_addr, dev->irq, pci_latency);
  182. /*
  183.  * Remap the regs into kernel space.
  184.  */
  185. rrpriv->regs = (struct rr_regs *)
  186. ioremap(dev->base_addr, 0x1000);
  187. if (!rrpriv->regs){
  188. printk(KERN_ERR "%s:  Unable to map I/O register, "
  189.        "RoadRunner %i will be disabled.n",
  190.        dev->name, boards_found);
  191. break;
  192. }
  193. /*
  194.  * Don't access any registes before this point!
  195.  */
  196. #ifdef __BIG_ENDIAN
  197. writel(readl(&regs->HostCtrl) | NO_SWAP, &regs->HostCtrl);
  198. #endif
  199. /*
  200.  * Need to add a case for little-endian 64-bit hosts here.
  201.  */
  202. rr_init(dev);
  203. boards_found++;
  204. dev->base_addr = 0;
  205. dev = NULL;
  206. opdev = pdev;
  207. }
  208. /*
  209.  * If we're at this point we're going through rr_hippi_probe()
  210.  * for the first time.  Return success (0) if we've initialized
  211.  * 1 or more boards. Otherwise, return failure (-ENODEV).
  212.  */
  213. #ifdef MODULE
  214. return boards_found;
  215. #else
  216. if (boards_found > 0)
  217. return 0;
  218. else
  219. return -ENODEV;
  220. #endif
  221. }
  222. #ifdef MODULE
  223. #if LINUX_VERSION_CODE > 0x20118
  224. MODULE_AUTHOR("Jes Sorensen <Jes.Sorensen@cern.ch>");
  225. MODULE_DESCRIPTION("Essential RoadRunner HIPPI driver");
  226. MODULE_LICENSE("GPL");
  227. #endif
  228. int init_module(void)
  229. {
  230. int cards;
  231. root_dev = NULL;
  232. #ifdef NEW_NETINIT
  233. cards = rr_hippi_probe();
  234. #else
  235. cards = rr_hippi_probe(NULL);
  236. #endif
  237. return cards ? 0 : -ENODEV;
  238. }
  239. void cleanup_module(void)
  240. {
  241. struct rr_private *rr;
  242. struct net_device *next;
  243. while (root_dev) {
  244. next = ((struct rr_private *)root_dev->priv)->next;
  245. rr = (struct rr_private *)root_dev->priv;
  246. if (!(readl(&rr->regs->HostCtrl) & NIC_HALTED)){
  247. printk(KERN_ERR "%s: trying to unload running NICn",
  248.        root_dev->name);
  249. writel(HALT_NIC, &rr->regs->HostCtrl);
  250. }
  251. iounmap(rr->regs);
  252. unregister_hipdev(root_dev);
  253. kfree(root_dev);
  254. root_dev = next;
  255. }
  256. }
  257. #endif
  258. /*
  259.  * Commands are considered to be slow, thus there is no reason to
  260.  * inline this.
  261.  */
  262. static void rr_issue_cmd(struct rr_private *rrpriv, struct cmd *cmd)
  263. {
  264. struct rr_regs *regs;
  265. u32 idx;
  266. regs = rrpriv->regs;
  267. /*
  268.  * This is temporary - it will go away in the final version.
  269.  * We probably also want to make this function inline.
  270.  */
  271. if (readl(&regs->HostCtrl) & NIC_HALTED){
  272. printk("issuing command for halted NIC, code 0x%x, "
  273.        "HostCtrl %08xn", cmd->code, readl(&regs->HostCtrl));
  274. if (readl(&regs->Mode) & FATAL_ERR)
  275. printk("error codes Fail1 %02x, Fail2 %02xn",
  276.        readl(&regs->Fail1), readl(&regs->Fail2));
  277. }
  278. idx = rrpriv->info->cmd_ctrl.pi;
  279. writel(*(u32*)(cmd), &regs->CmdRing[idx]);
  280. wmb();
  281. idx = (idx - 1) % CMD_RING_ENTRIES;
  282. rrpriv->info->cmd_ctrl.pi = idx;
  283. wmb();
  284. if (readl(&regs->Mode) & FATAL_ERR)
  285. printk("error code %02xn", readl(&regs->Fail1));
  286. }
  287. /*
  288.  * Reset the board in a sensible manner. The NIC is already halted
  289.  * when we get here and a spin-lock is held.
  290.  */
  291. static int rr_reset(struct net_device *dev)
  292. {
  293. struct rr_private *rrpriv;
  294. struct rr_regs *regs;
  295. struct eeprom *hw = NULL;
  296. u32 start_pc;
  297. int i;
  298. rrpriv = (struct rr_private *)dev->priv;
  299. regs = rrpriv->regs;
  300. rr_load_firmware(dev);
  301. writel(0x01000000, &regs->TX_state);
  302. writel(0xff800000, &regs->RX_state);
  303. writel(0, &regs->AssistState);
  304. writel(CLEAR_INTA, &regs->LocalCtrl);
  305. writel(0x01, &regs->BrkPt);
  306. writel(0, &regs->Timer);
  307. writel(0, &regs->TimerRef);
  308. writel(RESET_DMA, &regs->DmaReadState);
  309. writel(RESET_DMA, &regs->DmaWriteState);
  310. writel(0, &regs->DmaWriteHostHi);
  311. writel(0, &regs->DmaWriteHostLo);
  312. writel(0, &regs->DmaReadHostHi);
  313. writel(0, &regs->DmaReadHostLo);
  314. writel(0, &regs->DmaReadLen);
  315. writel(0, &regs->DmaWriteLen);
  316. writel(0, &regs->DmaWriteLcl);
  317. writel(0, &regs->DmaWriteIPchecksum);
  318. writel(0, &regs->DmaReadLcl);
  319. writel(0, &regs->DmaReadIPchecksum);
  320. writel(0, &regs->PciState);
  321. #if (BITS_PER_LONG == 64) && defined __LITTLE_ENDIAN
  322. writel(SWAP_DATA | PTR64BIT | PTR_WD_SWAP, &regs->Mode);
  323. #elif (BITS_PER_LONG == 64)
  324. writel(SWAP_DATA | PTR64BIT | PTR_WD_NOSWAP, &regs->Mode);
  325. #else
  326. writel(SWAP_DATA | PTR32BIT | PTR_WD_NOSWAP, &regs->Mode);
  327. #endif
  328. #if 0
  329. /*
  330.  * Don't worry, this is just black magic.
  331.  */
  332. writel(0xdf000, &regs->RxBase);
  333. writel(0xdf000, &regs->RxPrd);
  334. writel(0xdf000, &regs->RxCon);
  335. writel(0xce000, &regs->TxBase);
  336. writel(0xce000, &regs->TxPrd);
  337. writel(0xce000, &regs->TxCon);
  338. writel(0, &regs->RxIndPro);
  339. writel(0, &regs->RxIndCon);
  340. writel(0, &regs->RxIndRef);
  341. writel(0, &regs->TxIndPro);
  342. writel(0, &regs->TxIndCon);
  343. writel(0, &regs->TxIndRef);
  344. writel(0xcc000, &regs->pad10[0]);
  345. writel(0, &regs->DrCmndPro);
  346. writel(0, &regs->DrCmndCon);
  347. writel(0, &regs->DwCmndPro);
  348. writel(0, &regs->DwCmndCon);
  349. writel(0, &regs->DwCmndRef);
  350. writel(0, &regs->DrDataPro);
  351. writel(0, &regs->DrDataCon);
  352. writel(0, &regs->DrDataRef);
  353. writel(0, &regs->DwDataPro);
  354. writel(0, &regs->DwDataCon);
  355. writel(0, &regs->DwDataRef);
  356. #endif
  357. writel(0xffffffff, &regs->MbEvent);
  358. writel(0, &regs->Event);
  359. writel(0, &regs->TxPi);
  360. writel(0, &regs->IpRxPi);
  361. writel(0, &regs->EvtCon);
  362. writel(0, &regs->EvtPrd);
  363. rrpriv->info->evt_ctrl.pi = 0;
  364. for (i = 0; i < CMD_RING_ENTRIES; i++)
  365. writel(0, &regs->CmdRing[i]);
  366. /*
  367.  * Why 32 ? is this not cache line size dependant?
  368.  */
  369. writel(RBURST_64|WBURST_64, &regs->PciState);
  370. wmb();
  371. start_pc = rr_read_eeprom_word(rrpriv, &hw->rncd_info.FwStart);
  372. #if (DEBUG > 1)
  373. printk("%s: Executing firmware at address 0x%06xn",
  374.        dev->name, start_pc);
  375. #endif
  376. writel(start_pc + 0x800, &regs->Pc);
  377. wmb();
  378. udelay(5);
  379. writel(start_pc, &regs->Pc);
  380. wmb();
  381. return 0;
  382. }
  383. /*
  384.  * Read a string from the EEPROM.
  385.  */
  386. static unsigned int rr_read_eeprom(struct rr_private *rrpriv,
  387. unsigned long offset,
  388. unsigned char *buf,
  389. unsigned long length)
  390. {
  391. struct rr_regs *regs = rrpriv->regs;
  392. u32 misc, io, host, i;
  393. io = readl(&regs->ExtIo);
  394. writel(0, &regs->ExtIo);
  395. misc = readl(&regs->LocalCtrl);
  396. writel(0, &regs->LocalCtrl);
  397. host = readl(&regs->HostCtrl);
  398. writel(host | HALT_NIC, &regs->HostCtrl);
  399. mb();
  400. for (i = 0; i < length; i++){
  401. writel((EEPROM_BASE + ((offset+i) << 3)), &regs->WinBase);
  402. mb();
  403. buf[i] = (readl(&regs->WinData) >> 24) & 0xff;
  404. mb();
  405. }
  406. writel(host, &regs->HostCtrl);
  407. writel(misc, &regs->LocalCtrl);
  408. writel(io, &regs->ExtIo);
  409. mb();
  410. return i;
  411. }
  412. /*
  413.  * Shortcut to read one word (4 bytes) out of the EEPROM and convert
  414.  * it to our CPU byte-order.
  415.  */
  416. static u32 rr_read_eeprom_word(struct rr_private *rrpriv,
  417.     void * offset)
  418. {
  419. u32 word;
  420. if ((rr_read_eeprom(rrpriv, (unsigned long)offset,
  421.     (char *)&word, 4) == 4))
  422. return be32_to_cpu(word);
  423. return 0;
  424. }
  425. /*
  426.  * Write a string to the EEPROM.
  427.  *
  428.  * This is only called when the firmware is not running.
  429.  */
  430. static unsigned int write_eeprom(struct rr_private *rrpriv,
  431.  unsigned long offset,
  432.  unsigned char *buf,
  433.  unsigned long length)
  434. {
  435. struct rr_regs *regs = rrpriv->regs;
  436. u32 misc, io, data, i, j, ready, error = 0;
  437. io = readl(&regs->ExtIo);
  438. writel(0, &regs->ExtIo);
  439. misc = readl(&regs->LocalCtrl);
  440. writel(ENABLE_EEPROM_WRITE, &regs->LocalCtrl);
  441. mb();
  442. for (i = 0; i < length; i++){
  443. writel((EEPROM_BASE + ((offset+i) << 3)), &regs->WinBase);
  444. mb();
  445. data = buf[i] << 24;
  446. /*
  447.  * Only try to write the data if it is not the same
  448.  * value already.
  449.  */
  450. if ((readl(&regs->WinData) & 0xff000000) != data){
  451. writel(data, &regs->WinData);
  452. ready = 0;
  453. j = 0;
  454. mb();
  455. while(!ready){
  456. udelay(20);
  457. if ((readl(&regs->WinData) & 0xff000000) ==
  458.     data)
  459. ready = 1;
  460. mb();
  461. if (j++ > 5000){
  462. printk("data mismatch: %08x, "
  463.        "WinData %08xn", data,
  464.        readl(&regs->WinData));
  465. ready = 1;
  466. error = 1;
  467. }
  468. }
  469. }
  470. }
  471. writel(misc, &regs->LocalCtrl);
  472. writel(io, &regs->ExtIo);
  473. mb();
  474. return error;
  475. }
  476. static int __init rr_init(struct net_device *dev)
  477. {
  478. struct rr_private *rrpriv;
  479. struct rr_regs *regs;
  480. struct eeprom *hw = NULL;
  481. u32 sram_size, rev;
  482. int i;
  483. rrpriv = (struct rr_private *)dev->priv;
  484. regs = rrpriv->regs;
  485. rev = readl(&regs->FwRev);
  486. rrpriv->fw_rev = rev;
  487. if (rev > 0x00020024)
  488. printk("  Firmware revision: %i.%i.%in", (rev >> 16),
  489.        ((rev >> 8) & 0xff), (rev & 0xff));
  490. else if (rev >= 0x00020000) {
  491. printk("  Firmware revision: %i.%i.%i (2.0.37 or "
  492.        "later is recommended)n", (rev >> 16),
  493.        ((rev >> 8) & 0xff), (rev & 0xff));
  494. }else{
  495. printk("  Firmware revision too old: %i.%i.%i, please "
  496.        "upgrade to 2.0.37 or later.n",
  497.        (rev >> 16), ((rev >> 8) & 0xff), (rev & 0xff));
  498. }
  499. #if (DEBUG > 2)
  500. printk("  Maximum receive rings %in", readl(&regs->MaxRxRng));
  501. #endif
  502. /*
  503.  * Read the hardware address from the eeprom.  The HW address
  504.  * is not really necessary for HIPPI but awfully convenient.
  505.  * The pointer arithmetic to put it in dev_addr is ugly, but
  506.  * Donald Becker does it this way for the GigE version of this
  507.  * card and it's shorter and more portable than any
  508.  * other method I've seen.  -VAL
  509.  */
  510. *(u16 *)(dev->dev_addr) =
  511.   htons(rr_read_eeprom_word(rrpriv, &hw->manf.BoardULA));
  512. *(u32 *)(dev->dev_addr+2) =
  513.   htonl(rr_read_eeprom_word(rrpriv, &hw->manf.BoardULA[4]));
  514. printk("  MAC: ");
  515. for (i = 0; i < 5; i++)
  516. printk("%2.2x:", dev->dev_addr[i]);
  517. printk("%2.2xn", dev->dev_addr[i]);
  518. sram_size = rr_read_eeprom_word(rrpriv, (void *)8);
  519. printk("  SRAM size 0x%06xn", sram_size);
  520. if (sysctl_rmem_max < 262144){
  521. printk("  Receive socket buffer limit too low (%i), "
  522.        "setting to 262144n", sysctl_rmem_max);
  523. sysctl_rmem_max = 262144;
  524. }
  525. if (sysctl_wmem_max < 262144){
  526. printk("  Transmit socket buffer limit too low (%i), "
  527.        "setting to 262144n", sysctl_wmem_max);
  528. sysctl_wmem_max = 262144;
  529. }
  530. rrpriv->next = root_dev;
  531. root_dev = dev;
  532. return 0;
  533. }
  534. static int rr_init1(struct net_device *dev)
  535. {
  536. struct rr_private *rrpriv;
  537. struct rr_regs *regs;
  538. unsigned long myjif, flags;
  539. struct cmd cmd;
  540. u32 hostctrl;
  541. int ecode = 0;
  542. short i;
  543. rrpriv = (struct rr_private *)dev->priv;
  544. regs = rrpriv->regs;
  545. spin_lock_irqsave(&rrpriv->lock, flags);
  546. hostctrl = readl(&regs->HostCtrl);
  547. writel(hostctrl | HALT_NIC | RR_CLEAR_INT, &regs->HostCtrl);
  548. wmb();
  549. if (hostctrl & PARITY_ERR){
  550. printk("%s: Parity error halting NIC - this is serious!n",
  551.        dev->name);
  552. spin_unlock_irqrestore(&rrpriv->lock, flags);
  553. ecode = -EFAULT;
  554. goto error;
  555. }
  556. set_rxaddr(regs, rrpriv->rx_ctrl);
  557. set_infoaddr(regs, rrpriv->info);
  558. rrpriv->info->evt_ctrl.entry_size = sizeof(struct event);
  559. rrpriv->info->evt_ctrl.entries = EVT_RING_ENTRIES;
  560. rrpriv->info->evt_ctrl.mode = 0;
  561. rrpriv->info->evt_ctrl.pi = 0;
  562. set_rraddr(&rrpriv->info->evt_ctrl.rngptr, rrpriv->evt_ring);
  563. rrpriv->info->cmd_ctrl.entry_size = sizeof(struct cmd);
  564. rrpriv->info->cmd_ctrl.entries = CMD_RING_ENTRIES;
  565. rrpriv->info->cmd_ctrl.mode = 0;
  566. rrpriv->info->cmd_ctrl.pi = 15;
  567. for (i = 0; i < CMD_RING_ENTRIES; i++) {
  568. writel(0, &regs->CmdRing[i]);
  569. }
  570. for (i = 0; i < TX_RING_ENTRIES; i++) {
  571. rrpriv->tx_ring[i].size = 0;
  572. set_rraddr(&rrpriv->tx_ring[i].addr, 0);
  573. rrpriv->tx_skbuff[i] = 0;
  574. }
  575. rrpriv->info->tx_ctrl.entry_size = sizeof(struct tx_desc);
  576. rrpriv->info->tx_ctrl.entries = TX_RING_ENTRIES;
  577. rrpriv->info->tx_ctrl.mode = 0;
  578. rrpriv->info->tx_ctrl.pi = 0;
  579. set_rraddr(&rrpriv->info->tx_ctrl.rngptr, rrpriv->tx_ring);
  580. /*
  581.  * Set dirty_tx before we start receiving interrupts, otherwise
  582.  * the interrupt handler might think it is supposed to process
  583.  * tx ints before we are up and running, which may cause a null
  584.  * pointer access in the int handler.
  585.  */
  586. rrpriv->tx_full = 0;
  587. rrpriv->cur_rx = 0;
  588. rrpriv->dirty_rx = rrpriv->dirty_tx = 0;
  589. rr_reset(dev);
  590. /* Tuning values */
  591. writel(0x5000, &regs->ConRetry);
  592. writel(0x100, &regs->ConRetryTmr);
  593. writel(0x500000, &regs->ConTmout);
  594.   writel(0x60, &regs->IntrTmr);
  595. writel(0x500000, &regs->TxDataMvTimeout);
  596. writel(0x200000, &regs->RxDataMvTimeout);
  597.   writel(0x80, &regs->WriteDmaThresh);
  598.   writel(0x80, &regs->ReadDmaThresh);
  599. rrpriv->fw_running = 0;
  600. wmb();
  601. hostctrl &= ~(HALT_NIC | INVALID_INST_B | PARITY_ERR);
  602. writel(hostctrl, &regs->HostCtrl);
  603. wmb();
  604. spin_unlock_irqrestore(&rrpriv->lock, flags);
  605. for (i = 0; i < RX_RING_ENTRIES; i++) {
  606. struct sk_buff *skb;
  607. rrpriv->rx_ring[i].mode = 0;
  608. skb = alloc_skb(dev->mtu + HIPPI_HLEN, GFP_ATOMIC);
  609. if (!skb) {
  610. printk(KERN_WARNING "%s: Unable to allocate memory "
  611.        "for receive ring - halting NICn", dev->name);
  612. ecode = -ENOMEM;
  613. goto error;
  614. }
  615. rrpriv->rx_skbuff[i] = skb;
  616. /*
  617.  * Sanity test to see if we conflict with the DMA
  618.  * limitations of the Roadrunner.
  619.  */
  620. if ((((unsigned long)skb->data) & 0xfff) > ~65320)
  621. printk("skb alloc errorn");
  622. set_rraddr(&rrpriv->rx_ring[i].addr, skb->data);
  623. rrpriv->rx_ring[i].size = dev->mtu + HIPPI_HLEN;
  624. }
  625. rrpriv->rx_ctrl[4].entry_size = sizeof(struct rx_desc);
  626. rrpriv->rx_ctrl[4].entries = RX_RING_ENTRIES;
  627. rrpriv->rx_ctrl[4].mode = 8;
  628. rrpriv->rx_ctrl[4].pi = 0;
  629. wmb();
  630. set_rraddr(&rrpriv->rx_ctrl[4].rngptr, rrpriv->rx_ring);
  631. udelay(1000);
  632. /*
  633.  * Now start the FirmWare.
  634.  */
  635. cmd.code = C_START_FW;
  636. cmd.ring = 0;
  637. cmd.index = 0;
  638. rr_issue_cmd(rrpriv, &cmd);
  639. /*
  640.  * Give the FirmWare time to chew on the `get running' command.
  641.  */
  642. myjif = jiffies + 5 * HZ;
  643. while (time_before(jiffies, myjif) && !rrpriv->fw_running);
  644. netif_start_queue(dev);
  645. return ecode;
  646.  error:
  647. /*
  648.  * We might have gotten here because we are out of memory,
  649.  * make sure we release everything we allocated before failing
  650.  */
  651. for (i = 0; i < RX_RING_ENTRIES; i++) {
  652. if (rrpriv->rx_skbuff[i]) {
  653. rrpriv->rx_ring[i].size = 0;
  654. set_rraddr(&rrpriv->rx_ring[i].addr, 0);
  655. dev_kfree_skb(rrpriv->rx_skbuff[i]);
  656. }
  657. }
  658. return ecode;
  659. }
  660. /*
  661.  * All events are considered to be slow (RX/TX ints do not generate
  662.  * events) and are handled here, outside the main interrupt handler,
  663.  * to reduce the size of the handler.
  664.  */
  665. static u32 rr_handle_event(struct net_device *dev, u32 prodidx, u32 eidx)
  666. {
  667. struct rr_private *rrpriv;
  668. struct rr_regs *regs;
  669. u32 tmp;
  670. rrpriv = (struct rr_private *)dev->priv;
  671. regs = rrpriv->regs;
  672. while (prodidx != eidx){
  673. switch (rrpriv->evt_ring[eidx].code){
  674. case E_NIC_UP:
  675. tmp = readl(&regs->FwRev);
  676. printk(KERN_INFO "%s: Firmware revision %i.%i.%i "
  677.        "up and runningn", dev->name,
  678.        (tmp >> 16), ((tmp >> 8) & 0xff), (tmp & 0xff));
  679. rrpriv->fw_running = 1;
  680. writel(RX_RING_ENTRIES - 1, &regs->IpRxPi);
  681. wmb();
  682. break;
  683. case E_LINK_ON:
  684. printk(KERN_INFO "%s: Optical link ONn", dev->name);
  685. break;
  686. case E_LINK_OFF:
  687. printk(KERN_INFO "%s: Optical link OFFn", dev->name);
  688. break;
  689. case E_RX_IDLE:
  690. printk(KERN_WARNING "%s: RX data not movingn",
  691.        dev->name);
  692. goto drop;
  693. case E_WATCHDOG:
  694. printk(KERN_INFO "%s: The watchdog is here to see "
  695.        "usn", dev->name);
  696. break;
  697. case E_INTERN_ERR:
  698. printk(KERN_ERR "%s: HIPPI Internal NIC errorn",
  699.        dev->name);
  700. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  701.        &regs->HostCtrl);
  702. wmb();
  703. break;
  704. case E_HOST_ERR:
  705. printk(KERN_ERR "%s: Host software errorn",
  706.        dev->name);
  707. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  708.        &regs->HostCtrl);
  709. wmb();
  710. break;
  711. /*
  712.  * TX events.
  713.  */
  714. case E_CON_REJ:
  715. printk(KERN_WARNING "%s: Connection rejectedn",
  716.        dev->name);
  717. rrpriv->stats.tx_aborted_errors++;
  718. break;
  719. case E_CON_TMOUT:
  720. printk(KERN_WARNING "%s: Connection timeoutn",
  721.        dev->name);
  722. break;
  723. case E_DISC_ERR:
  724. printk(KERN_WARNING "%s: HIPPI disconnect errorn",
  725.        dev->name);
  726. rrpriv->stats.tx_aborted_errors++;
  727. break;
  728. case E_INT_PRTY:
  729. printk(KERN_ERR "%s: HIPPI Internal Parity errorn",
  730.        dev->name);
  731. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  732.        &regs->HostCtrl);
  733. wmb();
  734. break;
  735. case E_TX_IDLE:
  736. printk(KERN_WARNING "%s: Transmitter idlen",
  737.        dev->name);
  738. break;
  739. case E_TX_LINK_DROP:
  740. printk(KERN_WARNING "%s: Link lost during transmitn",
  741.        dev->name);
  742. rrpriv->stats.tx_aborted_errors++;
  743. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  744.        &regs->HostCtrl);
  745. wmb();
  746. break;
  747. case E_TX_INV_RNG:
  748. printk(KERN_ERR "%s: Invalid send ring blockn",
  749.        dev->name);
  750. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  751.        &regs->HostCtrl);
  752. wmb();
  753. break;
  754. case E_TX_INV_BUF:
  755. printk(KERN_ERR "%s: Invalid send buffer addressn",
  756.        dev->name);
  757. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  758.        &regs->HostCtrl);
  759. wmb();
  760. break;
  761. case E_TX_INV_DSC:
  762. printk(KERN_ERR "%s: Invalid descriptor addressn",
  763.        dev->name);
  764. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  765.        &regs->HostCtrl);
  766. wmb();
  767. break;
  768. /*
  769.  * RX events.
  770.  */
  771. case E_RX_RNG_OUT:
  772. printk(KERN_INFO "%s: Receive ring fulln", dev->name);
  773. break;
  774. case E_RX_PAR_ERR:
  775. printk(KERN_WARNING "%s: Receive parity errorn",
  776.        dev->name);
  777. goto drop;
  778. case E_RX_LLRC_ERR:
  779. printk(KERN_WARNING "%s: Receive LLRC errorn",
  780.        dev->name);
  781. goto drop;
  782. case E_PKT_LN_ERR:
  783. printk(KERN_WARNING "%s: Receive packet length "
  784.        "errorn", dev->name);
  785. goto drop;
  786. case E_DTA_CKSM_ERR:
  787. printk(KERN_WARNING "%s: Data checksum errorn",
  788.        dev->name);
  789. goto drop;
  790. case E_SHT_BST:
  791. printk(KERN_WARNING "%s: Unexpected short burst "
  792.        "errorn", dev->name);
  793. goto drop;
  794. case E_STATE_ERR:
  795. printk(KERN_WARNING "%s: Recv. state transition"
  796.        " errorn", dev->name);
  797. goto drop;
  798. case E_UNEXP_DATA:
  799. printk(KERN_WARNING "%s: Unexpected data errorn",
  800.        dev->name);
  801. goto drop;
  802. case E_LST_LNK_ERR:
  803. printk(KERN_WARNING "%s: Link lost errorn",
  804.        dev->name);
  805. goto drop;
  806. case E_FRM_ERR:
  807. printk(KERN_WARNING "%s: Framming Errorn",
  808.        dev->name);
  809. goto drop;
  810. case E_FLG_SYN_ERR:
  811. printk(KERN_WARNING "%s: Flag sync. lost during"
  812.        "packetn", dev->name);
  813. goto drop;
  814. case E_RX_INV_BUF:
  815. printk(KERN_ERR "%s: Invalid receive buffer "
  816.        "addressn", dev->name);
  817. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  818.        &regs->HostCtrl);
  819. wmb();
  820. break;
  821. case E_RX_INV_DSC:
  822. printk(KERN_ERR "%s: Invalid receive descriptor "
  823.        "addressn", dev->name);
  824. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  825.        &regs->HostCtrl);
  826. wmb();
  827. break;
  828. case E_RNG_BLK:
  829. printk(KERN_ERR "%s: Invalid ring blockn",
  830.        dev->name);
  831. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  832.        &regs->HostCtrl);
  833. wmb();
  834. break;
  835. drop:
  836. /* Label packet to be dropped.
  837.  * Actual dropping occurs in rx
  838.  * handling.
  839.  *
  840.  * The index of packet we get to drop is
  841.  * the index of the packet following
  842.  * the bad packet. -kbf
  843.  */
  844. {
  845. u16 index = rrpriv->evt_ring[eidx].index;
  846. index = (index + (RX_RING_ENTRIES - 1)) %
  847. RX_RING_ENTRIES;
  848. rrpriv->rx_ring[index].mode |=
  849. (PACKET_BAD | PACKET_END);
  850. }
  851. break;
  852. default:
  853. printk(KERN_WARNING "%s: Unhandled event 0x%02xn",
  854.        dev->name, rrpriv->evt_ring[eidx].code);
  855. }
  856. eidx = (eidx + 1) % EVT_RING_ENTRIES;
  857. }
  858. rrpriv->info->evt_ctrl.pi = eidx;
  859. wmb();
  860. return eidx;
  861. }
  862. static void rx_int(struct net_device *dev, u32 rxlimit, u32 index)
  863. {
  864. struct rr_private *rrpriv = (struct rr_private *)dev->priv;
  865. struct rr_regs *regs = rrpriv->regs;
  866. do {
  867. u32 pkt_len;
  868. pkt_len = rrpriv->rx_ring[index].size;
  869. #if (DEBUG > 2)
  870. printk("index %i, rxlimit %in", index, rxlimit);
  871. printk("len %x, mode %xn", pkt_len,
  872.        rrpriv->rx_ring[index].mode);
  873. #endif
  874. if ( (rrpriv->rx_ring[index].mode & PACKET_BAD) == PACKET_BAD){
  875. rrpriv->stats.rx_dropped++;
  876. goto defer;
  877. }
  878. if (pkt_len > 0){
  879. struct sk_buff *skb;
  880. if (pkt_len < PKT_COPY_THRESHOLD) {
  881. skb = alloc_skb(pkt_len, GFP_ATOMIC);
  882. if (skb == NULL){
  883. printk(KERN_WARNING "%s: Unable to allocate skb (%i bytes), deferring packetn", dev->name, pkt_len);
  884. rrpriv->stats.rx_dropped++;
  885. goto defer;
  886. }else
  887. memcpy(skb_put(skb, pkt_len),
  888.        rrpriv->rx_skbuff[index]->data,
  889.        pkt_len);
  890. }else{
  891. struct sk_buff *newskb;
  892. newskb = alloc_skb(dev->mtu + HIPPI_HLEN,
  893.    GFP_ATOMIC);
  894. if (newskb){
  895. skb = rrpriv->rx_skbuff[index];
  896. skb_put(skb, pkt_len);
  897. rrpriv->rx_skbuff[index] = newskb;
  898. set_rraddr(&rrpriv->rx_ring[index].addr, newskb->data);
  899. }else{
  900. printk("%s: Out of memory, deferring "
  901.        "packetn", dev->name);
  902. rrpriv->stats.rx_dropped++;
  903. goto defer;
  904. }
  905. }
  906. skb->dev = dev;
  907. skb->protocol = hippi_type_trans(skb, dev);
  908. netif_rx(skb); /* send it up */
  909. dev->last_rx = jiffies;
  910. rrpriv->stats.rx_packets++;
  911. rrpriv->stats.rx_bytes += pkt_len;
  912. }
  913. defer:
  914. rrpriv->rx_ring[index].mode = 0;
  915. rrpriv->rx_ring[index].size = dev->mtu + HIPPI_HLEN;
  916. if ((index & 7) == 7)
  917. writel(index, &regs->IpRxPi);
  918. index = (index + 1) % RX_RING_ENTRIES;
  919. } while(index != rxlimit);
  920. rrpriv->cur_rx = index;
  921. wmb();
  922. }
  923. static void rr_interrupt(int irq, void *dev_id, struct pt_regs *ptregs)
  924. {
  925. struct rr_private *rrpriv;
  926. struct rr_regs *regs;
  927. struct net_device *dev = (struct net_device *)dev_id;
  928. u32 prodidx, rxindex, eidx, txcsmr, rxlimit, txcon;
  929. rrpriv = (struct rr_private *)dev->priv;
  930. regs = rrpriv->regs;
  931. if (!(readl(&regs->HostCtrl) & RR_INT))
  932. return;
  933. spin_lock(&rrpriv->lock);
  934. prodidx = readl(&regs->EvtPrd);
  935. txcsmr = (prodidx >> 8) & 0xff;
  936. rxlimit = (prodidx >> 16) & 0xff;
  937. prodidx &= 0xff;
  938. #if (DEBUG > 2)
  939. printk("%s: interrupt, prodidx = %i, eidx = %in", dev->name,
  940.        prodidx, rrpriv->info->evt_ctrl.pi);
  941. #endif
  942. /*
  943.  * Order here is important.  We must handle events
  944.  * before doing anything else in order to catch
  945.  * such things as LLRC errors, etc -kbf
  946.  */
  947. eidx = rrpriv->info->evt_ctrl.pi;
  948. if (prodidx != eidx)
  949. eidx = rr_handle_event(dev, prodidx, eidx);
  950. rxindex = rrpriv->cur_rx;
  951. if (rxindex != rxlimit)
  952. rx_int(dev, rxlimit, rxindex);
  953. txcon = rrpriv->dirty_tx;
  954. if (txcsmr != txcon) {
  955. do {
  956. /* Due to occational firmware TX producer/consumer out
  957.  * of sync. error need to check entry in ring -kbf
  958.  */
  959. if(rrpriv->tx_skbuff[txcon]){
  960. rrpriv->stats.tx_packets++;
  961. rrpriv->stats.tx_bytes +=rrpriv->tx_skbuff[txcon]->len;
  962. dev_kfree_skb_irq(rrpriv->tx_skbuff[txcon]);
  963. rrpriv->tx_skbuff[txcon] = NULL;
  964. rrpriv->tx_ring[txcon].size = 0;
  965. set_rraddr(&rrpriv->tx_ring[txcon].addr, 0);
  966. rrpriv->tx_ring[txcon].mode = 0;
  967. }
  968. txcon = (txcon + 1) % TX_RING_ENTRIES;
  969. } while (txcsmr != txcon);
  970. wmb();
  971. rrpriv->dirty_tx = txcon;
  972. if (rrpriv->tx_full && rr_if_busy(dev) &&
  973.     (((rrpriv->info->tx_ctrl.pi + 1) % TX_RING_ENTRIES)
  974.      != rrpriv->dirty_tx)){
  975. rrpriv->tx_full = 0;
  976. netif_wake_queue(dev);
  977. rr_mark_net_bh(NET_BH);
  978. }
  979. }
  980. eidx |= ((txcsmr << 8) | (rxlimit << 16));
  981. writel(eidx, &regs->EvtCon);
  982. wmb();
  983. spin_unlock(&rrpriv->lock);
  984. }
  985. static void rr_timer(unsigned long data)
  986. {
  987. struct net_device *dev = (struct net_device *)data;
  988. struct rr_private *rrpriv = (struct rr_private *)dev->priv;
  989. struct rr_regs *regs = rrpriv->regs;
  990. unsigned long flags;
  991. int i;
  992. if (readl(&regs->HostCtrl) & NIC_HALTED){
  993. printk("%s: Restarting nicn", dev->name);
  994. memset(rrpriv->rx_ctrl, 0, 256 * sizeof(struct ring_ctrl));
  995. memset(rrpriv->info, 0, sizeof(struct rr_info));
  996. wmb();
  997. for (i = 0; i < TX_RING_ENTRIES; i++) {
  998. if (rrpriv->tx_skbuff[i]) {
  999. rrpriv->tx_ring[i].size = 0;
  1000. set_rraddr(&rrpriv->tx_ring[i].addr, 0);
  1001. dev_kfree_skb(rrpriv->tx_skbuff[i]);
  1002. rrpriv->tx_skbuff[i] = NULL;
  1003. }
  1004. }
  1005. for (i = 0; i < RX_RING_ENTRIES; i++) {
  1006. if (rrpriv->rx_skbuff[i]) {
  1007. rrpriv->rx_ring[i].size = 0;
  1008. set_rraddr(&rrpriv->rx_ring[i].addr, 0);
  1009. dev_kfree_skb(rrpriv->rx_skbuff[i]);
  1010. rrpriv->rx_skbuff[i] = NULL;
  1011. }
  1012. }
  1013. if (rr_init1(dev)) {
  1014. spin_lock_irqsave(&rrpriv->lock, flags);
  1015. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, 
  1016.        &regs->HostCtrl);
  1017. spin_unlock_irqrestore(&rrpriv->lock, flags);
  1018. }
  1019. }
  1020. rrpriv->timer.expires = RUN_AT(5*HZ);
  1021. add_timer(&rrpriv->timer);
  1022. }
  1023. static int rr_open(struct net_device *dev)
  1024. {
  1025. struct rr_private *rrpriv;
  1026. struct rr_regs *regs;
  1027. int ecode = 0;
  1028. unsigned long flags;
  1029. rrpriv = (struct rr_private *)dev->priv;
  1030. regs = rrpriv->regs;
  1031. if (rrpriv->fw_rev < 0x00020000) {
  1032. printk(KERN_WARNING "%s: trying to configure device with "
  1033.        "obsolete firmwaren", dev->name);
  1034. ecode = -EBUSY;
  1035. goto error;
  1036. }
  1037. rrpriv->rx_ctrl = kmalloc(256*sizeof(struct ring_ctrl), GFP_KERNEL);
  1038. if (!rrpriv->rx_ctrl) {
  1039. ecode = -ENOMEM;
  1040. goto error;
  1041. }
  1042. rrpriv->info = kmalloc(sizeof(struct rr_info), GFP_KERNEL);
  1043. if (!rrpriv->info){
  1044. rrpriv->rx_ctrl = NULL;
  1045. ecode = -ENOMEM;
  1046. goto error;
  1047. }
  1048. memset(rrpriv->rx_ctrl, 0, 256 * sizeof(struct ring_ctrl));
  1049. memset(rrpriv->info, 0, sizeof(struct rr_info));
  1050. wmb();
  1051. spin_lock_irqsave(&rrpriv->lock, flags);
  1052. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, &regs->HostCtrl);
  1053. spin_unlock_irqrestore(&rrpriv->lock, flags);
  1054. if (request_irq(dev->irq, rr_interrupt, SA_SHIRQ, rrpriv->name, dev))
  1055. {
  1056. printk(KERN_WARNING "%s: Requested IRQ %d is busyn",
  1057.        dev->name, dev->irq);
  1058. ecode = -EAGAIN;
  1059. goto error;
  1060. }
  1061. if ((ecode = rr_init1(dev)))
  1062. goto error;
  1063. /* Set the timer to switch to check for link beat and perhaps switch
  1064.    to an alternate media type. */
  1065. init_timer(&rrpriv->timer);
  1066. rrpriv->timer.expires = RUN_AT(5*HZ);           /* 5 sec. watchdog */
  1067. rrpriv->timer.data = (unsigned long)dev;
  1068. rrpriv->timer.function = &rr_timer;               /* timer handler */
  1069. add_timer(&rrpriv->timer);
  1070. netif_start_queue(dev);
  1071. return ecode;
  1072.  error:
  1073. spin_lock_irqsave(&rrpriv->lock, flags);
  1074. writel(readl(&regs->HostCtrl)|HALT_NIC|RR_CLEAR_INT, &regs->HostCtrl);
  1075. spin_unlock_irqrestore(&rrpriv->lock, flags);
  1076. if (rrpriv->info) {
  1077. kfree(rrpriv->info);
  1078. rrpriv->info = NULL;
  1079. }
  1080. if (rrpriv->rx_ctrl) {
  1081. kfree(rrpriv->rx_ctrl);
  1082. rrpriv->rx_ctrl = NULL;
  1083. }
  1084. netif_stop_queue(dev);
  1085. rr_if_down(dev);
  1086. return ecode;
  1087. }
  1088. static void rr_dump(struct net_device *dev)
  1089. {
  1090. struct rr_private *rrpriv;
  1091. struct rr_regs *regs;
  1092. u32 index, cons;
  1093. short i;
  1094. int len;
  1095. rrpriv = (struct rr_private *)dev->priv;
  1096. regs = rrpriv->regs;
  1097. printk("%s: dumping NIC TX ringsn", dev->name);
  1098. printk("RxPrd %08x, TxPrd %02x, EvtPrd %08x, TxPi %02x, TxCtrlPi %02xn",
  1099.        readl(&regs->RxPrd), readl(&regs->TxPrd),
  1100.        readl(&regs->EvtPrd), readl(&regs->TxPi),
  1101.        rrpriv->info->tx_ctrl.pi);
  1102. printk("Error code 0x%xn", readl(&regs->Fail1));
  1103. index = (((readl(&regs->EvtPrd) >> 8) & 0xff ) - 1) % EVT_RING_ENTRIES;
  1104. cons = rrpriv->dirty_tx;
  1105. printk("TX ring index %i, TX consumer %in",
  1106.        index, cons);
  1107. if (rrpriv->tx_skbuff[index]){
  1108. len = min_t(int, 0x80, rrpriv->tx_skbuff[index]->len);
  1109. printk("skbuff for index %i is valid - dumping data (0x%x bytes - DMA len 0x%x)n", index, len, rrpriv->tx_ring[index].size);
  1110. for (i = 0; i < len; i++){
  1111. if (!(i & 7))
  1112. printk("n");
  1113. printk("%02x ", (unsigned char) rrpriv->tx_skbuff[index]->data[i]);
  1114. }
  1115. printk("n");
  1116. }
  1117. if (rrpriv->tx_skbuff[cons]){
  1118. len = min_t(int, 0x80, rrpriv->tx_skbuff[cons]->len);
  1119. printk("skbuff for cons %i is valid - dumping data (0x%x bytes - skbuff len 0x%x)n", cons, len, rrpriv->tx_skbuff[cons]->len);
  1120. printk("mode 0x%x, size 0x%x,n phys %08x (virt %08lx), skbuff-addr %08lx, truesize 0x%xn",
  1121.        rrpriv->tx_ring[cons].mode,
  1122.        rrpriv->tx_ring[cons].size,
  1123.        rrpriv->tx_ring[cons].addr.addrlo,
  1124.        (unsigned long)bus_to_virt(rrpriv->tx_ring[cons].addr.addrlo),
  1125.        (unsigned long)rrpriv->tx_skbuff[cons]->data,
  1126.        (unsigned int)rrpriv->tx_skbuff[cons]->truesize);
  1127. for (i = 0; i < len; i++){
  1128. if (!(i & 7))
  1129. printk("n");
  1130. printk("%02x ", (unsigned char)rrpriv->tx_ring[cons].size);
  1131. }
  1132. printk("n");
  1133. }
  1134. printk("dumping TX ring info:n");
  1135. for (i = 0; i < TX_RING_ENTRIES; i++)
  1136. printk("mode 0x%x, size 0x%x, phys-addr %08xn",
  1137.        rrpriv->tx_ring[i].mode,
  1138.        rrpriv->tx_ring[i].size,
  1139.        rrpriv->tx_ring[i].addr.addrlo);
  1140. }
  1141. static int rr_close(struct net_device *dev)
  1142. {
  1143. struct rr_private *rrpriv;
  1144. struct rr_regs *regs;
  1145. u32 tmp;
  1146. short i;
  1147. netif_stop_queue(dev);
  1148. rr_if_down(dev);
  1149. rrpriv = (struct rr_private *)dev->priv;
  1150. regs = rrpriv->regs;
  1151. /*
  1152.  * Lock to make sure we are not cleaning up while another CPU
  1153.  * handling interrupts.
  1154.  */
  1155. spin_lock(&rrpriv->lock);
  1156. tmp = readl(&regs->HostCtrl);
  1157. if (tmp & NIC_HALTED){
  1158. printk("%s: NIC already haltedn", dev->name);
  1159. rr_dump(dev);
  1160. }else{
  1161. tmp |= HALT_NIC | RR_CLEAR_INT;
  1162. writel(tmp, &regs->HostCtrl);
  1163. wmb();
  1164. }
  1165. rrpriv->fw_running = 0;
  1166. del_timer(&rrpriv->timer);
  1167. writel(0, &regs->TxPi);
  1168. writel(0, &regs->IpRxPi);
  1169. writel(0, &regs->EvtCon);
  1170. writel(0, &regs->EvtPrd);
  1171. for (i = 0; i < CMD_RING_ENTRIES; i++)
  1172. writel(0, &regs->CmdRing[i]);
  1173. rrpriv->info->tx_ctrl.entries = 0;
  1174. rrpriv->info->cmd_ctrl.pi = 0;
  1175. rrpriv->info->evt_ctrl.pi = 0;
  1176. rrpriv->rx_ctrl[4].entries = 0;
  1177. for (i = 0; i < TX_RING_ENTRIES; i++) {
  1178. if (rrpriv->tx_skbuff[i]) {
  1179. rrpriv->tx_ring[i].size = 0;
  1180. set_rraddr(&rrpriv->tx_ring[i].addr, 0);
  1181. dev_kfree_skb(rrpriv->tx_skbuff[i]);
  1182. rrpriv->tx_skbuff[i] = NULL;
  1183. }
  1184. }
  1185. for (i = 0; i < RX_RING_ENTRIES; i++) {
  1186. if (rrpriv->rx_skbuff[i]) {
  1187. rrpriv->rx_ring[i].size = 0;
  1188. set_rraddr(&rrpriv->rx_ring[i].addr, 0);
  1189. dev_kfree_skb(rrpriv->rx_skbuff[i]);
  1190. rrpriv->rx_skbuff[i] = NULL;
  1191. }
  1192. }
  1193. if (rrpriv->rx_ctrl) {
  1194. kfree(rrpriv->rx_ctrl);
  1195. rrpriv->rx_ctrl = NULL;
  1196. }
  1197. if (rrpriv->info) {
  1198. kfree(rrpriv->info);
  1199. rrpriv->info = NULL;
  1200. }
  1201. free_irq(dev->irq, dev);
  1202. spin_unlock(&rrpriv->lock);
  1203. return 0;
  1204. }
  1205. static int rr_start_xmit(struct sk_buff *skb, struct net_device *dev)
  1206. {
  1207. struct rr_private *rrpriv = (struct rr_private *)dev->priv;
  1208. struct rr_regs *regs = rrpriv->regs;
  1209. struct ring_ctrl *txctrl;
  1210. unsigned long flags;
  1211. u32 index, len = skb->len;
  1212. u32 *ifield;
  1213. struct sk_buff *new_skb;
  1214. if (readl(&regs->Mode) & FATAL_ERR)
  1215. printk("error codes Fail1 %02x, Fail2 %02xn",
  1216.        readl(&regs->Fail1), readl(&regs->Fail2));
  1217. /*
  1218.  * We probably need to deal with tbusy here to prevent overruns.
  1219.  */
  1220. if (skb_headroom(skb) < 8){
  1221. printk("incoming skb too small - reallocatingn");
  1222. if (!(new_skb = dev_alloc_skb(len + 8))) {
  1223. dev_kfree_skb(skb);
  1224. netif_wake_queue(dev);
  1225. return -EBUSY;
  1226. }
  1227. skb_reserve(new_skb, 8);
  1228. skb_put(new_skb, len);
  1229. memcpy(new_skb->data, skb->data, len);
  1230. dev_kfree_skb(skb);
  1231. skb = new_skb;
  1232. }
  1233. ifield = (u32 *)skb_push(skb, 8);
  1234. ifield[0] = 0;
  1235. ifield[1] = skb->private.ifield;
  1236. /*
  1237.  * We don't need the lock before we are actually going to start
  1238.  * fiddling with the control blocks.
  1239.  */
  1240. spin_lock_irqsave(&rrpriv->lock, flags);
  1241. txctrl = &rrpriv->info->tx_ctrl;
  1242. index = txctrl->pi;
  1243. rrpriv->tx_skbuff[index] = skb;
  1244. set_rraddr(&rrpriv->tx_ring[index].addr, skb->data);
  1245. rrpriv->tx_ring[index].size = len + 8; /* include IFIELD */
  1246. rrpriv->tx_ring[index].mode = PACKET_START | PACKET_END;
  1247. txctrl->pi = (index + 1) % TX_RING_ENTRIES;
  1248. wmb();
  1249. writel(txctrl->pi, &regs->TxPi);
  1250. if (txctrl->pi == rrpriv->dirty_tx){
  1251. rrpriv->tx_full = 1;
  1252. netif_stop_queue(dev);
  1253. }
  1254. spin_unlock_irqrestore(&rrpriv->lock, flags);
  1255. dev->trans_start = jiffies;
  1256. return 0;
  1257. }
  1258. static struct net_device_stats *rr_get_stats(struct net_device *dev)
  1259. {
  1260. struct rr_private *rrpriv;
  1261. rrpriv = (struct rr_private *)dev->priv;
  1262. return(&rrpriv->stats);
  1263. }
  1264. /*
  1265.  * Read the firmware out of the EEPROM and put it into the SRAM
  1266.  * (or from user space - later)
  1267.  *
  1268.  * This operation requires the NIC to be halted and is performed with
  1269.  * interrupts disabled and with the spinlock hold.
  1270.  */
  1271. static int rr_load_firmware(struct net_device *dev)
  1272. {
  1273. struct rr_private *rrpriv;
  1274. struct rr_regs *regs;
  1275. unsigned long eptr, segptr;
  1276. int i, j;
  1277. u32 localctrl, sptr, len, tmp;
  1278. u32 p2len, p2size, nr_seg, revision, io, sram_size;
  1279. struct eeprom *hw = NULL;
  1280. rrpriv = (struct rr_private *)dev->priv;
  1281. regs = rrpriv->regs;
  1282. if (dev->flags & IFF_UP)
  1283. return -EBUSY;
  1284. if (!(readl(&regs->HostCtrl) & NIC_HALTED)){
  1285. printk("%s: Trying to load firmware to a running NIC.n", 
  1286.        dev->name);
  1287. return -EBUSY;
  1288. }
  1289. localctrl = readl(&regs->LocalCtrl);
  1290. writel(0, &regs->LocalCtrl);
  1291. writel(0, &regs->EvtPrd);
  1292. writel(0, &regs->RxPrd);
  1293. writel(0, &regs->TxPrd);
  1294. /*
  1295.  * First wipe the entire SRAM, otherwise we might run into all
  1296.  * kinds of trouble ... sigh, this took almost all afternoon
  1297.  * to track down ;-(
  1298.  */
  1299. io = readl(&regs->ExtIo);
  1300. writel(0, &regs->ExtIo);
  1301. sram_size = rr_read_eeprom_word(rrpriv, (void *)8);
  1302. for (i = 200; i < sram_size / 4; i++){
  1303. writel(i * 4, &regs->WinBase);
  1304. mb();
  1305. writel(0, &regs->WinData);
  1306. mb();
  1307. }
  1308. writel(io, &regs->ExtIo);
  1309. mb();
  1310. eptr = (unsigned long)rr_read_eeprom_word(rrpriv,
  1311.        &hw->rncd_info.AddrRunCodeSegs);
  1312. eptr = ((eptr & 0x1fffff) >> 3);
  1313. p2len = rr_read_eeprom_word(rrpriv, (void *)(0x83*4));
  1314. p2len = (p2len << 2);
  1315. p2size = rr_read_eeprom_word(rrpriv, (void *)(0x84*4));
  1316. p2size = ((p2size & 0x1fffff) >> 3);
  1317. if ((eptr < p2size) || (eptr > (p2size + p2len))){
  1318. printk("%s: eptr is invalidn", dev->name);
  1319. goto out;
  1320. }
  1321. revision = rr_read_eeprom_word(rrpriv, &hw->manf.HeaderFmt);
  1322. if (revision != 1){
  1323. printk("%s: invalid firmware format (%i)n",
  1324.        dev->name, revision);
  1325. goto out;
  1326. }
  1327. nr_seg = rr_read_eeprom_word(rrpriv, (void *)eptr);
  1328. eptr +=4;
  1329. #if (DEBUG > 1)
  1330. printk("%s: nr_seg %in", dev->name, nr_seg);
  1331. #endif
  1332. for (i = 0; i < nr_seg; i++){
  1333. sptr = rr_read_eeprom_word(rrpriv, (void *)eptr);
  1334. eptr += 4;
  1335. len = rr_read_eeprom_word(rrpriv, (void *)eptr);
  1336. eptr += 4;
  1337. segptr = (unsigned long)rr_read_eeprom_word(rrpriv, (void *)eptr);
  1338. segptr = ((segptr & 0x1fffff) >> 3);
  1339. eptr += 4;
  1340. #if (DEBUG > 1)
  1341. printk("%s: segment %i, sram address %06x, length %04x, segptr %06xn",
  1342.        dev->name, i, sptr, len, segptr);
  1343. #endif
  1344. for (j = 0; j < len; j++){
  1345. tmp = rr_read_eeprom_word(rrpriv, (void *)segptr);
  1346. writel(sptr, &regs->WinBase);
  1347. mb();
  1348. writel(tmp, &regs->WinData);
  1349. mb();
  1350. segptr += 4;
  1351. sptr += 4;
  1352. }
  1353. }
  1354. out:
  1355. writel(localctrl, &regs->LocalCtrl);
  1356. mb();
  1357. return 0;
  1358. }
  1359. static int rr_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
  1360. {
  1361. struct rr_private *rrpriv;
  1362. unsigned char *image, *oldimage;
  1363. unsigned int i;
  1364. int error = -EOPNOTSUPP;
  1365. rrpriv = dev->priv;
  1366. switch(cmd){
  1367. case SIOCRRGFW:
  1368. if (!capable(CAP_SYS_RAWIO)){
  1369. return -EPERM;
  1370. }
  1371. image = kmalloc(EEPROM_WORDS * sizeof(u32), GFP_KERNEL);
  1372. if (!image){
  1373. printk(KERN_ERR "%s: Unable to allocate memory "
  1374.        "for EEPROM imagen", dev->name);
  1375. return -ENOMEM;
  1376. }
  1377. spin_lock(&rrpriv->lock);
  1378. if (rrpriv->fw_running){
  1379. printk("%s: Firmware already runningn", dev->name);
  1380. error = -EPERM;
  1381. goto out_spin;
  1382. }
  1383. i = rr_read_eeprom(rrpriv, 0, image, EEPROM_BYTES);
  1384. if (i != EEPROM_BYTES){
  1385. printk(KERN_ERR "%s: Error reading EEPROMn", dev->name);
  1386. error = -EFAULT;
  1387. goto out_spin;
  1388. }
  1389. spin_unlock(&rrpriv->lock);
  1390. error = copy_to_user(rq->ifr_data, image, EEPROM_BYTES);
  1391. if (error)
  1392. error = -EFAULT;
  1393. kfree(image);
  1394. return error;
  1395. case SIOCRRPFW:
  1396. if (!capable(CAP_SYS_RAWIO)){
  1397. return -EPERM;
  1398. }
  1399. image = kmalloc(EEPROM_WORDS * sizeof(u32), GFP_KERNEL);
  1400. if (!image){
  1401. printk(KERN_ERR "%s: Unable to allocate memory "
  1402.        "for EEPROM imagen", dev->name);
  1403. return -ENOMEM;
  1404. }
  1405. oldimage = kmalloc(EEPROM_WORDS * sizeof(u32), GFP_KERNEL);
  1406. if (!oldimage){
  1407. kfree(image);
  1408. printk(KERN_ERR "%s: Unable to allocate memory "
  1409.        "for old EEPROM imagen", dev->name);
  1410. return -ENOMEM;
  1411. }
  1412. error = copy_from_user(image, rq->ifr_data, EEPROM_BYTES);
  1413. if (error) {
  1414. kfree(image);
  1415. kfree(oldimage);
  1416. return -EFAULT;
  1417. }
  1418. spin_lock(&rrpriv->lock);
  1419. if (rrpriv->fw_running){
  1420. kfree(oldimage);
  1421. printk("%s: Firmware already runningn", dev->name);
  1422. error = -EPERM;
  1423. goto out_spin;
  1424. }
  1425. printk("%s: Updating EEPROM firmwaren", dev->name);
  1426. error = write_eeprom(rrpriv, 0, image, EEPROM_BYTES);
  1427. if (error)
  1428. printk(KERN_ERR "%s: Error writing EEPROMn",
  1429.        dev->name);
  1430. i = rr_read_eeprom(rrpriv, 0, oldimage, EEPROM_BYTES);
  1431. if (i != EEPROM_BYTES)
  1432. printk(KERN_ERR "%s: Error reading back EEPROM "
  1433.        "imagen", dev->name);
  1434. spin_unlock(&rrpriv->lock);
  1435. error = memcmp(image, oldimage, EEPROM_BYTES);
  1436. if (error){
  1437. printk(KERN_ERR "%s: Error verifying EEPROM imagen",
  1438.        dev->name);
  1439. error = -EFAULT;
  1440. }
  1441. kfree(image);
  1442. kfree(oldimage);
  1443. return error;
  1444. case SIOCRRID:
  1445. return put_user(0x52523032, (int *)(&rq->ifr_data[0]));
  1446. default:
  1447. return error;
  1448. }
  1449.  out_spin:
  1450. kfree(image);
  1451. spin_unlock(&rrpriv->lock);
  1452. return error;
  1453. }
  1454. /*
  1455.  * Local variables:
  1456.  * compile-command: "gcc -D__KERNEL__ -I../../include -Wall -Wstrict-prototypes -O2 -pipe -fomit-frame-pointer -fno-strength-reduce -m486 -malign-loops=2 -malign-jumps=2 -malign-functions=2 -DMODULE -DMODVERSIONS -include ../../include/linux/modversions.h -c rrunner.c"
  1457.  * End:
  1458.  */