cxgb2.c 38 KB

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