netxen_nic_main.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407
  1. /*
  2. * Copyright (C) 2003 - 2006 NetXen, Inc.
  3. * All rights reserved.
  4. *
  5. * This program is free software; you can redistribute it and/or
  6. * modify it under the terms of the GNU General Public License
  7. * as published by the Free Software Foundation; either version 2
  8. * of the License, or (at your option) any later version.
  9. *
  10. * This program is distributed in the hope that it will be useful, but
  11. * WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. *
  15. * You should have received a copy of the GNU General Public License
  16. * along with this program; if not, write to the Free Software
  17. * Foundation, Inc., 59 Temple Place - Suite 330, Boston,
  18. * MA 02111-1307, USA.
  19. *
  20. * The full GNU General Public License is included in this distribution
  21. * in the file called LICENSE.
  22. *
  23. * Contact Information:
  24. * info@netxen.com
  25. * NetXen,
  26. * 3965 Freedom Circle, Fourth floor,
  27. * Santa Clara, CA 95054
  28. *
  29. *
  30. * Main source file for NetXen NIC Driver on Linux
  31. *
  32. */
  33. #include <linux/vmalloc.h>
  34. #include <linux/highmem.h>
  35. #include "netxen_nic_hw.h"
  36. #include "netxen_nic.h"
  37. #include "netxen_nic_phan_reg.h"
  38. #include <linux/dma-mapping.h>
  39. #include <linux/vmalloc.h>
  40. #include <net/ip.h>
  41. MODULE_DESCRIPTION("NetXen Multi port (1/10) Gigabit Network Driver");
  42. MODULE_LICENSE("GPL");
  43. MODULE_VERSION(NETXEN_NIC_LINUX_VERSIONID);
  44. char netxen_nic_driver_name[] = "netxen-nic";
  45. static char netxen_nic_driver_string[] = "NetXen Network Driver version "
  46. NETXEN_NIC_LINUX_VERSIONID;
  47. #define NETXEN_NETDEV_WEIGHT 120
  48. #define NETXEN_ADAPTER_UP_MAGIC 777
  49. #define NETXEN_NIC_PEG_TUNE 0
  50. u8 nx_p2_id = NX_P2_C0;
  51. #define DMA_32BIT_MASK 0x00000000ffffffffULL
  52. #define DMA_35BIT_MASK 0x00000007ffffffffULL
  53. /* Local functions to NetXen NIC driver */
  54. static int __devinit netxen_nic_probe(struct pci_dev *pdev,
  55. const struct pci_device_id *ent);
  56. static void __devexit netxen_nic_remove(struct pci_dev *pdev);
  57. static int netxen_nic_open(struct net_device *netdev);
  58. static int netxen_nic_close(struct net_device *netdev);
  59. static int netxen_nic_xmit_frame(struct sk_buff *, struct net_device *);
  60. static void netxen_tx_timeout(struct net_device *netdev);
  61. static void netxen_tx_timeout_task(struct work_struct *work);
  62. static void netxen_watchdog(unsigned long);
  63. static int netxen_handle_int(struct netxen_adapter *, struct net_device *);
  64. static int netxen_nic_poll(struct net_device *dev, int *budget);
  65. #ifdef CONFIG_NET_POLL_CONTROLLER
  66. static void netxen_nic_poll_controller(struct net_device *netdev);
  67. #endif
  68. static irqreturn_t netxen_intr(int irq, void *data);
  69. int physical_port[] = {0, 1, 2, 3};
  70. /* PCI Device ID Table */
  71. static struct pci_device_id netxen_pci_tbl[] __devinitdata = {
  72. {PCI_DEVICE(0x4040, 0x0001)},
  73. {PCI_DEVICE(0x4040, 0x0002)},
  74. {PCI_DEVICE(0x4040, 0x0003)},
  75. {PCI_DEVICE(0x4040, 0x0004)},
  76. {PCI_DEVICE(0x4040, 0x0005)},
  77. {PCI_DEVICE(0x4040, 0x0024)},
  78. {PCI_DEVICE(0x4040, 0x0025)},
  79. {0,}
  80. };
  81. MODULE_DEVICE_TABLE(pci, netxen_pci_tbl);
  82. struct workqueue_struct *netxen_workq;
  83. static void netxen_watchdog(unsigned long);
  84. static inline void netxen_nic_update_cmd_producer(struct netxen_adapter *adapter,
  85. uint32_t crb_producer)
  86. {
  87. switch (adapter->portnum) {
  88. case 0:
  89. writel(crb_producer, NETXEN_CRB_NORMALIZE
  90. (adapter, CRB_CMD_PRODUCER_OFFSET));
  91. return;
  92. case 1:
  93. writel(crb_producer, NETXEN_CRB_NORMALIZE
  94. (adapter, CRB_CMD_PRODUCER_OFFSET_1));
  95. return;
  96. case 2:
  97. writel(crb_producer, NETXEN_CRB_NORMALIZE
  98. (adapter, CRB_CMD_PRODUCER_OFFSET_2));
  99. return;
  100. case 3:
  101. writel(crb_producer, NETXEN_CRB_NORMALIZE
  102. (adapter, CRB_CMD_PRODUCER_OFFSET_3));
  103. return;
  104. default:
  105. printk(KERN_WARNING "We tried to update "
  106. "CRB_CMD_PRODUCER_OFFSET for invalid "
  107. "PCI function id %d\n",
  108. adapter->portnum);
  109. return;
  110. }
  111. }
  112. static inline void netxen_nic_update_cmd_consumer(struct netxen_adapter *adapter,
  113. u32 crb_consumer)
  114. {
  115. switch (adapter->portnum) {
  116. case 0:
  117. writel(crb_consumer, NETXEN_CRB_NORMALIZE
  118. (adapter, CRB_CMD_CONSUMER_OFFSET));
  119. return;
  120. case 1:
  121. writel(crb_consumer, NETXEN_CRB_NORMALIZE
  122. (adapter, CRB_CMD_CONSUMER_OFFSET_1));
  123. return;
  124. case 2:
  125. writel(crb_consumer, NETXEN_CRB_NORMALIZE
  126. (adapter, CRB_CMD_CONSUMER_OFFSET_2));
  127. return;
  128. case 3:
  129. writel(crb_consumer, NETXEN_CRB_NORMALIZE
  130. (adapter, CRB_CMD_CONSUMER_OFFSET_3));
  131. return;
  132. default:
  133. printk(KERN_WARNING "We tried to update "
  134. "CRB_CMD_PRODUCER_OFFSET for invalid "
  135. "PCI function id %d\n",
  136. adapter->portnum);
  137. return;
  138. }
  139. }
  140. #define ADAPTER_LIST_SIZE 12
  141. int netxen_cards_found;
  142. static void netxen_nic_disable_int(struct netxen_adapter *adapter)
  143. {
  144. uint32_t mask = 0x7ff;
  145. int retries = 32;
  146. DPRINTK(1, INFO, "Entered ISR Disable \n");
  147. switch (adapter->portnum) {
  148. case 0:
  149. writel(0x0, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_0));
  150. break;
  151. case 1:
  152. writel(0x0, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_1));
  153. break;
  154. case 2:
  155. writel(0x0, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_2));
  156. break;
  157. case 3:
  158. writel(0x0, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_3));
  159. break;
  160. }
  161. if (adapter->intr_scheme != -1 &&
  162. adapter->intr_scheme != INTR_SCHEME_PERPORT)
  163. writel(mask,PCI_OFFSET_SECOND_RANGE(adapter, ISR_INT_MASK));
  164. /* Window = 0 or 1 */
  165. if (!(adapter->flags & NETXEN_NIC_MSI_ENABLED)) {
  166. do {
  167. writel(0xffffffff,
  168. PCI_OFFSET_SECOND_RANGE(adapter, ISR_INT_TARGET_STATUS));
  169. mask = readl(pci_base_offset(adapter, ISR_INT_VECTOR));
  170. if (!(mask & 0x80))
  171. break;
  172. udelay(10);
  173. } while (--retries);
  174. if (!retries) {
  175. printk(KERN_NOTICE "%s: Failed to disable interrupt completely\n",
  176. netxen_nic_driver_name);
  177. }
  178. }
  179. DPRINTK(1, INFO, "Done with Disable Int\n");
  180. }
  181. static void netxen_nic_enable_int(struct netxen_adapter *adapter)
  182. {
  183. u32 mask;
  184. DPRINTK(1, INFO, "Entered ISR Enable \n");
  185. if (adapter->intr_scheme != -1 &&
  186. adapter->intr_scheme != INTR_SCHEME_PERPORT) {
  187. switch (adapter->ahw.board_type) {
  188. case NETXEN_NIC_GBE:
  189. mask = 0x77b;
  190. break;
  191. case NETXEN_NIC_XGBE:
  192. mask = 0x77f;
  193. break;
  194. default:
  195. mask = 0x7ff;
  196. break;
  197. }
  198. writel(mask, PCI_OFFSET_SECOND_RANGE(adapter, ISR_INT_MASK));
  199. }
  200. switch (adapter->portnum) {
  201. case 0:
  202. writel(0x1, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_0));
  203. break;
  204. case 1:
  205. writel(0x1, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_1));
  206. break;
  207. case 2:
  208. writel(0x1, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_2));
  209. break;
  210. case 3:
  211. writel(0x1, NETXEN_CRB_NORMALIZE(adapter, CRB_SW_INT_MASK_3));
  212. break;
  213. }
  214. if (!(adapter->flags & NETXEN_NIC_MSI_ENABLED)) {
  215. mask = 0xbff;
  216. if (adapter->intr_scheme != -1 &&
  217. adapter->intr_scheme != INTR_SCHEME_PERPORT) {
  218. writel(0X0, NETXEN_CRB_NORMALIZE(adapter, CRB_INT_VECTOR));
  219. }
  220. writel(mask,
  221. PCI_OFFSET_SECOND_RANGE(adapter, ISR_INT_TARGET_MASK));
  222. }
  223. DPRINTK(1, INFO, "Done with enable Int\n");
  224. }
  225. /*
  226. * netxen_nic_probe()
  227. *
  228. * The Linux system will invoke this after identifying the vendor ID and
  229. * device Id in the pci_tbl supported by this module.
  230. *
  231. * A quad port card has one operational PCI config space, (function 0),
  232. * which is used to access all four ports.
  233. *
  234. * This routine will initialize the adapter, and setup the global parameters
  235. * along with the port's specific structure.
  236. */
  237. static int __devinit
  238. netxen_nic_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
  239. {
  240. struct net_device *netdev = NULL;
  241. struct netxen_adapter *adapter = NULL;
  242. void __iomem *mem_ptr0 = NULL;
  243. void __iomem *mem_ptr1 = NULL;
  244. void __iomem *mem_ptr2 = NULL;
  245. unsigned long first_page_group_end;
  246. unsigned long first_page_group_start;
  247. u8 __iomem *db_ptr = NULL;
  248. unsigned long mem_base, mem_len, db_base, db_len;
  249. int pci_using_dac, i = 0, err;
  250. int ring;
  251. struct netxen_recv_context *recv_ctx = NULL;
  252. struct netxen_rcv_desc_ctx *rcv_desc = NULL;
  253. struct netxen_cmd_buffer *cmd_buf_arr = NULL;
  254. u64 mac_addr[FLASH_NUM_PORTS + 1];
  255. int valid_mac = 0;
  256. u32 val;
  257. int pci_func_id = PCI_FUNC(pdev->devfn);
  258. printk(KERN_INFO "%s \n", netxen_nic_driver_string);
  259. if (pdev->class != 0x020000) {
  260. printk(KERN_ERR"NetXen function %d, class %x will not"
  261. "be enabled.\n",pci_func_id, pdev->class);
  262. return -ENODEV;
  263. }
  264. if ((err = pci_enable_device(pdev)))
  265. return err;
  266. if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
  267. err = -ENODEV;
  268. goto err_out_disable_pdev;
  269. }
  270. if ((err = pci_request_regions(pdev, netxen_nic_driver_name)))
  271. goto err_out_disable_pdev;
  272. pci_set_master(pdev);
  273. pci_read_config_byte(pdev, PCI_REVISION_ID, &nx_p2_id);
  274. if (nx_p2_id == NX_P2_C1 &&
  275. (pci_set_dma_mask(pdev, DMA_35BIT_MASK) == 0) &&
  276. (pci_set_consistent_dma_mask(pdev, DMA_35BIT_MASK) == 0)) {
  277. pci_using_dac = 1;
  278. } else {
  279. if ((err = pci_set_dma_mask(pdev, DMA_32BIT_MASK)) ||
  280. (err = pci_set_consistent_dma_mask(pdev, DMA_32BIT_MASK)))
  281. goto err_out_free_res;
  282. pci_using_dac = 0;
  283. }
  284. netdev = alloc_etherdev(sizeof(struct netxen_adapter));
  285. if(!netdev) {
  286. printk(KERN_ERR"%s: Failed to allocate memory for the "
  287. "device block.Check system memory resource"
  288. " usage.\n", netxen_nic_driver_name);
  289. goto err_out_free_res;
  290. }
  291. SET_MODULE_OWNER(netdev);
  292. SET_NETDEV_DEV(netdev, &pdev->dev);
  293. adapter = netdev->priv;
  294. memset(adapter, 0 , sizeof(struct netxen_adapter));
  295. adapter->ahw.pdev = pdev;
  296. adapter->ahw.pci_func = pci_func_id;
  297. spin_lock_init(&adapter->tx_lock);
  298. spin_lock_init(&adapter->lock);
  299. /* remap phys address */
  300. mem_base = pci_resource_start(pdev, 0); /* 0 is for BAR 0 */
  301. mem_len = pci_resource_len(pdev, 0);
  302. /* 128 Meg of memory */
  303. if (mem_len == NETXEN_PCI_128MB_SIZE) {
  304. mem_ptr0 = ioremap(mem_base, FIRST_PAGE_GROUP_SIZE);
  305. mem_ptr1 = ioremap(mem_base + SECOND_PAGE_GROUP_START,
  306. SECOND_PAGE_GROUP_SIZE);
  307. mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START,
  308. THIRD_PAGE_GROUP_SIZE);
  309. first_page_group_start = FIRST_PAGE_GROUP_START;
  310. first_page_group_end = FIRST_PAGE_GROUP_END;
  311. } else if (mem_len == NETXEN_PCI_32MB_SIZE) {
  312. mem_ptr1 = ioremap(mem_base, SECOND_PAGE_GROUP_SIZE);
  313. mem_ptr2 = ioremap(mem_base + THIRD_PAGE_GROUP_START -
  314. SECOND_PAGE_GROUP_START, THIRD_PAGE_GROUP_SIZE);
  315. first_page_group_start = 0;
  316. first_page_group_end = 0;
  317. } else {
  318. err = -EIO;
  319. goto err_out_free_netdev;
  320. }
  321. if (((mem_ptr0 == 0UL) && (mem_len == NETXEN_PCI_128MB_SIZE)) ||
  322. (mem_ptr1 == 0UL) || (mem_ptr2 == 0UL)) {
  323. DPRINTK(ERR,
  324. "Cannot remap adapter memory aborting.:"
  325. "0 -> %p, 1 -> %p, 2 -> %p\n",
  326. mem_ptr0, mem_ptr1, mem_ptr2);
  327. err = -EIO;
  328. goto err_out_iounmap;
  329. }
  330. db_base = pci_resource_start(pdev, 4); /* doorbell is on bar 4 */
  331. db_len = pci_resource_len(pdev, 4);
  332. if (db_len == 0) {
  333. printk(KERN_ERR "%s: doorbell is disabled\n",
  334. netxen_nic_driver_name);
  335. err = -EIO;
  336. goto err_out_iounmap;
  337. }
  338. DPRINTK(INFO, "doorbell ioremap from %lx a size of %lx\n", db_base,
  339. db_len);
  340. db_ptr = ioremap(db_base, NETXEN_DB_MAPSIZE_BYTES);
  341. if (!db_ptr) {
  342. printk(KERN_ERR "%s: Failed to allocate doorbell map.",
  343. netxen_nic_driver_name);
  344. err = -EIO;
  345. goto err_out_iounmap;
  346. }
  347. DPRINTK(INFO, "doorbell ioremaped at %p\n", db_ptr);
  348. adapter->ahw.pci_base0 = mem_ptr0;
  349. adapter->ahw.first_page_group_start = first_page_group_start;
  350. adapter->ahw.first_page_group_end = first_page_group_end;
  351. adapter->ahw.pci_base1 = mem_ptr1;
  352. adapter->ahw.pci_base2 = mem_ptr2;
  353. adapter->ahw.db_base = db_ptr;
  354. adapter->ahw.db_len = db_len;
  355. adapter->netdev = netdev;
  356. adapter->pdev = pdev;
  357. /* this will be read from FW later */
  358. adapter->intr_scheme = -1;
  359. /* This will be reset for mezz cards */
  360. adapter->portnum = pci_func_id;
  361. adapter->status &= ~NETXEN_NETDEV_STATUS;
  362. netdev->open = netxen_nic_open;
  363. netdev->stop = netxen_nic_close;
  364. netdev->hard_start_xmit = netxen_nic_xmit_frame;
  365. netdev->get_stats = netxen_nic_get_stats;
  366. netdev->set_multicast_list = netxen_nic_set_multi;
  367. netdev->set_mac_address = netxen_nic_set_mac;
  368. netdev->change_mtu = netxen_nic_change_mtu;
  369. netdev->tx_timeout = netxen_tx_timeout;
  370. netdev->watchdog_timeo = HZ;
  371. netxen_nic_change_mtu(netdev, netdev->mtu);
  372. SET_ETHTOOL_OPS(netdev, &netxen_nic_ethtool_ops);
  373. netdev->poll = netxen_nic_poll;
  374. netdev->weight = NETXEN_NETDEV_WEIGHT;
  375. #ifdef CONFIG_NET_POLL_CONTROLLER
  376. netdev->poll_controller = netxen_nic_poll_controller;
  377. #endif
  378. /* ScatterGather support */
  379. netdev->features = NETIF_F_SG;
  380. netdev->features |= NETIF_F_IP_CSUM;
  381. netdev->features |= NETIF_F_TSO;
  382. if (pci_using_dac)
  383. netdev->features |= NETIF_F_HIGHDMA;
  384. if (pci_enable_msi(pdev))
  385. adapter->flags &= ~NETXEN_NIC_MSI_ENABLED;
  386. else
  387. adapter->flags |= NETXEN_NIC_MSI_ENABLED;
  388. netdev->irq = pdev->irq;
  389. INIT_WORK(&adapter->tx_timeout_task, netxen_tx_timeout_task);
  390. /*
  391. * Set the CRB window to invalid. If any register in window 0 is
  392. * accessed it should set the window to 0 and then reset it to 1.
  393. */
  394. adapter->curr_window = 255;
  395. /* initialize the adapter */
  396. netxen_initialize_adapter_hw(adapter);
  397. /*
  398. * Adapter in our case is quad port so initialize it before
  399. * initializing the ports
  400. */
  401. netxen_initialize_adapter_ops(adapter);
  402. adapter->max_tx_desc_count = MAX_CMD_DESCRIPTORS_HOST;
  403. if ((adapter->ahw.boardcfg.board_type == NETXEN_BRDTYPE_P2_SB35_4G) ||
  404. (adapter->ahw.boardcfg.board_type ==
  405. NETXEN_BRDTYPE_P2_SB31_2G))
  406. adapter->max_rx_desc_count = MAX_RCV_DESCRIPTORS_1G;
  407. else
  408. adapter->max_rx_desc_count = MAX_RCV_DESCRIPTORS;
  409. adapter->max_jumbo_rx_desc_count = MAX_JUMBO_RCV_DESCRIPTORS;
  410. adapter->max_lro_rx_desc_count = MAX_LRO_RCV_DESCRIPTORS;
  411. cmd_buf_arr = (struct netxen_cmd_buffer *)vmalloc(TX_RINGSIZE);
  412. if (cmd_buf_arr == NULL) {
  413. printk(KERN_ERR
  414. "%s: Could not allocate cmd_buf_arr memory:%d\n",
  415. netxen_nic_driver_name, (int)TX_RINGSIZE);
  416. err = -ENOMEM;
  417. goto err_out_free_adapter;
  418. }
  419. memset(cmd_buf_arr, 0, TX_RINGSIZE);
  420. adapter->cmd_buf_arr = cmd_buf_arr;
  421. for (i = 0; i < MAX_RCV_CTX; ++i) {
  422. recv_ctx = &adapter->recv_ctx[i];
  423. for (ring = 0; ring < NUM_RCV_DESC_RINGS; ring++) {
  424. rcv_desc = &recv_ctx->rcv_desc[ring];
  425. switch (RCV_DESC_TYPE(ring)) {
  426. case RCV_DESC_NORMAL:
  427. rcv_desc->max_rx_desc_count =
  428. adapter->max_rx_desc_count;
  429. rcv_desc->flags = RCV_DESC_NORMAL;
  430. rcv_desc->dma_size = RX_DMA_MAP_LEN;
  431. rcv_desc->skb_size = MAX_RX_BUFFER_LENGTH;
  432. break;
  433. case RCV_DESC_JUMBO:
  434. rcv_desc->max_rx_desc_count =
  435. adapter->max_jumbo_rx_desc_count;
  436. rcv_desc->flags = RCV_DESC_JUMBO;
  437. rcv_desc->dma_size = RX_JUMBO_DMA_MAP_LEN;
  438. rcv_desc->skb_size = MAX_RX_JUMBO_BUFFER_LENGTH;
  439. break;
  440. case RCV_RING_LRO:
  441. rcv_desc->max_rx_desc_count =
  442. adapter->max_lro_rx_desc_count;
  443. rcv_desc->flags = RCV_DESC_LRO;
  444. rcv_desc->dma_size = RX_LRO_DMA_MAP_LEN;
  445. rcv_desc->skb_size = MAX_RX_LRO_BUFFER_LENGTH;
  446. break;
  447. }
  448. rcv_desc->rx_buf_arr = (struct netxen_rx_buffer *)
  449. vmalloc(RCV_BUFFSIZE);
  450. if (rcv_desc->rx_buf_arr == NULL) {
  451. printk(KERN_ERR "%s: Could not allocate"
  452. "rcv_desc->rx_buf_arr memory:%d\n",
  453. netxen_nic_driver_name,
  454. (int)RCV_BUFFSIZE);
  455. err = -ENOMEM;
  456. goto err_out_free_rx_buffer;
  457. }
  458. memset(rcv_desc->rx_buf_arr, 0, RCV_BUFFSIZE);
  459. }
  460. }
  461. netxen_initialize_adapter_sw(adapter); /* initialize the buffers in adapter */
  462. /* Mezz cards have PCI function 0,2,3 enabled */
  463. if ((adapter->ahw.boardcfg.board_type == NETXEN_BRDTYPE_P2_SB31_10G_IMEZ)
  464. && (pci_func_id >= 2))
  465. adapter->portnum = pci_func_id - 2;
  466. #ifdef CONFIG_IA64
  467. if(adapter->portnum == 0) {
  468. netxen_pinit_from_rom(adapter, 0);
  469. udelay(500);
  470. netxen_load_firmware(adapter);
  471. }
  472. #endif
  473. init_timer(&adapter->watchdog_timer);
  474. adapter->ahw.xg_linkup = 0;
  475. adapter->watchdog_timer.function = &netxen_watchdog;
  476. adapter->watchdog_timer.data = (unsigned long)adapter;
  477. INIT_WORK(&adapter->watchdog_task, netxen_watchdog_task);
  478. adapter->ahw.pdev = pdev;
  479. adapter->proc_cmd_buf_counter = 0;
  480. adapter->ahw.revision_id = nx_p2_id;
  481. /* make sure Window == 1 */
  482. netxen_nic_pci_change_crbwindow(adapter, 1);
  483. netxen_nic_update_cmd_producer(adapter, 0);
  484. netxen_nic_update_cmd_consumer(adapter, 0);
  485. writel(0, NETXEN_CRB_NORMALIZE(adapter, CRB_HOST_CMD_ADDR_LO));
  486. if (netxen_is_flash_supported(adapter) == 0 &&
  487. netxen_get_flash_mac_addr(adapter, mac_addr) == 0)
  488. valid_mac = 1;
  489. else
  490. valid_mac = 0;
  491. if (valid_mac) {
  492. unsigned char *p = (unsigned char *)&mac_addr[adapter->portnum];
  493. netdev->dev_addr[0] = *(p + 5);
  494. netdev->dev_addr[1] = *(p + 4);
  495. netdev->dev_addr[2] = *(p + 3);
  496. netdev->dev_addr[3] = *(p + 2);
  497. netdev->dev_addr[4] = *(p + 1);
  498. netdev->dev_addr[5] = *(p + 0);
  499. memcpy(netdev->perm_addr, netdev->dev_addr,
  500. netdev->addr_len);
  501. if (!is_valid_ether_addr(netdev->perm_addr)) {
  502. printk(KERN_ERR "%s: Bad MAC address "
  503. "%02x:%02x:%02x:%02x:%02x:%02x.\n",
  504. netxen_nic_driver_name,
  505. netdev->dev_addr[0],
  506. netdev->dev_addr[1],
  507. netdev->dev_addr[2],
  508. netdev->dev_addr[3],
  509. netdev->dev_addr[4],
  510. netdev->dev_addr[5]);
  511. } else {
  512. if (adapter->macaddr_set)
  513. adapter->macaddr_set(adapter,
  514. netdev->dev_addr);
  515. }
  516. }
  517. if (adapter->portnum == 0) {
  518. err = netxen_initialize_adapter_offload(adapter);
  519. if (err)
  520. goto err_out_free_rx_buffer;
  521. val = readl(NETXEN_CRB_NORMALIZE(adapter,
  522. NETXEN_CAM_RAM(0x1fc)));
  523. if (val == 0x55555555) {
  524. /* This is the first boot after power up */
  525. netxen_nic_read_w0(adapter, NETXEN_PCIE_REG(0x4), &val);
  526. if (!(val & 0x4)) {
  527. val |= 0x4;
  528. netxen_nic_write_w0(adapter, NETXEN_PCIE_REG(0x4), val);
  529. netxen_nic_read_w0(adapter, NETXEN_PCIE_REG(0x4), &val);
  530. if (!(val & 0x4))
  531. printk(KERN_ERR "%s: failed to set MSI bit in PCI-e reg\n",
  532. netxen_nic_driver_name);
  533. }
  534. val = readl(NETXEN_CRB_NORMALIZE(adapter,
  535. NETXEN_ROMUSB_GLB_SW_RESET));
  536. printk(KERN_INFO"NetXen: read 0x%08x for reset reg.\n",val);
  537. if (val != 0x80000f) {
  538. /* clear the register for future unloads/loads */
  539. writel(0, NETXEN_CRB_NORMALIZE(adapter,
  540. NETXEN_CAM_RAM(0x1fc)));
  541. printk(KERN_ERR "ERROR in NetXen HW init sequence.\n");
  542. err = -ENODEV;
  543. goto err_out_free_dev;
  544. }
  545. }
  546. /* clear the register for future unloads/loads */
  547. writel(0, NETXEN_CRB_NORMALIZE(adapter, NETXEN_CAM_RAM(0x1fc)));
  548. printk(KERN_INFO "State: 0x%0x\n",
  549. readl(NETXEN_CRB_NORMALIZE(adapter, CRB_CMDPEG_STATE)));
  550. /*
  551. * Tell the hardware our version number.
  552. */
  553. i = (_NETXEN_NIC_LINUX_MAJOR << 16)
  554. | ((_NETXEN_NIC_LINUX_MINOR << 8))
  555. | (_NETXEN_NIC_LINUX_SUBVERSION);
  556. writel(i, NETXEN_CRB_NORMALIZE(adapter, CRB_DRIVER_VERSION));
  557. /* Unlock the HW, prompting the boot sequence */
  558. writel(1,
  559. NETXEN_CRB_NORMALIZE(adapter,
  560. NETXEN_ROMUSB_GLB_PEGTUNE_DONE));
  561. /* Handshake with the card before we register the devices. */
  562. netxen_phantom_init(adapter, NETXEN_NIC_PEG_TUNE);
  563. }
  564. /*
  565. * See if the firmware gave us a virtual-physical port mapping.
  566. */
  567. i = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_V2P(adapter->portnum)));
  568. if (i != 0x55555555)
  569. physical_port[adapter->portnum] = i;
  570. netif_carrier_off(netdev);
  571. netif_stop_queue(netdev);
  572. if ((err = register_netdev(netdev))) {
  573. printk(KERN_ERR "%s: register_netdev failed port #%d"
  574. " aborting\n", netxen_nic_driver_name,
  575. adapter->portnum);
  576. err = -EIO;
  577. goto err_out_free_dev;
  578. }
  579. pci_set_drvdata(pdev, adapter);
  580. switch (adapter->ahw.board_type) {
  581. case NETXEN_NIC_GBE:
  582. printk(KERN_INFO "%s: QUAD GbE board initialized\n",
  583. netxen_nic_driver_name);
  584. break;
  585. case NETXEN_NIC_XGBE:
  586. printk(KERN_INFO "%s: XGbE board initialized\n",
  587. netxen_nic_driver_name);
  588. break;
  589. }
  590. adapter->driver_mismatch = 0;
  591. return 0;
  592. err_out_free_dev:
  593. if (adapter->portnum == 0)
  594. netxen_free_adapter_offload(adapter);
  595. err_out_free_rx_buffer:
  596. for (i = 0; i < MAX_RCV_CTX; ++i) {
  597. recv_ctx = &adapter->recv_ctx[i];
  598. for (ring = 0; ring < NUM_RCV_DESC_RINGS; ring++) {
  599. rcv_desc = &recv_ctx->rcv_desc[ring];
  600. if (rcv_desc->rx_buf_arr != NULL) {
  601. vfree(rcv_desc->rx_buf_arr);
  602. rcv_desc->rx_buf_arr = NULL;
  603. }
  604. }
  605. }
  606. vfree(cmd_buf_arr);
  607. err_out_free_adapter:
  608. if (adapter->flags & NETXEN_NIC_MSI_ENABLED)
  609. pci_disable_msi(pdev);
  610. pci_set_drvdata(pdev, NULL);
  611. if (db_ptr)
  612. iounmap(db_ptr);
  613. err_out_iounmap:
  614. if (mem_ptr0)
  615. iounmap(mem_ptr0);
  616. if (mem_ptr1)
  617. iounmap(mem_ptr1);
  618. if (mem_ptr2)
  619. iounmap(mem_ptr2);
  620. err_out_free_netdev:
  621. free_netdev(netdev);
  622. err_out_free_res:
  623. pci_release_regions(pdev);
  624. err_out_disable_pdev:
  625. pci_disable_device(pdev);
  626. return err;
  627. }
  628. static void __devexit netxen_nic_remove(struct pci_dev *pdev)
  629. {
  630. struct netxen_adapter *adapter;
  631. struct net_device *netdev;
  632. struct netxen_rx_buffer *buffer;
  633. struct netxen_recv_context *recv_ctx;
  634. struct netxen_rcv_desc_ctx *rcv_desc;
  635. int i, ctxid, ring;
  636. static int init_firmware_done = 0;
  637. adapter = pci_get_drvdata(pdev);
  638. if (adapter == NULL)
  639. return;
  640. netdev = adapter->netdev;
  641. unregister_netdev(netdev);
  642. if (adapter->stop_port)
  643. adapter->stop_port(adapter);
  644. netxen_nic_disable_int(adapter);
  645. if (adapter->irq)
  646. free_irq(adapter->irq, adapter);
  647. if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) {
  648. init_firmware_done++;
  649. netxen_free_hw_resources(adapter);
  650. }
  651. for (ctxid = 0; ctxid < MAX_RCV_CTX; ++ctxid) {
  652. recv_ctx = &adapter->recv_ctx[ctxid];
  653. for (ring = 0; ring < NUM_RCV_DESC_RINGS; ring++) {
  654. rcv_desc = &recv_ctx->rcv_desc[ring];
  655. for (i = 0; i < rcv_desc->max_rx_desc_count; ++i) {
  656. buffer = &(rcv_desc->rx_buf_arr[i]);
  657. if (buffer->state == NETXEN_BUFFER_FREE)
  658. continue;
  659. pci_unmap_single(pdev, buffer->dma,
  660. rcv_desc->dma_size,
  661. PCI_DMA_FROMDEVICE);
  662. if (buffer->skb != NULL)
  663. dev_kfree_skb_any(buffer->skb);
  664. }
  665. vfree(rcv_desc->rx_buf_arr);
  666. }
  667. }
  668. if (adapter->flags & NETXEN_NIC_MSI_ENABLED)
  669. pci_disable_msi(pdev);
  670. vfree(adapter->cmd_buf_arr);
  671. pci_disable_device(pdev);
  672. if (adapter->portnum == 0) {
  673. if (init_firmware_done) {
  674. dma_watchdog_shutdown_request(adapter);
  675. msleep(100);
  676. i = 100;
  677. while ((dma_watchdog_shutdown_poll_result(adapter) != 1) && i) {
  678. printk(KERN_INFO "dma_watchdog_shutdown_poll still in progress\n");
  679. msleep(100);
  680. i--;
  681. }
  682. if (i == 0) {
  683. printk(KERN_ERR "dma_watchdog_shutdown_request failed\n");
  684. return;
  685. }
  686. /* clear the register for future unloads/loads */
  687. writel(0, NETXEN_CRB_NORMALIZE(adapter, NETXEN_CAM_RAM(0x1fc)));
  688. printk(KERN_INFO "State: 0x%0x\n",
  689. readl(NETXEN_CRB_NORMALIZE(adapter, CRB_CMDPEG_STATE)));
  690. /* leave the hw in the same state as reboot */
  691. writel(0, NETXEN_CRB_NORMALIZE(adapter, CRB_CMDPEG_STATE));
  692. if (netxen_pinit_from_rom(adapter, 0))
  693. return;
  694. msleep(1);
  695. if (netxen_load_firmware(adapter))
  696. return;
  697. netxen_phantom_init(adapter, NETXEN_NIC_PEG_TUNE);
  698. }
  699. /* clear the register for future unloads/loads */
  700. writel(0, NETXEN_CRB_NORMALIZE(adapter, NETXEN_CAM_RAM(0x1fc)));
  701. printk(KERN_INFO "State: 0x%0x\n",
  702. readl(NETXEN_CRB_NORMALIZE(adapter, CRB_CMDPEG_STATE)));
  703. dma_watchdog_shutdown_request(adapter);
  704. msleep(100);
  705. i = 100;
  706. while ((dma_watchdog_shutdown_poll_result(adapter) != 1) && i) {
  707. printk(KERN_INFO "dma_watchdog_shutdown_poll still in progress\n");
  708. msleep(100);
  709. i--;
  710. }
  711. if (i) {
  712. netxen_free_adapter_offload(adapter);
  713. } else {
  714. printk(KERN_ERR "failed to dma shutdown\n");
  715. return;
  716. }
  717. }
  718. iounmap(adapter->ahw.db_base);
  719. iounmap(adapter->ahw.pci_base0);
  720. iounmap(adapter->ahw.pci_base1);
  721. iounmap(adapter->ahw.pci_base2);
  722. pci_release_regions(pdev);
  723. pci_set_drvdata(pdev, NULL);
  724. free_netdev(netdev);
  725. }
  726. /*
  727. * Called when a network interface is made active
  728. * @returns 0 on success, negative value on failure
  729. */
  730. static int netxen_nic_open(struct net_device *netdev)
  731. {
  732. struct netxen_adapter *adapter = (struct netxen_adapter *)netdev->priv;
  733. int err = 0;
  734. int ctx, ring;
  735. if (adapter->is_up != NETXEN_ADAPTER_UP_MAGIC) {
  736. err = netxen_init_firmware(adapter);
  737. if (err != 0) {
  738. printk(KERN_ERR "Failed to init firmware\n");
  739. return -EIO;
  740. }
  741. netxen_nic_flash_print(adapter);
  742. /* setup all the resources for the Phantom... */
  743. /* this include the descriptors for rcv, tx, and status */
  744. netxen_nic_clear_stats(adapter);
  745. err = netxen_nic_hw_resources(adapter);
  746. if (err) {
  747. printk(KERN_ERR "Error in setting hw resources:%d\n",
  748. err);
  749. return err;
  750. }
  751. for (ctx = 0; ctx < MAX_RCV_CTX; ++ctx) {
  752. for (ring = 0; ring < NUM_RCV_DESC_RINGS; ring++)
  753. netxen_post_rx_buffers(adapter, ctx, ring);
  754. }
  755. adapter->irq = adapter->ahw.pdev->irq;
  756. err = request_irq(adapter->ahw.pdev->irq, netxen_intr,
  757. IRQF_SHARED|IRQF_SAMPLE_RANDOM, netdev->name,
  758. adapter);
  759. if (err) {
  760. printk(KERN_ERR "request_irq failed with: %d\n", err);
  761. netxen_free_hw_resources(adapter);
  762. return err;
  763. }
  764. adapter->is_up = NETXEN_ADAPTER_UP_MAGIC;
  765. }
  766. if (!adapter->driver_mismatch)
  767. mod_timer(&adapter->watchdog_timer, jiffies);
  768. netxen_nic_enable_int(adapter);
  769. /* Done here again so that even if phantom sw overwrote it,
  770. * we set it */
  771. if (adapter->macaddr_set)
  772. adapter->macaddr_set(adapter, netdev->dev_addr);
  773. if (adapter->init_port
  774. && adapter->init_port(adapter, adapter->portnum) != 0) {
  775. del_timer_sync(&adapter->watchdog_timer);
  776. printk(KERN_ERR "%s: Failed to initialize port %d\n",
  777. netxen_nic_driver_name, adapter->portnum);
  778. return -EIO;
  779. }
  780. netxen_nic_set_link_parameters(adapter);
  781. netxen_nic_set_multi(netdev);
  782. if (adapter->set_mtu)
  783. adapter->set_mtu(adapter, netdev->mtu);
  784. if (!adapter->driver_mismatch)
  785. netif_start_queue(netdev);
  786. return 0;
  787. }
  788. /*
  789. * netxen_nic_close - Disables a network interface entry point
  790. */
  791. static int netxen_nic_close(struct net_device *netdev)
  792. {
  793. struct netxen_adapter *adapter = netdev_priv(netdev);
  794. int i, j;
  795. struct netxen_cmd_buffer *cmd_buff;
  796. struct netxen_skb_frag *buffrag;
  797. netif_carrier_off(netdev);
  798. netif_stop_queue(netdev);
  799. cmd_buff = adapter->cmd_buf_arr;
  800. for (i = 0; i < adapter->max_tx_desc_count; i++) {
  801. buffrag = cmd_buff->frag_array;
  802. if (buffrag->dma) {
  803. pci_unmap_single(adapter->pdev, buffrag->dma,
  804. buffrag->length, PCI_DMA_TODEVICE);
  805. buffrag->dma = 0ULL;
  806. }
  807. for (j = 0; j < cmd_buff->frag_count; j++) {
  808. buffrag++;
  809. if (buffrag->dma) {
  810. pci_unmap_page(adapter->pdev, buffrag->dma,
  811. buffrag->length,
  812. PCI_DMA_TODEVICE);
  813. buffrag->dma = 0ULL;
  814. }
  815. }
  816. /* Free the skb we received in netxen_nic_xmit_frame */
  817. if (cmd_buff->skb) {
  818. dev_kfree_skb_any(cmd_buff->skb);
  819. cmd_buff->skb = NULL;
  820. }
  821. cmd_buff++;
  822. }
  823. if (adapter->is_up == NETXEN_ADAPTER_UP_MAGIC) {
  824. FLUSH_SCHEDULED_WORK();
  825. del_timer_sync(&adapter->watchdog_timer);
  826. }
  827. return 0;
  828. }
  829. static int netxen_nic_xmit_frame(struct sk_buff *skb, struct net_device *netdev)
  830. {
  831. struct netxen_adapter *adapter = netdev_priv(netdev);
  832. struct netxen_hardware_context *hw = &adapter->ahw;
  833. unsigned int first_seg_len = skb->len - skb->data_len;
  834. struct netxen_skb_frag *buffrag;
  835. unsigned int i;
  836. u32 producer = 0;
  837. u32 saved_producer = 0;
  838. struct cmd_desc_type0 *hwdesc;
  839. int k;
  840. struct netxen_cmd_buffer *pbuf = NULL;
  841. static int dropped_packet = 0;
  842. int frag_count;
  843. u32 local_producer = 0;
  844. u32 max_tx_desc_count = 0;
  845. u32 last_cmd_consumer = 0;
  846. int no_of_desc;
  847. adapter->stats.xmitcalled++;
  848. frag_count = skb_shinfo(skb)->nr_frags + 1;
  849. if (unlikely(skb->len <= 0)) {
  850. dev_kfree_skb_any(skb);
  851. adapter->stats.badskblen++;
  852. return NETDEV_TX_OK;
  853. }
  854. if (frag_count > MAX_BUFFERS_PER_CMD) {
  855. printk("%s: %s netxen_nic_xmit_frame: frag_count (%d)"
  856. "too large, can handle only %d frags\n",
  857. netxen_nic_driver_name, netdev->name,
  858. frag_count, MAX_BUFFERS_PER_CMD);
  859. adapter->stats.txdropped++;
  860. if ((++dropped_packet & 0xff) == 0xff)
  861. printk("%s: %s droppped packets = %d\n",
  862. netxen_nic_driver_name, netdev->name,
  863. dropped_packet);
  864. return NETDEV_TX_OK;
  865. }
  866. /*
  867. * Everything is set up. Now, we just need to transmit it out.
  868. * Note that we have to copy the contents of buffer over to
  869. * right place. Later on, this can be optimized out by de-coupling the
  870. * producer index from the buffer index.
  871. */
  872. retry_getting_window:
  873. spin_lock_bh(&adapter->tx_lock);
  874. if (adapter->total_threads >= MAX_XMIT_PRODUCERS) {
  875. spin_unlock_bh(&adapter->tx_lock);
  876. /*
  877. * Yield CPU
  878. */
  879. if (!in_atomic())
  880. schedule();
  881. else {
  882. for (i = 0; i < 20; i++)
  883. cpu_relax(); /*This a nop instr on i386 */
  884. }
  885. goto retry_getting_window;
  886. }
  887. local_producer = adapter->cmd_producer;
  888. /* There 4 fragments per descriptor */
  889. no_of_desc = (frag_count + 3) >> 2;
  890. if (netdev->features & NETIF_F_TSO) {
  891. if (skb_shinfo(skb)->gso_size > 0) {
  892. no_of_desc++;
  893. if ((ip_hdrlen(skb) + tcp_hdrlen(skb) +
  894. sizeof(struct ethhdr)) >
  895. (sizeof(struct cmd_desc_type0) - 2)) {
  896. no_of_desc++;
  897. }
  898. }
  899. }
  900. k = adapter->cmd_producer;
  901. max_tx_desc_count = adapter->max_tx_desc_count;
  902. last_cmd_consumer = adapter->last_cmd_consumer;
  903. if ((k + no_of_desc) >=
  904. ((last_cmd_consumer <= k) ? last_cmd_consumer + max_tx_desc_count :
  905. last_cmd_consumer)) {
  906. netif_stop_queue(netdev);
  907. adapter->flags |= NETXEN_NETDEV_STATUS;
  908. spin_unlock_bh(&adapter->tx_lock);
  909. return NETDEV_TX_BUSY;
  910. }
  911. k = get_index_range(k, max_tx_desc_count, no_of_desc);
  912. adapter->cmd_producer = k;
  913. adapter->total_threads++;
  914. adapter->num_threads++;
  915. spin_unlock_bh(&adapter->tx_lock);
  916. /* Copy the descriptors into the hardware */
  917. producer = local_producer;
  918. saved_producer = producer;
  919. hwdesc = &hw->cmd_desc_head[producer];
  920. memset(hwdesc, 0, sizeof(struct cmd_desc_type0));
  921. /* Take skb->data itself */
  922. pbuf = &adapter->cmd_buf_arr[producer];
  923. if ((netdev->features & NETIF_F_TSO) && skb_shinfo(skb)->gso_size > 0) {
  924. pbuf->mss = skb_shinfo(skb)->gso_size;
  925. hwdesc->mss = cpu_to_le16(skb_shinfo(skb)->gso_size);
  926. } else {
  927. pbuf->mss = 0;
  928. hwdesc->mss = 0;
  929. }
  930. pbuf->total_length = skb->len;
  931. pbuf->skb = skb;
  932. pbuf->cmd = TX_ETHER_PKT;
  933. pbuf->frag_count = frag_count;
  934. pbuf->port = adapter->portnum;
  935. buffrag = &pbuf->frag_array[0];
  936. buffrag->dma = pci_map_single(adapter->pdev, skb->data, first_seg_len,
  937. PCI_DMA_TODEVICE);
  938. buffrag->length = first_seg_len;
  939. netxen_set_cmd_desc_totallength(hwdesc, skb->len);
  940. netxen_set_cmd_desc_num_of_buff(hwdesc, frag_count);
  941. netxen_set_cmd_desc_opcode(hwdesc, TX_ETHER_PKT);
  942. netxen_set_cmd_desc_port(hwdesc, adapter->portnum);
  943. netxen_set_cmd_desc_ctxid(hwdesc, adapter->portnum);
  944. hwdesc->buffer1_length = cpu_to_le16(first_seg_len);
  945. hwdesc->addr_buffer1 = cpu_to_le64(buffrag->dma);
  946. for (i = 1, k = 1; i < frag_count; i++, k++) {
  947. struct skb_frag_struct *frag;
  948. int len, temp_len;
  949. unsigned long offset;
  950. dma_addr_t temp_dma;
  951. /* move to next desc. if there is a need */
  952. if ((i & 0x3) == 0) {
  953. k = 0;
  954. producer = get_next_index(producer,
  955. adapter->max_tx_desc_count);
  956. hwdesc = &hw->cmd_desc_head[producer];
  957. memset(hwdesc, 0, sizeof(struct cmd_desc_type0));
  958. }
  959. frag = &skb_shinfo(skb)->frags[i - 1];
  960. len = frag->size;
  961. offset = frag->page_offset;
  962. temp_len = len;
  963. temp_dma = pci_map_page(adapter->pdev, frag->page, offset,
  964. len, PCI_DMA_TODEVICE);
  965. buffrag++;
  966. buffrag->dma = temp_dma;
  967. buffrag->length = temp_len;
  968. DPRINTK(INFO, "for loop. i=%d k=%d\n", i, k);
  969. switch (k) {
  970. case 0:
  971. hwdesc->buffer1_length = cpu_to_le16(temp_len);
  972. hwdesc->addr_buffer1 = cpu_to_le64(temp_dma);
  973. break;
  974. case 1:
  975. hwdesc->buffer2_length = cpu_to_le16(temp_len);
  976. hwdesc->addr_buffer2 = cpu_to_le64(temp_dma);
  977. break;
  978. case 2:
  979. hwdesc->buffer3_length = cpu_to_le16(temp_len);
  980. hwdesc->addr_buffer3 = cpu_to_le64(temp_dma);
  981. break;
  982. case 3:
  983. hwdesc->buffer4_length = cpu_to_le16(temp_len);
  984. hwdesc->addr_buffer4 = cpu_to_le64(temp_dma);
  985. break;
  986. }
  987. frag++;
  988. }
  989. producer = get_next_index(producer, adapter->max_tx_desc_count);
  990. /* might change opcode to TX_TCP_LSO */
  991. netxen_tso_check(adapter, &hw->cmd_desc_head[saved_producer], skb);
  992. /* For LSO, we need to copy the MAC/IP/TCP headers into
  993. * the descriptor ring
  994. */
  995. if (netxen_get_cmd_desc_opcode(&hw->cmd_desc_head[saved_producer])
  996. == TX_TCP_LSO) {
  997. int hdr_len, first_hdr_len, more_hdr;
  998. hdr_len = hw->cmd_desc_head[saved_producer].total_hdr_length;
  999. if (hdr_len > (sizeof(struct cmd_desc_type0) - 2)) {
  1000. first_hdr_len = sizeof(struct cmd_desc_type0) - 2;
  1001. more_hdr = 1;
  1002. } else {
  1003. first_hdr_len = hdr_len;
  1004. more_hdr = 0;
  1005. }
  1006. /* copy the MAC/IP/TCP headers to the cmd descriptor list */
  1007. hwdesc = &hw->cmd_desc_head[producer];
  1008. /* copy the first 64 bytes */
  1009. memcpy(((void *)hwdesc) + 2,
  1010. (void *)(skb->data), first_hdr_len);
  1011. producer = get_next_index(producer, max_tx_desc_count);
  1012. if (more_hdr) {
  1013. hwdesc = &hw->cmd_desc_head[producer];
  1014. /* copy the next 64 bytes - should be enough except
  1015. * for pathological case
  1016. */
  1017. skb_copy_from_linear_data_offset(skb, first_hdr_len,
  1018. hwdesc,
  1019. (hdr_len -
  1020. first_hdr_len));
  1021. producer = get_next_index(producer, max_tx_desc_count);
  1022. }
  1023. }
  1024. i = netxen_get_cmd_desc_totallength(&hw->cmd_desc_head[saved_producer]);
  1025. hw->cmd_desc_head[saved_producer].flags_opcode =
  1026. cpu_to_le16(hw->cmd_desc_head[saved_producer].flags_opcode);
  1027. hw->cmd_desc_head[saved_producer].num_of_buffers_total_length =
  1028. cpu_to_le32(hw->cmd_desc_head[saved_producer].
  1029. num_of_buffers_total_length);
  1030. spin_lock_bh(&adapter->tx_lock);
  1031. adapter->stats.txbytes += i;
  1032. /* Code to update the adapter considering how many producer threads
  1033. are currently working */
  1034. if ((--adapter->num_threads) == 0) {
  1035. /* This is the last thread */
  1036. u32 crb_producer = adapter->cmd_producer;
  1037. netxen_nic_update_cmd_producer(adapter, crb_producer);
  1038. wmb();
  1039. adapter->total_threads = 0;
  1040. }
  1041. adapter->stats.xmitfinished++;
  1042. spin_unlock_bh(&adapter->tx_lock);
  1043. netdev->trans_start = jiffies;
  1044. DPRINTK(INFO, "wrote CMD producer %x to phantom\n", producer);
  1045. DPRINTK(INFO, "Done. Send\n");
  1046. return NETDEV_TX_OK;
  1047. }
  1048. static void netxen_watchdog(unsigned long v)
  1049. {
  1050. struct netxen_adapter *adapter = (struct netxen_adapter *)v;
  1051. SCHEDULE_WORK(&adapter->watchdog_task);
  1052. }
  1053. static void netxen_tx_timeout(struct net_device *netdev)
  1054. {
  1055. struct netxen_adapter *adapter = (struct netxen_adapter *)
  1056. netdev_priv(netdev);
  1057. SCHEDULE_WORK(&adapter->tx_timeout_task);
  1058. }
  1059. static void netxen_tx_timeout_task(struct work_struct *work)
  1060. {
  1061. struct netxen_adapter *adapter =
  1062. container_of(work, struct netxen_adapter, tx_timeout_task);
  1063. unsigned long flags;
  1064. printk(KERN_ERR "%s %s: transmit timeout, resetting.\n",
  1065. netxen_nic_driver_name, adapter->netdev->name);
  1066. spin_lock_irqsave(&adapter->lock, flags);
  1067. netxen_nic_close(adapter->netdev);
  1068. netxen_nic_open(adapter->netdev);
  1069. spin_unlock_irqrestore(&adapter->lock, flags);
  1070. adapter->netdev->trans_start = jiffies;
  1071. netif_wake_queue(adapter->netdev);
  1072. }
  1073. static int
  1074. netxen_handle_int(struct netxen_adapter *adapter, struct net_device *netdev)
  1075. {
  1076. u32 ret = 0;
  1077. u32 our_int = 0;
  1078. DPRINTK(INFO, "Entered handle ISR\n");
  1079. adapter->stats.ints++;
  1080. if (!(adapter->flags & NETXEN_NIC_MSI_ENABLED)) {
  1081. our_int = readl(NETXEN_CRB_NORMALIZE(adapter, CRB_INT_VECTOR));
  1082. /* not our interrupt */
  1083. if ((our_int & (0x80 << adapter->portnum)) == 0)
  1084. return ret;
  1085. }
  1086. netxen_nic_disable_int(adapter);
  1087. if (adapter->intr_scheme == INTR_SCHEME_PERPORT) {
  1088. /* claim interrupt */
  1089. if (!(adapter->flags & NETXEN_NIC_MSI_ENABLED)) {
  1090. writel(our_int & ~((u32)(0x80 << adapter->portnum)),
  1091. NETXEN_CRB_NORMALIZE(adapter, CRB_INT_VECTOR));
  1092. }
  1093. }
  1094. if (netxen_nic_rx_has_work(adapter) || netxen_nic_tx_has_work(adapter)) {
  1095. if (netif_rx_schedule_prep(netdev)) {
  1096. /*
  1097. * Interrupts are already disabled.
  1098. */
  1099. __netif_rx_schedule(netdev);
  1100. } else {
  1101. static unsigned int intcount = 0;
  1102. if ((++intcount & 0xfff) == 0xfff)
  1103. DPRINTK(KERN_ERR
  1104. "%s: %s interrupt %d while in poll\n",
  1105. netxen_nic_driver_name, netdev->name,
  1106. intcount);
  1107. }
  1108. ret = 1;
  1109. }
  1110. if (ret == 0) {
  1111. netxen_nic_enable_int(adapter);
  1112. }
  1113. return ret;
  1114. }
  1115. /*
  1116. * netxen_intr - Interrupt Handler
  1117. * @irq: interrupt number
  1118. * data points to adapter stucture (which may be handling more than 1 port
  1119. */
  1120. irqreturn_t netxen_intr(int irq, void *data)
  1121. {
  1122. struct netxen_adapter *adapter;
  1123. struct net_device *netdev;
  1124. if (unlikely(!irq)) {
  1125. return IRQ_NONE; /* Not our interrupt */
  1126. }
  1127. adapter = (struct netxen_adapter *)data;
  1128. netdev = adapter->netdev;
  1129. /* process our status queue (for all 4 ports) */
  1130. if (netif_running(netdev))
  1131. netxen_handle_int(adapter, netdev);
  1132. return IRQ_HANDLED;
  1133. }
  1134. static int netxen_nic_poll(struct net_device *netdev, int *budget)
  1135. {
  1136. struct netxen_adapter *adapter = netdev_priv(netdev);
  1137. int work_to_do = min(*budget, netdev->quota);
  1138. int done = 1;
  1139. int ctx;
  1140. int this_work_done;
  1141. int work_done = 0;
  1142. DPRINTK(INFO, "polling for %d descriptors\n", *budget);
  1143. work_done = 0;
  1144. for (ctx = 0; ctx < MAX_RCV_CTX; ++ctx) {
  1145. /*
  1146. * Fairness issue. This will give undue weight to the
  1147. * receive context 0.
  1148. */
  1149. /*
  1150. * To avoid starvation, we give each of our receivers,
  1151. * a fraction of the quota. Sometimes, it might happen that we
  1152. * have enough quota to process every packet, but since all the
  1153. * packets are on one context, it gets only half of the quota,
  1154. * and ends up not processing it.
  1155. */
  1156. this_work_done = netxen_process_rcv_ring(adapter, ctx,
  1157. work_to_do /
  1158. MAX_RCV_CTX);
  1159. work_done += this_work_done;
  1160. }
  1161. netdev->quota -= work_done;
  1162. *budget -= work_done;
  1163. if (work_done >= work_to_do && netxen_nic_rx_has_work(adapter) != 0)
  1164. done = 0;
  1165. if (netxen_process_cmd_ring((unsigned long)adapter) == 0)
  1166. done = 0;
  1167. DPRINTK(INFO, "new work_done: %d work_to_do: %d\n",
  1168. work_done, work_to_do);
  1169. if (done) {
  1170. netif_rx_complete(netdev);
  1171. netxen_nic_enable_int(adapter);
  1172. }
  1173. return !done;
  1174. }
  1175. #ifdef CONFIG_NET_POLL_CONTROLLER
  1176. static void netxen_nic_poll_controller(struct net_device *netdev)
  1177. {
  1178. struct netxen_adapter *adapter = netdev_priv(netdev);
  1179. disable_irq(adapter->irq);
  1180. netxen_intr(adapter->irq, adapter);
  1181. enable_irq(adapter->irq);
  1182. }
  1183. #endif
  1184. static struct pci_driver netxen_driver = {
  1185. .name = netxen_nic_driver_name,
  1186. .id_table = netxen_pci_tbl,
  1187. .probe = netxen_nic_probe,
  1188. .remove = __devexit_p(netxen_nic_remove)
  1189. };
  1190. /* Driver Registration on NetXen card */
  1191. static int __init netxen_init_module(void)
  1192. {
  1193. if ((netxen_workq = create_singlethread_workqueue("netxen")) == 0)
  1194. return -ENOMEM;
  1195. return pci_register_driver(&netxen_driver);
  1196. }
  1197. module_init(netxen_init_module);
  1198. static void __exit netxen_exit_module(void)
  1199. {
  1200. /*
  1201. * Wait for some time to allow the dma to drain, if any.
  1202. */
  1203. msleep(100);
  1204. pci_unregister_driver(&netxen_driver);
  1205. destroy_workqueue(netxen_workq);
  1206. }
  1207. module_exit(netxen_exit_module);