cxgb2.c 38 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428
  1. /*****************************************************************************
  2. * *
  3. * File: cxgb2.c *
  4. * $Revision: 1.25 $ *
  5. * $Date: 2005/06/22 00:43:25 $ *
  6. * Description: *
  7. * Chelsio 10Gb Ethernet Driver. *
  8. * *
  9. * This program is free software; you can redistribute it and/or modify *
  10. * it under the terms of the GNU General Public License, version 2, as *
  11. * published by the Free Software Foundation. *
  12. * *
  13. * You should have received a copy of the GNU General Public License along *
  14. * with this program; if not, write to the Free Software Foundation, Inc., *
  15. * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
  16. * *
  17. * THIS SOFTWARE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR IMPLIED *
  18. * WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED WARRANTIES OF *
  19. * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE. *
  20. * *
  21. * http://www.chelsio.com *
  22. * *
  23. * Copyright (c) 2003 - 2005 Chelsio Communications, Inc. *
  24. * All rights reserved. *
  25. * *
  26. * Maintainers: maintainers@chelsio.com *
  27. * *
  28. * Authors: Dimitrios Michailidis <dm@chelsio.com> *
  29. * Tina Yang <tainay@chelsio.com> *
  30. * Felix Marti <felix@chelsio.com> *
  31. * Scott Bardone <sbardone@chelsio.com> *
  32. * Kurt Ottaway <kottaway@chelsio.com> *
  33. * Frank DiMambro <frank@chelsio.com> *
  34. * *
  35. * History: *
  36. * *
  37. ****************************************************************************/
  38. #include "common.h"
  39. #include <linux/module.h>
  40. #include <linux/init.h>
  41. #include <linux/pci.h>
  42. #include <linux/netdevice.h>
  43. #include <linux/etherdevice.h>
  44. #include <linux/if_vlan.h>
  45. #include <linux/mii.h>
  46. #include <linux/sockios.h>
  47. #include <linux/dma-mapping.h>
  48. #include <asm/uaccess.h>
  49. #include "cpl5_cmd.h"
  50. #include "regs.h"
  51. #include "gmac.h"
  52. #include "cphy.h"
  53. #include "sge.h"
  54. #include "tp.h"
  55. #include "espi.h"
  56. #include "elmer0.h"
  57. #include <linux/workqueue.h>
  58. static inline void schedule_mac_stats_update(struct adapter *ap, int secs)
  59. {
  60. schedule_delayed_work(&ap->stats_update_task, secs * HZ);
  61. }
  62. static inline void cancel_mac_stats_update(struct adapter *ap)
  63. {
  64. cancel_delayed_work(&ap->stats_update_task);
  65. }
  66. #define MAX_CMDQ_ENTRIES 16384
  67. #define MAX_CMDQ1_ENTRIES 1024
  68. #define MAX_RX_BUFFERS 16384
  69. #define MAX_RX_JUMBO_BUFFERS 16384
  70. #define MAX_TX_BUFFERS_HIGH 16384U
  71. #define MAX_TX_BUFFERS_LOW 1536U
  72. #define MAX_TX_BUFFERS 1460U
  73. #define MIN_FL_ENTRIES 32
  74. #define DFLT_MSG_ENABLE (NETIF_MSG_DRV | NETIF_MSG_PROBE | NETIF_MSG_LINK | \
  75. NETIF_MSG_TIMER | NETIF_MSG_IFDOWN | NETIF_MSG_IFUP |\
  76. NETIF_MSG_RX_ERR | NETIF_MSG_TX_ERR)
  77. /*
  78. * The EEPROM is actually bigger but only the first few bytes are used so we
  79. * only report those.
  80. */
  81. #define EEPROM_SIZE 32
  82. MODULE_DESCRIPTION(DRV_DESCRIPTION);
  83. MODULE_AUTHOR("Chelsio Communications");
  84. MODULE_LICENSE("GPL");
  85. static int dflt_msg_enable = DFLT_MSG_ENABLE;
  86. module_param(dflt_msg_enable, int, 0);
  87. MODULE_PARM_DESC(dflt_msg_enable, "Chelsio T1 default message enable bitmap");
  88. #define HCLOCK 0x0
  89. #define LCLOCK 0x1
  90. /* T1 cards powersave mode */
  91. static int t1_clock(struct adapter *adapter, int mode);
  92. static int t1powersave = 1; /* HW default is powersave mode. */
  93. module_param(t1powersave, int, 0);
  94. MODULE_PARM_DESC(t1powersave, "Enable/Disable T1 powersaving mode");
  95. static int disable_msi = 0;
  96. module_param(disable_msi, int, 0);
  97. MODULE_PARM_DESC(disable_msi, "Disable Message Signaled Interrupt (MSI)");
  98. static const char pci_speed[][4] = {
  99. "33", "66", "100", "133"
  100. };
  101. /*
  102. * Setup MAC to receive the types of packets we want.
  103. */
  104. static void t1_set_rxmode(struct net_device *dev)
  105. {
  106. struct adapter *adapter = dev->priv;
  107. struct cmac *mac = adapter->port[dev->if_port].mac;
  108. struct t1_rx_mode rm;
  109. rm.dev = dev;
  110. rm.idx = 0;
  111. rm.list = dev->mc_list;
  112. mac->ops->set_rx_mode(mac, &rm);
  113. }
  114. static void link_report(struct port_info *p)
  115. {
  116. if (!netif_carrier_ok(p->dev))
  117. printk(KERN_INFO "%s: link down\n", p->dev->name);
  118. else {
  119. const char *s = "10Mbps";
  120. switch (p->link_config.speed) {
  121. case SPEED_10000: s = "10Gbps"; break;
  122. case SPEED_1000: s = "1000Mbps"; break;
  123. case SPEED_100: s = "100Mbps"; break;
  124. }
  125. printk(KERN_INFO "%s: link up, %s, %s-duplex\n",
  126. p->dev->name, s,
  127. p->link_config.duplex == DUPLEX_FULL ? "full" : "half");
  128. }
  129. }
  130. void t1_link_negotiated(struct adapter *adapter, int port_id, int link_stat,
  131. int speed, int duplex, int pause)
  132. {
  133. struct port_info *p = &adapter->port[port_id];
  134. if (link_stat != netif_carrier_ok(p->dev)) {
  135. if (link_stat)
  136. netif_carrier_on(p->dev);
  137. else
  138. netif_carrier_off(p->dev);
  139. link_report(p);
  140. /* multi-ports: inform toe */
  141. if ((speed > 0) && (adapter->params.nports > 1)) {
  142. unsigned int sched_speed = 10;
  143. switch (speed) {
  144. case SPEED_1000:
  145. sched_speed = 1000;
  146. break;
  147. case SPEED_100:
  148. sched_speed = 100;
  149. break;
  150. case SPEED_10:
  151. sched_speed = 10;
  152. break;
  153. }
  154. t1_sched_update_parms(adapter->sge, port_id, 0, sched_speed);
  155. }
  156. }
  157. }
  158. static void link_start(struct port_info *p)
  159. {
  160. struct cmac *mac = p->mac;
  161. mac->ops->reset(mac);
  162. if (mac->ops->macaddress_set)
  163. mac->ops->macaddress_set(mac, p->dev->dev_addr);
  164. t1_set_rxmode(p->dev);
  165. t1_link_start(p->phy, mac, &p->link_config);
  166. mac->ops->enable(mac, MAC_DIRECTION_RX | MAC_DIRECTION_TX);
  167. }
  168. static void enable_hw_csum(struct adapter *adapter)
  169. {
  170. if (adapter->flags & TSO_CAPABLE)
  171. t1_tp_set_ip_checksum_offload(adapter->tp, 1); /* for TSO only */
  172. if (adapter->flags & UDP_CSUM_CAPABLE)
  173. t1_tp_set_udp_checksum_offload(adapter->tp, 1);
  174. t1_tp_set_tcp_checksum_offload(adapter->tp, 1);
  175. }
  176. /*
  177. * Things to do upon first use of a card.
  178. * This must run with the rtnl lock held.
  179. */
  180. static int cxgb_up(struct adapter *adapter)
  181. {
  182. int err = 0;
  183. if (!(adapter->flags & FULL_INIT_DONE)) {
  184. err = t1_init_hw_modules(adapter);
  185. if (err)
  186. goto out_err;
  187. enable_hw_csum(adapter);
  188. adapter->flags |= FULL_INIT_DONE;
  189. }
  190. t1_interrupts_clear(adapter);
  191. adapter->params.has_msi = !disable_msi && !pci_enable_msi(adapter->pdev);
  192. err = request_irq(adapter->pdev->irq, t1_interrupt,
  193. adapter->params.has_msi ? 0 : IRQF_SHARED,
  194. adapter->name, adapter);
  195. if (err) {
  196. if (adapter->params.has_msi)
  197. pci_disable_msi(adapter->pdev);
  198. goto out_err;
  199. }
  200. t1_sge_start(adapter->sge);
  201. t1_interrupts_enable(adapter);
  202. out_err:
  203. return err;
  204. }
  205. /*
  206. * Release resources when all the ports have been stopped.
  207. */
  208. static void cxgb_down(struct adapter *adapter)
  209. {
  210. t1_sge_stop(adapter->sge);
  211. t1_interrupts_disable(adapter);
  212. free_irq(adapter->pdev->irq, adapter);
  213. if (adapter->params.has_msi)
  214. pci_disable_msi(adapter->pdev);
  215. }
  216. static int cxgb_open(struct net_device *dev)
  217. {
  218. int err;
  219. struct adapter *adapter = dev->priv;
  220. int other_ports = adapter->open_device_map & PORT_MASK;
  221. if (!adapter->open_device_map && (err = cxgb_up(adapter)) < 0)
  222. return err;
  223. __set_bit(dev->if_port, &adapter->open_device_map);
  224. link_start(&adapter->port[dev->if_port]);
  225. netif_start_queue(dev);
  226. if (!other_ports && adapter->params.stats_update_period)
  227. schedule_mac_stats_update(adapter,
  228. adapter->params.stats_update_period);
  229. return 0;
  230. }
  231. static int cxgb_close(struct net_device *dev)
  232. {
  233. struct adapter *adapter = dev->priv;
  234. struct port_info *p = &adapter->port[dev->if_port];
  235. struct cmac *mac = p->mac;
  236. netif_stop_queue(dev);
  237. mac->ops->disable(mac, MAC_DIRECTION_TX | MAC_DIRECTION_RX);
  238. netif_carrier_off(dev);
  239. clear_bit(dev->if_port, &adapter->open_device_map);
  240. if (adapter->params.stats_update_period &&
  241. !(adapter->open_device_map & PORT_MASK)) {
  242. /* Stop statistics accumulation. */
  243. smp_mb__after_clear_bit();
  244. spin_lock(&adapter->work_lock); /* sync with update task */
  245. spin_unlock(&adapter->work_lock);
  246. cancel_mac_stats_update(adapter);
  247. }
  248. if (!adapter->open_device_map)
  249. cxgb_down(adapter);
  250. return 0;
  251. }
  252. static struct net_device_stats *t1_get_stats(struct net_device *dev)
  253. {
  254. struct adapter *adapter = dev->priv;
  255. struct port_info *p = &adapter->port[dev->if_port];
  256. struct net_device_stats *ns = &p->netstats;
  257. const struct cmac_statistics *pstats;
  258. /* Do a full update of the MAC stats */
  259. pstats = p->mac->ops->statistics_update(p->mac,
  260. MAC_STATS_UPDATE_FULL);
  261. ns->tx_packets = pstats->TxUnicastFramesOK +
  262. pstats->TxMulticastFramesOK + pstats->TxBroadcastFramesOK;
  263. ns->rx_packets = pstats->RxUnicastFramesOK +
  264. pstats->RxMulticastFramesOK + pstats->RxBroadcastFramesOK;
  265. ns->tx_bytes = pstats->TxOctetsOK;
  266. ns->rx_bytes = pstats->RxOctetsOK;
  267. ns->tx_errors = pstats->TxLateCollisions + pstats->TxLengthErrors +
  268. pstats->TxUnderrun + pstats->TxFramesAbortedDueToXSCollisions;
  269. ns->rx_errors = pstats->RxDataErrors + pstats->RxJabberErrors +
  270. pstats->RxFCSErrors + pstats->RxAlignErrors +
  271. pstats->RxSequenceErrors + pstats->RxFrameTooLongErrors +
  272. pstats->RxSymbolErrors + pstats->RxRuntErrors;
  273. ns->multicast = pstats->RxMulticastFramesOK;
  274. ns->collisions = pstats->TxTotalCollisions;
  275. /* detailed rx_errors */
  276. ns->rx_length_errors = pstats->RxFrameTooLongErrors +
  277. pstats->RxJabberErrors;
  278. ns->rx_over_errors = 0;
  279. ns->rx_crc_errors = pstats->RxFCSErrors;
  280. ns->rx_frame_errors = pstats->RxAlignErrors;
  281. ns->rx_fifo_errors = 0;
  282. ns->rx_missed_errors = 0;
  283. /* detailed tx_errors */
  284. ns->tx_aborted_errors = pstats->TxFramesAbortedDueToXSCollisions;
  285. ns->tx_carrier_errors = 0;
  286. ns->tx_fifo_errors = pstats->TxUnderrun;
  287. ns->tx_heartbeat_errors = 0;
  288. ns->tx_window_errors = pstats->TxLateCollisions;
  289. return ns;
  290. }
  291. static u32 get_msglevel(struct net_device *dev)
  292. {
  293. struct adapter *adapter = dev->priv;
  294. return adapter->msg_enable;
  295. }
  296. static void set_msglevel(struct net_device *dev, u32 val)
  297. {
  298. struct adapter *adapter = dev->priv;
  299. adapter->msg_enable = val;
  300. }
  301. static char stats_strings[][ETH_GSTRING_LEN] = {
  302. "TxOctetsOK",
  303. "TxOctetsBad",
  304. "TxUnicastFramesOK",
  305. "TxMulticastFramesOK",
  306. "TxBroadcastFramesOK",
  307. "TxPauseFrames",
  308. "TxFramesWithDeferredXmissions",
  309. "TxLateCollisions",
  310. "TxTotalCollisions",
  311. "TxFramesAbortedDueToXSCollisions",
  312. "TxUnderrun",
  313. "TxLengthErrors",
  314. "TxInternalMACXmitError",
  315. "TxFramesWithExcessiveDeferral",
  316. "TxFCSErrors",
  317. "RxOctetsOK",
  318. "RxOctetsBad",
  319. "RxUnicastFramesOK",
  320. "RxMulticastFramesOK",
  321. "RxBroadcastFramesOK",
  322. "RxPauseFrames",
  323. "RxFCSErrors",
  324. "RxAlignErrors",
  325. "RxSymbolErrors",
  326. "RxDataErrors",
  327. "RxSequenceErrors",
  328. "RxRuntErrors",
  329. "RxJabberErrors",
  330. "RxInternalMACRcvError",
  331. "RxInRangeLengthErrors",
  332. "RxOutOfRangeLengthField",
  333. "RxFrameTooLongErrors",
  334. /* Port stats */
  335. "RxPackets",
  336. "RxCsumGood",
  337. "TxPackets",
  338. "TxCsumOffload",
  339. "TxTso",
  340. "RxVlan",
  341. "TxVlan",
  342. /* Interrupt stats */
  343. "rx drops",
  344. "pure_rsps",
  345. "unhandled irqs",
  346. "respQ_empty",
  347. "respQ_overflow",
  348. "freelistQ_empty",
  349. "pkt_too_big",
  350. "pkt_mismatch",
  351. "cmdQ_full0",
  352. "cmdQ_full1",
  353. "espi_DIP2ParityErr",
  354. "espi_DIP4Err",
  355. "espi_RxDrops",
  356. "espi_TxDrops",
  357. "espi_RxOvfl",
  358. "espi_ParityErr"
  359. };
  360. #define T2_REGMAP_SIZE (3 * 1024)
  361. static int get_regs_len(struct net_device *dev)
  362. {
  363. return T2_REGMAP_SIZE;
  364. }
  365. static void get_drvinfo(struct net_device *dev, struct ethtool_drvinfo *info)
  366. {
  367. struct adapter *adapter = dev->priv;
  368. strcpy(info->driver, DRV_NAME);
  369. strcpy(info->version, DRV_VERSION);
  370. strcpy(info->fw_version, "N/A");
  371. strcpy(info->bus_info, pci_name(adapter->pdev));
  372. }
  373. static int get_stats_count(struct net_device *dev)
  374. {
  375. return ARRAY_SIZE(stats_strings);
  376. }
  377. static void get_strings(struct net_device *dev, u32 stringset, u8 *data)
  378. {
  379. if (stringset == ETH_SS_STATS)
  380. memcpy(data, stats_strings, sizeof(stats_strings));
  381. }
  382. static void get_stats(struct net_device *dev, struct ethtool_stats *stats,
  383. u64 *data)
  384. {
  385. struct adapter *adapter = dev->priv;
  386. struct cmac *mac = adapter->port[dev->if_port].mac;
  387. const struct cmac_statistics *s;
  388. const struct sge_intr_counts *t;
  389. struct sge_port_stats ss;
  390. s = mac->ops->statistics_update(mac, MAC_STATS_UPDATE_FULL);
  391. *data++ = s->TxOctetsOK;
  392. *data++ = s->TxOctetsBad;
  393. *data++ = s->TxUnicastFramesOK;
  394. *data++ = s->TxMulticastFramesOK;
  395. *data++ = s->TxBroadcastFramesOK;
  396. *data++ = s->TxPauseFrames;
  397. *data++ = s->TxFramesWithDeferredXmissions;
  398. *data++ = s->TxLateCollisions;
  399. *data++ = s->TxTotalCollisions;
  400. *data++ = s->TxFramesAbortedDueToXSCollisions;
  401. *data++ = s->TxUnderrun;
  402. *data++ = s->TxLengthErrors;
  403. *data++ = s->TxInternalMACXmitError;
  404. *data++ = s->TxFramesWithExcessiveDeferral;
  405. *data++ = s->TxFCSErrors;
  406. *data++ = s->RxOctetsOK;
  407. *data++ = s->RxOctetsBad;
  408. *data++ = s->RxUnicastFramesOK;
  409. *data++ = s->RxMulticastFramesOK;
  410. *data++ = s->RxBroadcastFramesOK;
  411. *data++ = s->RxPauseFrames;
  412. *data++ = s->RxFCSErrors;
  413. *data++ = s->RxAlignErrors;
  414. *data++ = s->RxSymbolErrors;
  415. *data++ = s->RxDataErrors;
  416. *data++ = s->RxSequenceErrors;
  417. *data++ = s->RxRuntErrors;
  418. *data++ = s->RxJabberErrors;
  419. *data++ = s->RxInternalMACRcvError;
  420. *data++ = s->RxInRangeLengthErrors;
  421. *data++ = s->RxOutOfRangeLengthField;
  422. *data++ = s->RxFrameTooLongErrors;
  423. t1_sge_get_port_stats(adapter->sge, dev->if_port, &ss);
  424. *data++ = ss.rx_packets;
  425. *data++ = ss.rx_cso_good;
  426. *data++ = ss.tx_packets;
  427. *data++ = ss.tx_cso;
  428. *data++ = ss.tx_tso;
  429. *data++ = ss.vlan_xtract;
  430. *data++ = ss.vlan_insert;
  431. t = t1_sge_get_intr_counts(adapter->sge);
  432. *data++ = t->rx_drops;
  433. *data++ = t->pure_rsps;
  434. *data++ = t->unhandled_irqs;
  435. *data++ = t->respQ_empty;
  436. *data++ = t->respQ_overflow;
  437. *data++ = t->freelistQ_empty;
  438. *data++ = t->pkt_too_big;
  439. *data++ = t->pkt_mismatch;
  440. *data++ = t->cmdQ_full[0];
  441. *data++ = t->cmdQ_full[1];
  442. if (adapter->espi) {
  443. const struct espi_intr_counts *e;
  444. e = t1_espi_get_intr_counts(adapter->espi);
  445. *data++ = e->DIP2_parity_err;
  446. *data++ = e->DIP4_err;
  447. *data++ = e->rx_drops;
  448. *data++ = e->tx_drops;
  449. *data++ = e->rx_ovflw;
  450. *data++ = e->parity_err;
  451. }
  452. }
  453. static inline void reg_block_dump(struct adapter *ap, void *buf,
  454. unsigned int start, unsigned int end)
  455. {
  456. u32 *p = buf + start;
  457. for ( ; start <= end; start += sizeof(u32))
  458. *p++ = readl(ap->regs + start);
  459. }
  460. static void get_regs(struct net_device *dev, struct ethtool_regs *regs,
  461. void *buf)
  462. {
  463. struct adapter *ap = dev->priv;
  464. /*
  465. * Version scheme: bits 0..9: chip version, bits 10..15: chip revision
  466. */
  467. regs->version = 2;
  468. memset(buf, 0, T2_REGMAP_SIZE);
  469. reg_block_dump(ap, buf, 0, A_SG_RESPACCUTIMER);
  470. reg_block_dump(ap, buf, A_MC3_CFG, A_MC4_INT_CAUSE);
  471. reg_block_dump(ap, buf, A_TPI_ADDR, A_TPI_PAR);
  472. reg_block_dump(ap, buf, A_TP_IN_CONFIG, A_TP_TX_DROP_COUNT);
  473. reg_block_dump(ap, buf, A_RAT_ROUTE_CONTROL, A_RAT_INTR_CAUSE);
  474. reg_block_dump(ap, buf, A_CSPI_RX_AE_WM, A_CSPI_INTR_ENABLE);
  475. reg_block_dump(ap, buf, A_ESPI_SCH_TOKEN0, A_ESPI_GOSTAT);
  476. reg_block_dump(ap, buf, A_ULP_ULIMIT, A_ULP_PIO_CTRL);
  477. reg_block_dump(ap, buf, A_PL_ENABLE, A_PL_CAUSE);
  478. reg_block_dump(ap, buf, A_MC5_CONFIG, A_MC5_MASK_WRITE_CMD);
  479. }
  480. static int get_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  481. {
  482. struct adapter *adapter = dev->priv;
  483. struct port_info *p = &adapter->port[dev->if_port];
  484. cmd->supported = p->link_config.supported;
  485. cmd->advertising = p->link_config.advertising;
  486. if (netif_carrier_ok(dev)) {
  487. cmd->speed = p->link_config.speed;
  488. cmd->duplex = p->link_config.duplex;
  489. } else {
  490. cmd->speed = -1;
  491. cmd->duplex = -1;
  492. }
  493. cmd->port = (cmd->supported & SUPPORTED_TP) ? PORT_TP : PORT_FIBRE;
  494. cmd->phy_address = p->phy->addr;
  495. cmd->transceiver = XCVR_EXTERNAL;
  496. cmd->autoneg = p->link_config.autoneg;
  497. cmd->maxtxpkt = 0;
  498. cmd->maxrxpkt = 0;
  499. return 0;
  500. }
  501. static int speed_duplex_to_caps(int speed, int duplex)
  502. {
  503. int cap = 0;
  504. switch (speed) {
  505. case SPEED_10:
  506. if (duplex == DUPLEX_FULL)
  507. cap = SUPPORTED_10baseT_Full;
  508. else
  509. cap = SUPPORTED_10baseT_Half;
  510. break;
  511. case SPEED_100:
  512. if (duplex == DUPLEX_FULL)
  513. cap = SUPPORTED_100baseT_Full;
  514. else
  515. cap = SUPPORTED_100baseT_Half;
  516. break;
  517. case SPEED_1000:
  518. if (duplex == DUPLEX_FULL)
  519. cap = SUPPORTED_1000baseT_Full;
  520. else
  521. cap = SUPPORTED_1000baseT_Half;
  522. break;
  523. case SPEED_10000:
  524. if (duplex == DUPLEX_FULL)
  525. cap = SUPPORTED_10000baseT_Full;
  526. }
  527. return cap;
  528. }
  529. #define ADVERTISED_MASK (ADVERTISED_10baseT_Half | ADVERTISED_10baseT_Full | \
  530. ADVERTISED_100baseT_Half | ADVERTISED_100baseT_Full | \
  531. ADVERTISED_1000baseT_Half | ADVERTISED_1000baseT_Full | \
  532. ADVERTISED_10000baseT_Full)
  533. static int set_settings(struct net_device *dev, struct ethtool_cmd *cmd)
  534. {
  535. struct adapter *adapter = dev->priv;
  536. struct port_info *p = &adapter->port[dev->if_port];
  537. struct link_config *lc = &p->link_config;
  538. if (!(lc->supported & SUPPORTED_Autoneg))
  539. return -EOPNOTSUPP; /* can't change speed/duplex */
  540. if (cmd->autoneg == AUTONEG_DISABLE) {
  541. int cap = speed_duplex_to_caps(cmd->speed, cmd->duplex);
  542. if (!(lc->supported & cap) || cmd->speed == SPEED_1000)
  543. return -EINVAL;
  544. lc->requested_speed = cmd->speed;
  545. lc->requested_duplex = cmd->duplex;
  546. lc->advertising = 0;
  547. } else {
  548. cmd->advertising &= ADVERTISED_MASK;
  549. if (cmd->advertising & (cmd->advertising - 1))
  550. cmd->advertising = lc->supported;
  551. cmd->advertising &= lc->supported;
  552. if (!cmd->advertising)
  553. return -EINVAL;
  554. lc->requested_speed = SPEED_INVALID;
  555. lc->requested_duplex = DUPLEX_INVALID;
  556. lc->advertising = cmd->advertising | ADVERTISED_Autoneg;
  557. }
  558. lc->autoneg = cmd->autoneg;
  559. if (netif_running(dev))
  560. t1_link_start(p->phy, p->mac, lc);
  561. return 0;
  562. }
  563. static void get_pauseparam(struct net_device *dev,
  564. struct ethtool_pauseparam *epause)
  565. {
  566. struct adapter *adapter = dev->priv;
  567. struct port_info *p = &adapter->port[dev->if_port];
  568. epause->autoneg = (p->link_config.requested_fc & PAUSE_AUTONEG) != 0;
  569. epause->rx_pause = (p->link_config.fc & PAUSE_RX) != 0;
  570. epause->tx_pause = (p->link_config.fc & PAUSE_TX) != 0;
  571. }
  572. static int set_pauseparam(struct net_device *dev,
  573. struct ethtool_pauseparam *epause)
  574. {
  575. struct adapter *adapter = dev->priv;
  576. struct port_info *p = &adapter->port[dev->if_port];
  577. struct link_config *lc = &p->link_config;
  578. if (epause->autoneg == AUTONEG_DISABLE)
  579. lc->requested_fc = 0;
  580. else if (lc->supported & SUPPORTED_Autoneg)
  581. lc->requested_fc = PAUSE_AUTONEG;
  582. else
  583. return -EINVAL;
  584. if (epause->rx_pause)
  585. lc->requested_fc |= PAUSE_RX;
  586. if (epause->tx_pause)
  587. lc->requested_fc |= PAUSE_TX;
  588. if (lc->autoneg == AUTONEG_ENABLE) {
  589. if (netif_running(dev))
  590. t1_link_start(p->phy, p->mac, lc);
  591. } else {
  592. lc->fc = lc->requested_fc & (PAUSE_RX | PAUSE_TX);
  593. if (netif_running(dev))
  594. p->mac->ops->set_speed_duplex_fc(p->mac, -1, -1,
  595. lc->fc);
  596. }
  597. return 0;
  598. }
  599. static u32 get_rx_csum(struct net_device *dev)
  600. {
  601. struct adapter *adapter = dev->priv;
  602. return (adapter->flags & RX_CSUM_ENABLED) != 0;
  603. }
  604. static int set_rx_csum(struct net_device *dev, u32 data)
  605. {
  606. struct adapter *adapter = dev->priv;
  607. if (data)
  608. adapter->flags |= RX_CSUM_ENABLED;
  609. else
  610. adapter->flags &= ~RX_CSUM_ENABLED;
  611. return 0;
  612. }
  613. static int set_tso(struct net_device *dev, u32 value)
  614. {
  615. struct adapter *adapter = dev->priv;
  616. if (!(adapter->flags & TSO_CAPABLE))
  617. return value ? -EOPNOTSUPP : 0;
  618. return ethtool_op_set_tso(dev, value);
  619. }
  620. static void get_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
  621. {
  622. struct adapter *adapter = dev->priv;
  623. int jumbo_fl = t1_is_T1B(adapter) ? 1 : 0;
  624. e->rx_max_pending = MAX_RX_BUFFERS;
  625. e->rx_mini_max_pending = 0;
  626. e->rx_jumbo_max_pending = MAX_RX_JUMBO_BUFFERS;
  627. e->tx_max_pending = MAX_CMDQ_ENTRIES;
  628. e->rx_pending = adapter->params.sge.freelQ_size[!jumbo_fl];
  629. e->rx_mini_pending = 0;
  630. e->rx_jumbo_pending = adapter->params.sge.freelQ_size[jumbo_fl];
  631. e->tx_pending = adapter->params.sge.cmdQ_size[0];
  632. }
  633. static int set_sge_param(struct net_device *dev, struct ethtool_ringparam *e)
  634. {
  635. struct adapter *adapter = dev->priv;
  636. int jumbo_fl = t1_is_T1B(adapter) ? 1 : 0;
  637. if (e->rx_pending > MAX_RX_BUFFERS || e->rx_mini_pending ||
  638. e->rx_jumbo_pending > MAX_RX_JUMBO_BUFFERS ||
  639. e->tx_pending > MAX_CMDQ_ENTRIES ||
  640. e->rx_pending < MIN_FL_ENTRIES ||
  641. e->rx_jumbo_pending < MIN_FL_ENTRIES ||
  642. e->tx_pending < (adapter->params.nports + 1) * (MAX_SKB_FRAGS + 1))
  643. return -EINVAL;
  644. if (adapter->flags & FULL_INIT_DONE)
  645. return -EBUSY;
  646. adapter->params.sge.freelQ_size[!jumbo_fl] = e->rx_pending;
  647. adapter->params.sge.freelQ_size[jumbo_fl] = e->rx_jumbo_pending;
  648. adapter->params.sge.cmdQ_size[0] = e->tx_pending;
  649. adapter->params.sge.cmdQ_size[1] = e->tx_pending > MAX_CMDQ1_ENTRIES ?
  650. MAX_CMDQ1_ENTRIES : e->tx_pending;
  651. return 0;
  652. }
  653. static int set_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
  654. {
  655. struct adapter *adapter = dev->priv;
  656. adapter->params.sge.rx_coalesce_usecs = c->rx_coalesce_usecs;
  657. adapter->params.sge.coalesce_enable = c->use_adaptive_rx_coalesce;
  658. adapter->params.sge.sample_interval_usecs = c->rate_sample_interval;
  659. t1_sge_set_coalesce_params(adapter->sge, &adapter->params.sge);
  660. return 0;
  661. }
  662. static int get_coalesce(struct net_device *dev, struct ethtool_coalesce *c)
  663. {
  664. struct adapter *adapter = dev->priv;
  665. c->rx_coalesce_usecs = adapter->params.sge.rx_coalesce_usecs;
  666. c->rate_sample_interval = adapter->params.sge.sample_interval_usecs;
  667. c->use_adaptive_rx_coalesce = adapter->params.sge.coalesce_enable;
  668. return 0;
  669. }
  670. static int get_eeprom_len(struct net_device *dev)
  671. {
  672. struct adapter *adapter = dev->priv;
  673. return t1_is_asic(adapter) ? EEPROM_SIZE : 0;
  674. }
  675. #define EEPROM_MAGIC(ap) \
  676. (PCI_VENDOR_ID_CHELSIO | ((ap)->params.chip_version << 16))
  677. static int get_eeprom(struct net_device *dev, struct ethtool_eeprom *e,
  678. u8 *data)
  679. {
  680. int i;
  681. u8 buf[EEPROM_SIZE] __attribute__((aligned(4)));
  682. struct adapter *adapter = dev->priv;
  683. e->magic = EEPROM_MAGIC(adapter);
  684. for (i = e->offset & ~3; i < e->offset + e->len; i += sizeof(u32))
  685. t1_seeprom_read(adapter, i, (u32 *)&buf[i]);
  686. memcpy(data, buf + e->offset, e->len);
  687. return 0;
  688. }
  689. static const struct ethtool_ops t1_ethtool_ops = {
  690. .get_settings = get_settings,
  691. .set_settings = set_settings,
  692. .get_drvinfo = get_drvinfo,
  693. .get_msglevel = get_msglevel,
  694. .set_msglevel = set_msglevel,
  695. .get_ringparam = get_sge_param,
  696. .set_ringparam = set_sge_param,
  697. .get_coalesce = get_coalesce,
  698. .set_coalesce = set_coalesce,
  699. .get_eeprom_len = get_eeprom_len,
  700. .get_eeprom = get_eeprom,
  701. .get_pauseparam = get_pauseparam,
  702. .set_pauseparam = set_pauseparam,
  703. .get_rx_csum = get_rx_csum,
  704. .set_rx_csum = set_rx_csum,
  705. .get_tx_csum = ethtool_op_get_tx_csum,
  706. .set_tx_csum = ethtool_op_set_tx_csum,
  707. .get_sg = ethtool_op_get_sg,
  708. .set_sg = ethtool_op_set_sg,
  709. .get_link = ethtool_op_get_link,
  710. .get_strings = get_strings,
  711. .get_stats_count = get_stats_count,
  712. .get_ethtool_stats = get_stats,
  713. .get_regs_len = get_regs_len,
  714. .get_regs = get_regs,
  715. .get_tso = ethtool_op_get_tso,
  716. .set_tso = set_tso,
  717. };
  718. static int t1_ioctl(struct net_device *dev, struct ifreq *req, int cmd)
  719. {
  720. struct adapter *adapter = dev->priv;
  721. struct mii_ioctl_data *data = if_mii(req);
  722. switch (cmd) {
  723. case SIOCGMIIPHY:
  724. data->phy_id = adapter->port[dev->if_port].phy->addr;
  725. /* FALLTHRU */
  726. case SIOCGMIIREG: {
  727. struct cphy *phy = adapter->port[dev->if_port].phy;
  728. u32 val;
  729. if (!phy->mdio_read)
  730. return -EOPNOTSUPP;
  731. phy->mdio_read(adapter, data->phy_id, 0, data->reg_num & 0x1f,
  732. &val);
  733. data->val_out = val;
  734. break;
  735. }
  736. case SIOCSMIIREG: {
  737. struct cphy *phy = adapter->port[dev->if_port].phy;
  738. if (!capable(CAP_NET_ADMIN))
  739. return -EPERM;
  740. if (!phy->mdio_write)
  741. return -EOPNOTSUPP;
  742. phy->mdio_write(adapter, data->phy_id, 0, data->reg_num & 0x1f,
  743. data->val_in);
  744. break;
  745. }
  746. default:
  747. return -EOPNOTSUPP;
  748. }
  749. return 0;
  750. }
  751. static int t1_change_mtu(struct net_device *dev, int new_mtu)
  752. {
  753. int ret;
  754. struct adapter *adapter = dev->priv;
  755. struct cmac *mac = adapter->port[dev->if_port].mac;
  756. if (!mac->ops->set_mtu)
  757. return -EOPNOTSUPP;
  758. if (new_mtu < 68)
  759. return -EINVAL;
  760. if ((ret = mac->ops->set_mtu(mac, new_mtu)))
  761. return ret;
  762. dev->mtu = new_mtu;
  763. return 0;
  764. }
  765. static int t1_set_mac_addr(struct net_device *dev, void *p)
  766. {
  767. struct adapter *adapter = dev->priv;
  768. struct cmac *mac = adapter->port[dev->if_port].mac;
  769. struct sockaddr *addr = p;
  770. if (!mac->ops->macaddress_set)
  771. return -EOPNOTSUPP;
  772. memcpy(dev->dev_addr, addr->sa_data, dev->addr_len);
  773. mac->ops->macaddress_set(mac, dev->dev_addr);
  774. return 0;
  775. }
  776. #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
  777. static void vlan_rx_register(struct net_device *dev,
  778. struct vlan_group *grp)
  779. {
  780. struct adapter *adapter = dev->priv;
  781. spin_lock_irq(&adapter->async_lock);
  782. adapter->vlan_grp = grp;
  783. t1_set_vlan_accel(adapter, grp != NULL);
  784. spin_unlock_irq(&adapter->async_lock);
  785. }
  786. static void vlan_rx_kill_vid(struct net_device *dev, unsigned short vid)
  787. {
  788. struct adapter *adapter = dev->priv;
  789. spin_lock_irq(&adapter->async_lock);
  790. if (adapter->vlan_grp)
  791. adapter->vlan_grp->vlan_devices[vid] = NULL;
  792. spin_unlock_irq(&adapter->async_lock);
  793. }
  794. #endif
  795. #ifdef CONFIG_NET_POLL_CONTROLLER
  796. static void t1_netpoll(struct net_device *dev)
  797. {
  798. unsigned long flags;
  799. struct adapter *adapter = dev->priv;
  800. local_irq_save(flags);
  801. t1_interrupt(adapter->pdev->irq, adapter);
  802. local_irq_restore(flags);
  803. }
  804. #endif
  805. /*
  806. * Periodic accumulation of MAC statistics. This is used only if the MAC
  807. * does not have any other way to prevent stats counter overflow.
  808. */
  809. static void mac_stats_task(struct work_struct *work)
  810. {
  811. int i;
  812. struct adapter *adapter =
  813. container_of(work, struct adapter, stats_update_task.work);
  814. for_each_port(adapter, i) {
  815. struct port_info *p = &adapter->port[i];
  816. if (netif_running(p->dev))
  817. p->mac->ops->statistics_update(p->mac,
  818. MAC_STATS_UPDATE_FAST);
  819. }
  820. /* Schedule the next statistics update if any port is active. */
  821. spin_lock(&adapter->work_lock);
  822. if (adapter->open_device_map & PORT_MASK)
  823. schedule_mac_stats_update(adapter,
  824. adapter->params.stats_update_period);
  825. spin_unlock(&adapter->work_lock);
  826. }
  827. /*
  828. * Processes elmer0 external interrupts in process context.
  829. */
  830. static void ext_intr_task(struct work_struct *work)
  831. {
  832. struct adapter *adapter =
  833. container_of(work, struct adapter, ext_intr_handler_task);
  834. t1_elmer0_ext_intr_handler(adapter);
  835. /* Now reenable external interrupts */
  836. spin_lock_irq(&adapter->async_lock);
  837. adapter->slow_intr_mask |= F_PL_INTR_EXT;
  838. writel(F_PL_INTR_EXT, adapter->regs + A_PL_CAUSE);
  839. writel(adapter->slow_intr_mask | F_PL_INTR_SGE_DATA,
  840. adapter->regs + A_PL_ENABLE);
  841. spin_unlock_irq(&adapter->async_lock);
  842. }
  843. /*
  844. * Interrupt-context handler for elmer0 external interrupts.
  845. */
  846. void t1_elmer0_ext_intr(struct adapter *adapter)
  847. {
  848. /*
  849. * Schedule a task to handle external interrupts as we require
  850. * a process context. We disable EXT interrupts in the interim
  851. * and let the task reenable them when it's done.
  852. */
  853. adapter->slow_intr_mask &= ~F_PL_INTR_EXT;
  854. writel(adapter->slow_intr_mask | F_PL_INTR_SGE_DATA,
  855. adapter->regs + A_PL_ENABLE);
  856. schedule_work(&adapter->ext_intr_handler_task);
  857. }
  858. void t1_fatal_err(struct adapter *adapter)
  859. {
  860. if (adapter->flags & FULL_INIT_DONE) {
  861. t1_sge_stop(adapter->sge);
  862. t1_interrupts_disable(adapter);
  863. }
  864. CH_ALERT("%s: encountered fatal error, operation suspended\n",
  865. adapter->name);
  866. }
  867. static int __devinit init_one(struct pci_dev *pdev,
  868. const struct pci_device_id *ent)
  869. {
  870. static int version_printed;
  871. int i, err, pci_using_dac = 0;
  872. unsigned long mmio_start, mmio_len;
  873. const struct board_info *bi;
  874. struct adapter *adapter = NULL;
  875. struct port_info *pi;
  876. if (!version_printed) {
  877. printk(KERN_INFO "%s - version %s\n", DRV_DESCRIPTION,
  878. DRV_VERSION);
  879. ++version_printed;
  880. }
  881. err = pci_enable_device(pdev);
  882. if (err)
  883. return err;
  884. if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) {
  885. CH_ERR("%s: cannot find PCI device memory base address\n",
  886. pci_name(pdev));
  887. err = -ENODEV;
  888. goto out_disable_pdev;
  889. }
  890. if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK)) {
  891. pci_using_dac = 1;
  892. if (pci_set_consistent_dma_mask(pdev, DMA_64BIT_MASK)) {
  893. CH_ERR("%s: unable to obtain 64-bit DMA for"
  894. "consistent allocations\n", pci_name(pdev));
  895. err = -ENODEV;
  896. goto out_disable_pdev;
  897. }
  898. } else if ((err = pci_set_dma_mask(pdev, DMA_32BIT_MASK)) != 0) {
  899. CH_ERR("%s: no usable DMA configuration\n", pci_name(pdev));
  900. goto out_disable_pdev;
  901. }
  902. err = pci_request_regions(pdev, DRV_NAME);
  903. if (err) {
  904. CH_ERR("%s: cannot obtain PCI resources\n", pci_name(pdev));
  905. goto out_disable_pdev;
  906. }
  907. pci_set_master(pdev);
  908. mmio_start = pci_resource_start(pdev, 0);
  909. mmio_len = pci_resource_len(pdev, 0);
  910. bi = t1_get_board_info(ent->driver_data);
  911. for (i = 0; i < bi->port_number; ++i) {
  912. struct net_device *netdev;
  913. netdev = alloc_etherdev(adapter ? 0 : sizeof(*adapter));
  914. if (!netdev) {
  915. err = -ENOMEM;
  916. goto out_free_dev;
  917. }
  918. SET_MODULE_OWNER(netdev);
  919. SET_NETDEV_DEV(netdev, &pdev->dev);
  920. if (!adapter) {
  921. adapter = netdev->priv;
  922. adapter->pdev = pdev;
  923. adapter->port[0].dev = netdev; /* so we don't leak it */
  924. adapter->regs = ioremap(mmio_start, mmio_len);
  925. if (!adapter->regs) {
  926. CH_ERR("%s: cannot map device registers\n",
  927. pci_name(pdev));
  928. err = -ENOMEM;
  929. goto out_free_dev;
  930. }
  931. if (t1_get_board_rev(adapter, bi, &adapter->params)) {
  932. err = -ENODEV; /* Can't handle this chip rev */
  933. goto out_free_dev;
  934. }
  935. adapter->name = pci_name(pdev);
  936. adapter->msg_enable = dflt_msg_enable;
  937. adapter->mmio_len = mmio_len;
  938. spin_lock_init(&adapter->tpi_lock);
  939. spin_lock_init(&adapter->work_lock);
  940. spin_lock_init(&adapter->async_lock);
  941. spin_lock_init(&adapter->mac_lock);
  942. INIT_WORK(&adapter->ext_intr_handler_task,
  943. ext_intr_task);
  944. INIT_DELAYED_WORK(&adapter->stats_update_task,
  945. mac_stats_task);
  946. pci_set_drvdata(pdev, netdev);
  947. }
  948. pi = &adapter->port[i];
  949. pi->dev = netdev;
  950. netif_carrier_off(netdev);
  951. netdev->irq = pdev->irq;
  952. netdev->if_port = i;
  953. netdev->mem_start = mmio_start;
  954. netdev->mem_end = mmio_start + mmio_len - 1;
  955. netdev->priv = adapter;
  956. netdev->features |= NETIF_F_SG | NETIF_F_IP_CSUM;
  957. netdev->features |= NETIF_F_LLTX;
  958. adapter->flags |= RX_CSUM_ENABLED | TCP_CSUM_CAPABLE;
  959. if (pci_using_dac)
  960. netdev->features |= NETIF_F_HIGHDMA;
  961. if (vlan_tso_capable(adapter)) {
  962. #if defined(CONFIG_VLAN_8021Q) || defined(CONFIG_VLAN_8021Q_MODULE)
  963. adapter->flags |= VLAN_ACCEL_CAPABLE;
  964. netdev->features |=
  965. NETIF_F_HW_VLAN_TX | NETIF_F_HW_VLAN_RX;
  966. netdev->vlan_rx_register = vlan_rx_register;
  967. netdev->vlan_rx_kill_vid = vlan_rx_kill_vid;
  968. #endif
  969. /* T204: disable TSO */
  970. if (!(is_T2(adapter)) || bi->port_number != 4) {
  971. adapter->flags |= TSO_CAPABLE;
  972. netdev->features |= NETIF_F_TSO;
  973. }
  974. }
  975. netdev->open = cxgb_open;
  976. netdev->stop = cxgb_close;
  977. netdev->hard_start_xmit = t1_start_xmit;
  978. netdev->hard_header_len += (adapter->flags & TSO_CAPABLE) ?
  979. sizeof(struct cpl_tx_pkt_lso) : sizeof(struct cpl_tx_pkt);
  980. netdev->get_stats = t1_get_stats;
  981. netdev->set_multicast_list = t1_set_rxmode;
  982. netdev->do_ioctl = t1_ioctl;
  983. netdev->change_mtu = t1_change_mtu;
  984. netdev->set_mac_address = t1_set_mac_addr;
  985. #ifdef CONFIG_NET_POLL_CONTROLLER
  986. netdev->poll_controller = t1_netpoll;
  987. #endif
  988. #ifdef CONFIG_CHELSIO_T1_NAPI
  989. netdev->weight = 64;
  990. netdev->poll = t1_poll;
  991. #endif
  992. SET_ETHTOOL_OPS(netdev, &t1_ethtool_ops);
  993. }
  994. if (t1_init_sw_modules(adapter, bi) < 0) {
  995. err = -ENODEV;
  996. goto out_free_dev;
  997. }
  998. /*
  999. * The card is now ready to go. If any errors occur during device
  1000. * registration we do not fail the whole card but rather proceed only
  1001. * with the ports we manage to register successfully. However we must
  1002. * register at least one net device.
  1003. */
  1004. for (i = 0; i < bi->port_number; ++i) {
  1005. err = register_netdev(adapter->port[i].dev);
  1006. if (err)
  1007. CH_WARN("%s: cannot register net device %s, skipping\n",
  1008. pci_name(pdev), adapter->port[i].dev->name);
  1009. else {
  1010. /*
  1011. * Change the name we use for messages to the name of
  1012. * the first successfully registered interface.
  1013. */
  1014. if (!adapter->registered_device_map)
  1015. adapter->name = adapter->port[i].dev->name;
  1016. __set_bit(i, &adapter->registered_device_map);
  1017. }
  1018. }
  1019. if (!adapter->registered_device_map) {
  1020. CH_ERR("%s: could not register any net devices\n",
  1021. pci_name(pdev));
  1022. goto out_release_adapter_res;
  1023. }
  1024. printk(KERN_INFO "%s: %s (rev %d), %s %dMHz/%d-bit\n", adapter->name,
  1025. bi->desc, adapter->params.chip_revision,
  1026. adapter->params.pci.is_pcix ? "PCIX" : "PCI",
  1027. adapter->params.pci.speed, adapter->params.pci.width);
  1028. /*
  1029. * Set the T1B ASIC and memory clocks.
  1030. */
  1031. if (t1powersave)
  1032. adapter->t1powersave = LCLOCK; /* HW default is powersave mode. */
  1033. else
  1034. adapter->t1powersave = HCLOCK;
  1035. if (t1_is_T1B(adapter))
  1036. t1_clock(adapter, t1powersave);
  1037. return 0;
  1038. out_release_adapter_res:
  1039. t1_free_sw_modules(adapter);
  1040. out_free_dev:
  1041. if (adapter) {
  1042. if (adapter->regs)
  1043. iounmap(adapter->regs);
  1044. for (i = bi->port_number - 1; i >= 0; --i)
  1045. if (adapter->port[i].dev)
  1046. free_netdev(adapter->port[i].dev);
  1047. }
  1048. pci_release_regions(pdev);
  1049. out_disable_pdev:
  1050. pci_disable_device(pdev);
  1051. pci_set_drvdata(pdev, NULL);
  1052. return err;
  1053. }
  1054. static void bit_bang(struct adapter *adapter, int bitdata, int nbits)
  1055. {
  1056. int data;
  1057. int i;
  1058. u32 val;
  1059. enum {
  1060. S_CLOCK = 1 << 3,
  1061. S_DATA = 1 << 4
  1062. };
  1063. for (i = (nbits - 1); i > -1; i--) {
  1064. udelay(50);
  1065. data = ((bitdata >> i) & 0x1);
  1066. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1067. if (data)
  1068. val |= S_DATA;
  1069. else
  1070. val &= ~S_DATA;
  1071. udelay(50);
  1072. /* Set SCLOCK low */
  1073. val &= ~S_CLOCK;
  1074. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1075. udelay(50);
  1076. /* Write SCLOCK high */
  1077. val |= S_CLOCK;
  1078. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1079. }
  1080. }
  1081. static int t1_clock(struct adapter *adapter, int mode)
  1082. {
  1083. u32 val;
  1084. int M_CORE_VAL;
  1085. int M_MEM_VAL;
  1086. enum {
  1087. M_CORE_BITS = 9,
  1088. T_CORE_VAL = 0,
  1089. T_CORE_BITS = 2,
  1090. N_CORE_VAL = 0,
  1091. N_CORE_BITS = 2,
  1092. M_MEM_BITS = 9,
  1093. T_MEM_VAL = 0,
  1094. T_MEM_BITS = 2,
  1095. N_MEM_VAL = 0,
  1096. N_MEM_BITS = 2,
  1097. NP_LOAD = 1 << 17,
  1098. S_LOAD_MEM = 1 << 5,
  1099. S_LOAD_CORE = 1 << 6,
  1100. S_CLOCK = 1 << 3
  1101. };
  1102. if (!t1_is_T1B(adapter))
  1103. return -ENODEV; /* Can't re-clock this chip. */
  1104. if (mode & 2)
  1105. return 0; /* show current mode. */
  1106. if ((adapter->t1powersave & 1) == (mode & 1))
  1107. return -EALREADY; /* ASIC already running in mode. */
  1108. if ((mode & 1) == HCLOCK) {
  1109. M_CORE_VAL = 0x14;
  1110. M_MEM_VAL = 0x18;
  1111. adapter->t1powersave = HCLOCK; /* overclock */
  1112. } else {
  1113. M_CORE_VAL = 0xe;
  1114. M_MEM_VAL = 0x10;
  1115. adapter->t1powersave = LCLOCK; /* underclock */
  1116. }
  1117. /* Don't interrupt this serial stream! */
  1118. spin_lock(&adapter->tpi_lock);
  1119. /* Initialize for ASIC core */
  1120. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1121. val |= NP_LOAD;
  1122. udelay(50);
  1123. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1124. udelay(50);
  1125. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1126. val &= ~S_LOAD_CORE;
  1127. val &= ~S_CLOCK;
  1128. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1129. udelay(50);
  1130. /* Serial program the ASIC clock synthesizer */
  1131. bit_bang(adapter, T_CORE_VAL, T_CORE_BITS);
  1132. bit_bang(adapter, N_CORE_VAL, N_CORE_BITS);
  1133. bit_bang(adapter, M_CORE_VAL, M_CORE_BITS);
  1134. udelay(50);
  1135. /* Finish ASIC core */
  1136. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1137. val |= S_LOAD_CORE;
  1138. udelay(50);
  1139. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1140. udelay(50);
  1141. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1142. val &= ~S_LOAD_CORE;
  1143. udelay(50);
  1144. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1145. udelay(50);
  1146. /* Initialize for memory */
  1147. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1148. val |= NP_LOAD;
  1149. udelay(50);
  1150. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1151. udelay(50);
  1152. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1153. val &= ~S_LOAD_MEM;
  1154. val &= ~S_CLOCK;
  1155. udelay(50);
  1156. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1157. udelay(50);
  1158. /* Serial program the memory clock synthesizer */
  1159. bit_bang(adapter, T_MEM_VAL, T_MEM_BITS);
  1160. bit_bang(adapter, N_MEM_VAL, N_MEM_BITS);
  1161. bit_bang(adapter, M_MEM_VAL, M_MEM_BITS);
  1162. udelay(50);
  1163. /* Finish memory */
  1164. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1165. val |= S_LOAD_MEM;
  1166. udelay(50);
  1167. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1168. udelay(50);
  1169. __t1_tpi_read(adapter, A_ELMER0_GPO, &val);
  1170. val &= ~S_LOAD_MEM;
  1171. udelay(50);
  1172. __t1_tpi_write(adapter, A_ELMER0_GPO, val);
  1173. spin_unlock(&adapter->tpi_lock);
  1174. return 0;
  1175. }
  1176. static inline void t1_sw_reset(struct pci_dev *pdev)
  1177. {
  1178. pci_write_config_dword(pdev, A_PCICFG_PM_CSR, 3);
  1179. pci_write_config_dword(pdev, A_PCICFG_PM_CSR, 0);
  1180. }
  1181. static void __devexit remove_one(struct pci_dev *pdev)
  1182. {
  1183. struct net_device *dev = pci_get_drvdata(pdev);
  1184. struct adapter *adapter = dev->priv;
  1185. int i;
  1186. for_each_port(adapter, i) {
  1187. if (test_bit(i, &adapter->registered_device_map))
  1188. unregister_netdev(adapter->port[i].dev);
  1189. }
  1190. t1_free_sw_modules(adapter);
  1191. iounmap(adapter->regs);
  1192. while (--i >= 0) {
  1193. if (adapter->port[i].dev)
  1194. free_netdev(adapter->port[i].dev);
  1195. }
  1196. pci_release_regions(pdev);
  1197. pci_disable_device(pdev);
  1198. pci_set_drvdata(pdev, NULL);
  1199. t1_sw_reset(pdev);
  1200. }
  1201. static struct pci_driver driver = {
  1202. .name = DRV_NAME,
  1203. .id_table = t1_pci_tbl,
  1204. .probe = init_one,
  1205. .remove = __devexit_p(remove_one),
  1206. };
  1207. static int __init t1_init_module(void)
  1208. {
  1209. return pci_register_driver(&driver);
  1210. }
  1211. static void __exit t1_cleanup_module(void)
  1212. {
  1213. pci_unregister_driver(&driver);
  1214. }
  1215. module_init(t1_init_module);
  1216. module_exit(t1_cleanup_module);