lmc_main.c 62 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145
  1. /*
  2. * Copyright (c) 1997-2000 LAN Media Corporation (LMC)
  3. * All rights reserved. www.lanmedia.com
  4. * Generic HDLC port Copyright (C) 2008 Krzysztof Halasa <khc@pm.waw.pl>
  5. *
  6. * This code is written by:
  7. * Andrew Stanley-Jones (asj@cban.com)
  8. * Rob Braun (bbraun@vix.com),
  9. * Michael Graff (explorer@vix.com) and
  10. * Matt Thomas (matt@3am-software.com).
  11. *
  12. * With Help By:
  13. * David Boggs
  14. * Ron Crane
  15. * Alan Cox
  16. *
  17. * This software may be used and distributed according to the terms
  18. * of the GNU General Public License version 2, incorporated herein by reference.
  19. *
  20. * Driver for the LanMedia LMC5200, LMC5245, LMC1000, LMC1200 cards.
  21. *
  22. * To control link specific options lmcctl is required.
  23. * It can be obtained from ftp.lanmedia.com.
  24. *
  25. * Linux driver notes:
  26. * Linux uses the device struct lmc_private to pass private information
  27. * around.
  28. *
  29. * The initialization portion of this driver (the lmc_reset() and the
  30. * lmc_dec_reset() functions, as well as the led controls and the
  31. * lmc_initcsrs() functions.
  32. *
  33. * The watchdog function runs every second and checks to see if
  34. * we still have link, and that the timing source is what we expected
  35. * it to be. If link is lost, the interface is marked down, and
  36. * we no longer can transmit.
  37. *
  38. */
  39. #include <linux/kernel.h>
  40. #include <linux/module.h>
  41. #include <linux/string.h>
  42. #include <linux/timer.h>
  43. #include <linux/ptrace.h>
  44. #include <linux/errno.h>
  45. #include <linux/ioport.h>
  46. #include <linux/slab.h>
  47. #include <linux/interrupt.h>
  48. #include <linux/pci.h>
  49. #include <linux/delay.h>
  50. #include <linux/hdlc.h>
  51. #include <linux/init.h>
  52. #include <linux/in.h>
  53. #include <linux/if_arp.h>
  54. #include <linux/netdevice.h>
  55. #include <linux/etherdevice.h>
  56. #include <linux/skbuff.h>
  57. #include <linux/inet.h>
  58. #include <linux/bitops.h>
  59. #include <asm/processor.h> /* Processor type for cache alignment. */
  60. #include <asm/io.h>
  61. #include <asm/dma.h>
  62. #include <asm/uaccess.h>
  63. //#include <asm/spinlock.h>
  64. #define DRIVER_MAJOR_VERSION 1
  65. #define DRIVER_MINOR_VERSION 34
  66. #define DRIVER_SUB_VERSION 0
  67. #define DRIVER_VERSION ((DRIVER_MAJOR_VERSION << 8) + DRIVER_MINOR_VERSION)
  68. #include "lmc.h"
  69. #include "lmc_var.h"
  70. #include "lmc_ioctl.h"
  71. #include "lmc_debug.h"
  72. #include "lmc_proto.h"
  73. static int LMC_PKT_BUF_SZ = 1542;
  74. static DEFINE_PCI_DEVICE_TABLE(lmc_pci_tbl) = {
  75. { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_TULIP_FAST,
  76. PCI_VENDOR_ID_LMC, PCI_ANY_ID },
  77. { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_DEC_TULIP_FAST,
  78. PCI_ANY_ID, PCI_VENDOR_ID_LMC },
  79. { 0 }
  80. };
  81. MODULE_DEVICE_TABLE(pci, lmc_pci_tbl);
  82. MODULE_LICENSE("GPL v2");
  83. static netdev_tx_t lmc_start_xmit(struct sk_buff *skb,
  84. struct net_device *dev);
  85. static int lmc_rx (struct net_device *dev);
  86. static int lmc_open(struct net_device *dev);
  87. static int lmc_close(struct net_device *dev);
  88. static struct net_device_stats *lmc_get_stats(struct net_device *dev);
  89. static irqreturn_t lmc_interrupt(int irq, void *dev_instance);
  90. static void lmc_initcsrs(lmc_softc_t * const sc, lmc_csrptr_t csr_base, size_t csr_size);
  91. static void lmc_softreset(lmc_softc_t * const);
  92. static void lmc_running_reset(struct net_device *dev);
  93. static int lmc_ifdown(struct net_device * const);
  94. static void lmc_watchdog(unsigned long data);
  95. static void lmc_reset(lmc_softc_t * const sc);
  96. static void lmc_dec_reset(lmc_softc_t * const sc);
  97. static void lmc_driver_timeout(struct net_device *dev);
  98. /*
  99. * linux reserves 16 device specific IOCTLs. We call them
  100. * LMCIOC* to control various bits of our world.
  101. */
  102. int lmc_ioctl(struct net_device *dev, struct ifreq *ifr, int cmd) /*fold00*/
  103. {
  104. lmc_softc_t *sc = dev_to_sc(dev);
  105. lmc_ctl_t ctl;
  106. int ret = -EOPNOTSUPP;
  107. u16 regVal;
  108. unsigned long flags;
  109. lmc_trace(dev, "lmc_ioctl in");
  110. /*
  111. * Most functions mess with the structure
  112. * Disable interrupts while we do the polling
  113. */
  114. switch (cmd) {
  115. /*
  116. * Return current driver state. Since we keep this up
  117. * To date internally, just copy this out to the user.
  118. */
  119. case LMCIOCGINFO: /*fold01*/
  120. if (copy_to_user(ifr->ifr_data, &sc->ictl, sizeof(lmc_ctl_t)))
  121. ret = -EFAULT;
  122. else
  123. ret = 0;
  124. break;
  125. case LMCIOCSINFO: /*fold01*/
  126. if (!capable(CAP_NET_ADMIN)) {
  127. ret = -EPERM;
  128. break;
  129. }
  130. if(dev->flags & IFF_UP){
  131. ret = -EBUSY;
  132. break;
  133. }
  134. if (copy_from_user(&ctl, ifr->ifr_data, sizeof(lmc_ctl_t))) {
  135. ret = -EFAULT;
  136. break;
  137. }
  138. spin_lock_irqsave(&sc->lmc_lock, flags);
  139. sc->lmc_media->set_status (sc, &ctl);
  140. if(ctl.crc_length != sc->ictl.crc_length) {
  141. sc->lmc_media->set_crc_length(sc, ctl.crc_length);
  142. if (sc->ictl.crc_length == LMC_CTL_CRC_LENGTH_16)
  143. sc->TxDescriptControlInit |= LMC_TDES_ADD_CRC_DISABLE;
  144. else
  145. sc->TxDescriptControlInit &= ~LMC_TDES_ADD_CRC_DISABLE;
  146. }
  147. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  148. ret = 0;
  149. break;
  150. case LMCIOCIFTYPE: /*fold01*/
  151. {
  152. u16 old_type = sc->if_type;
  153. u16 new_type;
  154. if (!capable(CAP_NET_ADMIN)) {
  155. ret = -EPERM;
  156. break;
  157. }
  158. if (copy_from_user(&new_type, ifr->ifr_data, sizeof(u16))) {
  159. ret = -EFAULT;
  160. break;
  161. }
  162. if (new_type == old_type)
  163. {
  164. ret = 0 ;
  165. break; /* no change */
  166. }
  167. spin_lock_irqsave(&sc->lmc_lock, flags);
  168. lmc_proto_close(sc);
  169. sc->if_type = new_type;
  170. lmc_proto_attach(sc);
  171. ret = lmc_proto_open(sc);
  172. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  173. break;
  174. }
  175. case LMCIOCGETXINFO: /*fold01*/
  176. spin_lock_irqsave(&sc->lmc_lock, flags);
  177. sc->lmc_xinfo.Magic0 = 0xBEEFCAFE;
  178. sc->lmc_xinfo.PciCardType = sc->lmc_cardtype;
  179. sc->lmc_xinfo.PciSlotNumber = 0;
  180. sc->lmc_xinfo.DriverMajorVersion = DRIVER_MAJOR_VERSION;
  181. sc->lmc_xinfo.DriverMinorVersion = DRIVER_MINOR_VERSION;
  182. sc->lmc_xinfo.DriverSubVersion = DRIVER_SUB_VERSION;
  183. sc->lmc_xinfo.XilinxRevisionNumber =
  184. lmc_mii_readreg (sc, 0, 3) & 0xf;
  185. sc->lmc_xinfo.MaxFrameSize = LMC_PKT_BUF_SZ;
  186. sc->lmc_xinfo.link_status = sc->lmc_media->get_link_status (sc);
  187. sc->lmc_xinfo.mii_reg16 = lmc_mii_readreg (sc, 0, 16);
  188. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  189. sc->lmc_xinfo.Magic1 = 0xDEADBEEF;
  190. if (copy_to_user(ifr->ifr_data, &sc->lmc_xinfo,
  191. sizeof(struct lmc_xinfo)))
  192. ret = -EFAULT;
  193. else
  194. ret = 0;
  195. break;
  196. case LMCIOCGETLMCSTATS:
  197. spin_lock_irqsave(&sc->lmc_lock, flags);
  198. if (sc->lmc_cardtype == LMC_CARDTYPE_T1) {
  199. lmc_mii_writereg(sc, 0, 17, T1FRAMER_FERR_LSB);
  200. sc->extra_stats.framingBitErrorCount +=
  201. lmc_mii_readreg(sc, 0, 18) & 0xff;
  202. lmc_mii_writereg(sc, 0, 17, T1FRAMER_FERR_MSB);
  203. sc->extra_stats.framingBitErrorCount +=
  204. (lmc_mii_readreg(sc, 0, 18) & 0xff) << 8;
  205. lmc_mii_writereg(sc, 0, 17, T1FRAMER_LCV_LSB);
  206. sc->extra_stats.lineCodeViolationCount +=
  207. lmc_mii_readreg(sc, 0, 18) & 0xff;
  208. lmc_mii_writereg(sc, 0, 17, T1FRAMER_LCV_MSB);
  209. sc->extra_stats.lineCodeViolationCount +=
  210. (lmc_mii_readreg(sc, 0, 18) & 0xff) << 8;
  211. lmc_mii_writereg(sc, 0, 17, T1FRAMER_AERR);
  212. regVal = lmc_mii_readreg(sc, 0, 18) & 0xff;
  213. sc->extra_stats.lossOfFrameCount +=
  214. (regVal & T1FRAMER_LOF_MASK) >> 4;
  215. sc->extra_stats.changeOfFrameAlignmentCount +=
  216. (regVal & T1FRAMER_COFA_MASK) >> 2;
  217. sc->extra_stats.severelyErroredFrameCount +=
  218. regVal & T1FRAMER_SEF_MASK;
  219. }
  220. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  221. if (copy_to_user(ifr->ifr_data, &sc->lmc_device->stats,
  222. sizeof(sc->lmc_device->stats)) ||
  223. copy_to_user(ifr->ifr_data + sizeof(sc->lmc_device->stats),
  224. &sc->extra_stats, sizeof(sc->extra_stats)))
  225. ret = -EFAULT;
  226. else
  227. ret = 0;
  228. break;
  229. case LMCIOCCLEARLMCSTATS:
  230. if (!capable(CAP_NET_ADMIN)) {
  231. ret = -EPERM;
  232. break;
  233. }
  234. spin_lock_irqsave(&sc->lmc_lock, flags);
  235. memset(&sc->lmc_device->stats, 0, sizeof(sc->lmc_device->stats));
  236. memset(&sc->extra_stats, 0, sizeof(sc->extra_stats));
  237. sc->extra_stats.check = STATCHECK;
  238. sc->extra_stats.version_size = (DRIVER_VERSION << 16) +
  239. sizeof(sc->lmc_device->stats) + sizeof(sc->extra_stats);
  240. sc->extra_stats.lmc_cardtype = sc->lmc_cardtype;
  241. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  242. ret = 0;
  243. break;
  244. case LMCIOCSETCIRCUIT: /*fold01*/
  245. if (!capable(CAP_NET_ADMIN)){
  246. ret = -EPERM;
  247. break;
  248. }
  249. if(dev->flags & IFF_UP){
  250. ret = -EBUSY;
  251. break;
  252. }
  253. if (copy_from_user(&ctl, ifr->ifr_data, sizeof(lmc_ctl_t))) {
  254. ret = -EFAULT;
  255. break;
  256. }
  257. spin_lock_irqsave(&sc->lmc_lock, flags);
  258. sc->lmc_media->set_circuit_type(sc, ctl.circuit_type);
  259. sc->ictl.circuit_type = ctl.circuit_type;
  260. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  261. ret = 0;
  262. break;
  263. case LMCIOCRESET: /*fold01*/
  264. if (!capable(CAP_NET_ADMIN)){
  265. ret = -EPERM;
  266. break;
  267. }
  268. spin_lock_irqsave(&sc->lmc_lock, flags);
  269. /* Reset driver and bring back to current state */
  270. printk (" REG16 before reset +%04x\n", lmc_mii_readreg (sc, 0, 16));
  271. lmc_running_reset (dev);
  272. printk (" REG16 after reset +%04x\n", lmc_mii_readreg (sc, 0, 16));
  273. LMC_EVENT_LOG(LMC_EVENT_FORCEDRESET, LMC_CSR_READ (sc, csr_status), lmc_mii_readreg (sc, 0, 16));
  274. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  275. ret = 0;
  276. break;
  277. #ifdef DEBUG
  278. case LMCIOCDUMPEVENTLOG:
  279. if (copy_to_user(ifr->ifr_data, &lmcEventLogIndex, sizeof(u32))) {
  280. ret = -EFAULT;
  281. break;
  282. }
  283. if (copy_to_user(ifr->ifr_data + sizeof(u32), lmcEventLogBuf,
  284. sizeof(lmcEventLogBuf)))
  285. ret = -EFAULT;
  286. else
  287. ret = 0;
  288. break;
  289. #endif /* end ifdef _DBG_EVENTLOG */
  290. case LMCIOCT1CONTROL: /*fold01*/
  291. if (sc->lmc_cardtype != LMC_CARDTYPE_T1){
  292. ret = -EOPNOTSUPP;
  293. break;
  294. }
  295. break;
  296. case LMCIOCXILINX: /*fold01*/
  297. {
  298. struct lmc_xilinx_control xc; /*fold02*/
  299. if (!capable(CAP_NET_ADMIN)){
  300. ret = -EPERM;
  301. break;
  302. }
  303. /*
  304. * Stop the xwitter whlie we restart the hardware
  305. */
  306. netif_stop_queue(dev);
  307. if (copy_from_user(&xc, ifr->ifr_data, sizeof(struct lmc_xilinx_control))) {
  308. ret = -EFAULT;
  309. break;
  310. }
  311. switch(xc.command){
  312. case lmc_xilinx_reset: /*fold02*/
  313. {
  314. u16 mii;
  315. spin_lock_irqsave(&sc->lmc_lock, flags);
  316. mii = lmc_mii_readreg (sc, 0, 16);
  317. /*
  318. * Make all of them 0 and make input
  319. */
  320. lmc_gpio_mkinput(sc, 0xff);
  321. /*
  322. * make the reset output
  323. */
  324. lmc_gpio_mkoutput(sc, LMC_GEP_RESET);
  325. /*
  326. * RESET low to force configuration. This also forces
  327. * the transmitter clock to be internal, but we expect to reset
  328. * that later anyway.
  329. */
  330. sc->lmc_gpio &= ~LMC_GEP_RESET;
  331. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  332. /*
  333. * hold for more than 10 microseconds
  334. */
  335. udelay(50);
  336. sc->lmc_gpio |= LMC_GEP_RESET;
  337. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  338. /*
  339. * stop driving Xilinx-related signals
  340. */
  341. lmc_gpio_mkinput(sc, 0xff);
  342. /* Reset the frammer hardware */
  343. sc->lmc_media->set_link_status (sc, 1);
  344. sc->lmc_media->set_status (sc, NULL);
  345. // lmc_softreset(sc);
  346. {
  347. int i;
  348. for(i = 0; i < 5; i++){
  349. lmc_led_on(sc, LMC_DS3_LED0);
  350. mdelay(100);
  351. lmc_led_off(sc, LMC_DS3_LED0);
  352. lmc_led_on(sc, LMC_DS3_LED1);
  353. mdelay(100);
  354. lmc_led_off(sc, LMC_DS3_LED1);
  355. lmc_led_on(sc, LMC_DS3_LED3);
  356. mdelay(100);
  357. lmc_led_off(sc, LMC_DS3_LED3);
  358. lmc_led_on(sc, LMC_DS3_LED2);
  359. mdelay(100);
  360. lmc_led_off(sc, LMC_DS3_LED2);
  361. }
  362. }
  363. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  364. ret = 0x0;
  365. }
  366. break;
  367. case lmc_xilinx_load_prom: /*fold02*/
  368. {
  369. u16 mii;
  370. int timeout = 500000;
  371. spin_lock_irqsave(&sc->lmc_lock, flags);
  372. mii = lmc_mii_readreg (sc, 0, 16);
  373. /*
  374. * Make all of them 0 and make input
  375. */
  376. lmc_gpio_mkinput(sc, 0xff);
  377. /*
  378. * make the reset output
  379. */
  380. lmc_gpio_mkoutput(sc, LMC_GEP_DP | LMC_GEP_RESET);
  381. /*
  382. * RESET low to force configuration. This also forces
  383. * the transmitter clock to be internal, but we expect to reset
  384. * that later anyway.
  385. */
  386. sc->lmc_gpio &= ~(LMC_GEP_RESET | LMC_GEP_DP);
  387. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  388. /*
  389. * hold for more than 10 microseconds
  390. */
  391. udelay(50);
  392. sc->lmc_gpio |= LMC_GEP_DP | LMC_GEP_RESET;
  393. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  394. /*
  395. * busy wait for the chip to reset
  396. */
  397. while( (LMC_CSR_READ(sc, csr_gp) & LMC_GEP_INIT) == 0 &&
  398. (timeout-- > 0))
  399. cpu_relax();
  400. /*
  401. * stop driving Xilinx-related signals
  402. */
  403. lmc_gpio_mkinput(sc, 0xff);
  404. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  405. ret = 0x0;
  406. break;
  407. }
  408. case lmc_xilinx_load: /*fold02*/
  409. {
  410. char *data;
  411. int pos;
  412. int timeout = 500000;
  413. if (!xc.data) {
  414. ret = -EINVAL;
  415. break;
  416. }
  417. data = kmalloc(xc.len, GFP_KERNEL);
  418. if (!data) {
  419. printk(KERN_WARNING "%s: Failed to allocate memory for copy\n", dev->name);
  420. ret = -ENOMEM;
  421. break;
  422. }
  423. if(copy_from_user(data, xc.data, xc.len))
  424. {
  425. kfree(data);
  426. ret = -ENOMEM;
  427. break;
  428. }
  429. printk("%s: Starting load of data Len: %d at 0x%p == 0x%p\n", dev->name, xc.len, xc.data, data);
  430. spin_lock_irqsave(&sc->lmc_lock, flags);
  431. lmc_gpio_mkinput(sc, 0xff);
  432. /*
  433. * Clear the Xilinx and start prgramming from the DEC
  434. */
  435. /*
  436. * Set ouput as:
  437. * Reset: 0 (active)
  438. * DP: 0 (active)
  439. * Mode: 1
  440. *
  441. */
  442. sc->lmc_gpio = 0x00;
  443. sc->lmc_gpio &= ~LMC_GEP_DP;
  444. sc->lmc_gpio &= ~LMC_GEP_RESET;
  445. sc->lmc_gpio |= LMC_GEP_MODE;
  446. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  447. lmc_gpio_mkoutput(sc, LMC_GEP_MODE | LMC_GEP_DP | LMC_GEP_RESET);
  448. /*
  449. * Wait at least 10 us 20 to be safe
  450. */
  451. udelay(50);
  452. /*
  453. * Clear reset and activate programming lines
  454. * Reset: Input
  455. * DP: Input
  456. * Clock: Output
  457. * Data: Output
  458. * Mode: Output
  459. */
  460. lmc_gpio_mkinput(sc, LMC_GEP_DP | LMC_GEP_RESET);
  461. /*
  462. * Set LOAD, DATA, Clock to 1
  463. */
  464. sc->lmc_gpio = 0x00;
  465. sc->lmc_gpio |= LMC_GEP_MODE;
  466. sc->lmc_gpio |= LMC_GEP_DATA;
  467. sc->lmc_gpio |= LMC_GEP_CLK;
  468. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  469. lmc_gpio_mkoutput(sc, LMC_GEP_DATA | LMC_GEP_CLK | LMC_GEP_MODE );
  470. /*
  471. * busy wait for the chip to reset
  472. */
  473. while( (LMC_CSR_READ(sc, csr_gp) & LMC_GEP_INIT) == 0 &&
  474. (timeout-- > 0))
  475. cpu_relax();
  476. printk(KERN_DEBUG "%s: Waited %d for the Xilinx to clear it's memory\n", dev->name, 500000-timeout);
  477. for(pos = 0; pos < xc.len; pos++){
  478. switch(data[pos]){
  479. case 0:
  480. sc->lmc_gpio &= ~LMC_GEP_DATA; /* Data is 0 */
  481. break;
  482. case 1:
  483. sc->lmc_gpio |= LMC_GEP_DATA; /* Data is 1 */
  484. break;
  485. default:
  486. printk(KERN_WARNING "%s Bad data in xilinx programming data at %d, got %d wanted 0 or 1\n", dev->name, pos, data[pos]);
  487. sc->lmc_gpio |= LMC_GEP_DATA; /* Assume it's 1 */
  488. }
  489. sc->lmc_gpio &= ~LMC_GEP_CLK; /* Clock to zero */
  490. sc->lmc_gpio |= LMC_GEP_MODE;
  491. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  492. udelay(1);
  493. sc->lmc_gpio |= LMC_GEP_CLK; /* Put the clack back to one */
  494. sc->lmc_gpio |= LMC_GEP_MODE;
  495. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  496. udelay(1);
  497. }
  498. if((LMC_CSR_READ(sc, csr_gp) & LMC_GEP_INIT) == 0){
  499. printk(KERN_WARNING "%s: Reprogramming FAILED. Needs to be reprogrammed. (corrupted data)\n", dev->name);
  500. }
  501. else if((LMC_CSR_READ(sc, csr_gp) & LMC_GEP_DP) == 0){
  502. printk(KERN_WARNING "%s: Reprogramming FAILED. Needs to be reprogrammed. (done)\n", dev->name);
  503. }
  504. else {
  505. printk(KERN_DEBUG "%s: Done reprogramming Xilinx, %d bits, good luck!\n", dev->name, pos);
  506. }
  507. lmc_gpio_mkinput(sc, 0xff);
  508. sc->lmc_miireg16 |= LMC_MII16_FIFO_RESET;
  509. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  510. sc->lmc_miireg16 &= ~LMC_MII16_FIFO_RESET;
  511. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  512. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  513. kfree(data);
  514. ret = 0;
  515. break;
  516. }
  517. default: /*fold02*/
  518. ret = -EBADE;
  519. break;
  520. }
  521. netif_wake_queue(dev);
  522. sc->lmc_txfull = 0;
  523. }
  524. break;
  525. default: /*fold01*/
  526. /* If we don't know what to do, give the protocol a shot. */
  527. ret = lmc_proto_ioctl (sc, ifr, cmd);
  528. break;
  529. }
  530. lmc_trace(dev, "lmc_ioctl out");
  531. return ret;
  532. }
  533. /* the watchdog process that cruises around */
  534. static void lmc_watchdog (unsigned long data) /*fold00*/
  535. {
  536. struct net_device *dev = (struct net_device *)data;
  537. lmc_softc_t *sc = dev_to_sc(dev);
  538. int link_status;
  539. u32 ticks;
  540. unsigned long flags;
  541. lmc_trace(dev, "lmc_watchdog in");
  542. spin_lock_irqsave(&sc->lmc_lock, flags);
  543. if(sc->check != 0xBEAFCAFE){
  544. printk("LMC: Corrupt net_device struct, breaking out\n");
  545. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  546. return;
  547. }
  548. /* Make sure the tx jabber and rx watchdog are off,
  549. * and the transmit and receive processes are running.
  550. */
  551. LMC_CSR_WRITE (sc, csr_15, 0x00000011);
  552. sc->lmc_cmdmode |= TULIP_CMD_TXRUN | TULIP_CMD_RXRUN;
  553. LMC_CSR_WRITE (sc, csr_command, sc->lmc_cmdmode);
  554. if (sc->lmc_ok == 0)
  555. goto kick_timer;
  556. LMC_EVENT_LOG(LMC_EVENT_WATCHDOG, LMC_CSR_READ (sc, csr_status), lmc_mii_readreg (sc, 0, 16));
  557. /* --- begin time out check -----------------------------------
  558. * check for a transmit interrupt timeout
  559. * Has the packet xmt vs xmt serviced threshold been exceeded */
  560. if (sc->lmc_taint_tx == sc->lastlmc_taint_tx &&
  561. sc->lmc_device->stats.tx_packets > sc->lasttx_packets &&
  562. sc->tx_TimeoutInd == 0)
  563. {
  564. /* wait for the watchdog to come around again */
  565. sc->tx_TimeoutInd = 1;
  566. }
  567. else if (sc->lmc_taint_tx == sc->lastlmc_taint_tx &&
  568. sc->lmc_device->stats.tx_packets > sc->lasttx_packets &&
  569. sc->tx_TimeoutInd)
  570. {
  571. LMC_EVENT_LOG(LMC_EVENT_XMTINTTMO, LMC_CSR_READ (sc, csr_status), 0);
  572. sc->tx_TimeoutDisplay = 1;
  573. sc->extra_stats.tx_TimeoutCnt++;
  574. /* DEC chip is stuck, hit it with a RESET!!!! */
  575. lmc_running_reset (dev);
  576. /* look at receive & transmit process state to make sure they are running */
  577. LMC_EVENT_LOG(LMC_EVENT_RESET1, LMC_CSR_READ (sc, csr_status), 0);
  578. /* look at: DSR - 02 for Reg 16
  579. * CTS - 08
  580. * DCD - 10
  581. * RI - 20
  582. * for Reg 17
  583. */
  584. LMC_EVENT_LOG(LMC_EVENT_RESET2, lmc_mii_readreg (sc, 0, 16), lmc_mii_readreg (sc, 0, 17));
  585. /* reset the transmit timeout detection flag */
  586. sc->tx_TimeoutInd = 0;
  587. sc->lastlmc_taint_tx = sc->lmc_taint_tx;
  588. sc->lasttx_packets = sc->lmc_device->stats.tx_packets;
  589. } else {
  590. sc->tx_TimeoutInd = 0;
  591. sc->lastlmc_taint_tx = sc->lmc_taint_tx;
  592. sc->lasttx_packets = sc->lmc_device->stats.tx_packets;
  593. }
  594. /* --- end time out check ----------------------------------- */
  595. link_status = sc->lmc_media->get_link_status (sc);
  596. /*
  597. * hardware level link lost, but the interface is marked as up.
  598. * Mark it as down.
  599. */
  600. if ((link_status == 0) && (sc->last_link_status != 0)) {
  601. printk(KERN_WARNING "%s: hardware/physical link down\n", dev->name);
  602. sc->last_link_status = 0;
  603. /* lmc_reset (sc); Why reset??? The link can go down ok */
  604. /* Inform the world that link has been lost */
  605. netif_carrier_off(dev);
  606. }
  607. /*
  608. * hardware link is up, but the interface is marked as down.
  609. * Bring it back up again.
  610. */
  611. if (link_status != 0 && sc->last_link_status == 0) {
  612. printk(KERN_WARNING "%s: hardware/physical link up\n", dev->name);
  613. sc->last_link_status = 1;
  614. /* lmc_reset (sc); Again why reset??? */
  615. netif_carrier_on(dev);
  616. }
  617. /* Call media specific watchdog functions */
  618. sc->lmc_media->watchdog(sc);
  619. /*
  620. * Poke the transmitter to make sure it
  621. * never stops, even if we run out of mem
  622. */
  623. LMC_CSR_WRITE(sc, csr_rxpoll, 0);
  624. /*
  625. * Check for code that failed
  626. * and try and fix it as appropriate
  627. */
  628. if(sc->failed_ring == 1){
  629. /*
  630. * Failed to setup the recv/xmit rin
  631. * Try again
  632. */
  633. sc->failed_ring = 0;
  634. lmc_softreset(sc);
  635. }
  636. if(sc->failed_recv_alloc == 1){
  637. /*
  638. * We failed to alloc mem in the
  639. * interrupt handler, go through the rings
  640. * and rebuild them
  641. */
  642. sc->failed_recv_alloc = 0;
  643. lmc_softreset(sc);
  644. }
  645. /*
  646. * remember the timer value
  647. */
  648. kick_timer:
  649. ticks = LMC_CSR_READ (sc, csr_gp_timer);
  650. LMC_CSR_WRITE (sc, csr_gp_timer, 0xffffffffUL);
  651. sc->ictl.ticks = 0x0000ffff - (ticks & 0x0000ffff);
  652. /*
  653. * restart this timer.
  654. */
  655. sc->timer.expires = jiffies + (HZ);
  656. add_timer (&sc->timer);
  657. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  658. lmc_trace(dev, "lmc_watchdog out");
  659. }
  660. static int lmc_attach(struct net_device *dev, unsigned short encoding,
  661. unsigned short parity)
  662. {
  663. if (encoding == ENCODING_NRZ && parity == PARITY_CRC16_PR1_CCITT)
  664. return 0;
  665. return -EINVAL;
  666. }
  667. static const struct net_device_ops lmc_ops = {
  668. .ndo_open = lmc_open,
  669. .ndo_stop = lmc_close,
  670. .ndo_change_mtu = hdlc_change_mtu,
  671. .ndo_start_xmit = hdlc_start_xmit,
  672. .ndo_do_ioctl = lmc_ioctl,
  673. .ndo_tx_timeout = lmc_driver_timeout,
  674. .ndo_get_stats = lmc_get_stats,
  675. };
  676. static int __devinit lmc_init_one(struct pci_dev *pdev,
  677. const struct pci_device_id *ent)
  678. {
  679. lmc_softc_t *sc;
  680. struct net_device *dev;
  681. u16 subdevice;
  682. u16 AdapModelNum;
  683. int err;
  684. static int cards_found;
  685. /* lmc_trace(dev, "lmc_init_one in"); */
  686. err = pci_enable_device(pdev);
  687. if (err) {
  688. printk(KERN_ERR "lmc: pci enable failed: %d\n", err);
  689. return err;
  690. }
  691. err = pci_request_regions(pdev, "lmc");
  692. if (err) {
  693. printk(KERN_ERR "lmc: pci_request_region failed\n");
  694. goto err_req_io;
  695. }
  696. /*
  697. * Allocate our own device structure
  698. */
  699. sc = kzalloc(sizeof(lmc_softc_t), GFP_KERNEL);
  700. if (!sc) {
  701. err = -ENOMEM;
  702. goto err_kzalloc;
  703. }
  704. dev = alloc_hdlcdev(sc);
  705. if (!dev) {
  706. printk(KERN_ERR "lmc:alloc_netdev for device failed\n");
  707. goto err_hdlcdev;
  708. }
  709. dev->type = ARPHRD_HDLC;
  710. dev_to_hdlc(dev)->xmit = lmc_start_xmit;
  711. dev_to_hdlc(dev)->attach = lmc_attach;
  712. dev->netdev_ops = &lmc_ops;
  713. dev->watchdog_timeo = HZ; /* 1 second */
  714. dev->tx_queue_len = 100;
  715. sc->lmc_device = dev;
  716. sc->name = dev->name;
  717. sc->if_type = LMC_PPP;
  718. sc->check = 0xBEAFCAFE;
  719. dev->base_addr = pci_resource_start(pdev, 0);
  720. dev->irq = pdev->irq;
  721. pci_set_drvdata(pdev, dev);
  722. SET_NETDEV_DEV(dev, &pdev->dev);
  723. /*
  724. * This will get the protocol layer ready and do any 1 time init's
  725. * Must have a valid sc and dev structure
  726. */
  727. lmc_proto_attach(sc);
  728. /* Init the spin lock so can call it latter */
  729. spin_lock_init(&sc->lmc_lock);
  730. pci_set_master(pdev);
  731. printk(KERN_INFO "%s: detected at %lx, irq %d\n", dev->name,
  732. dev->base_addr, dev->irq);
  733. err = register_hdlc_device(dev);
  734. if (err) {
  735. printk(KERN_ERR "%s: register_netdev failed.\n", dev->name);
  736. free_netdev(dev);
  737. goto err_hdlcdev;
  738. }
  739. sc->lmc_cardtype = LMC_CARDTYPE_UNKNOWN;
  740. sc->lmc_timing = LMC_CTL_CLOCK_SOURCE_EXT;
  741. /*
  742. *
  743. * Check either the subvendor or the subdevice, some systems reverse
  744. * the setting in the bois, seems to be version and arch dependent?
  745. * Fix the error, exchange the two values
  746. */
  747. if ((subdevice = pdev->subsystem_device) == PCI_VENDOR_ID_LMC)
  748. subdevice = pdev->subsystem_vendor;
  749. switch (subdevice) {
  750. case PCI_DEVICE_ID_LMC_HSSI:
  751. printk(KERN_INFO "%s: LMC HSSI\n", dev->name);
  752. sc->lmc_cardtype = LMC_CARDTYPE_HSSI;
  753. sc->lmc_media = &lmc_hssi_media;
  754. break;
  755. case PCI_DEVICE_ID_LMC_DS3:
  756. printk(KERN_INFO "%s: LMC DS3\n", dev->name);
  757. sc->lmc_cardtype = LMC_CARDTYPE_DS3;
  758. sc->lmc_media = &lmc_ds3_media;
  759. break;
  760. case PCI_DEVICE_ID_LMC_SSI:
  761. printk(KERN_INFO "%s: LMC SSI\n", dev->name);
  762. sc->lmc_cardtype = LMC_CARDTYPE_SSI;
  763. sc->lmc_media = &lmc_ssi_media;
  764. break;
  765. case PCI_DEVICE_ID_LMC_T1:
  766. printk(KERN_INFO "%s: LMC T1\n", dev->name);
  767. sc->lmc_cardtype = LMC_CARDTYPE_T1;
  768. sc->lmc_media = &lmc_t1_media;
  769. break;
  770. default:
  771. printk(KERN_WARNING "%s: LMC UNKNOWN CARD!\n", dev->name);
  772. break;
  773. }
  774. lmc_initcsrs (sc, dev->base_addr, 8);
  775. lmc_gpio_mkinput (sc, 0xff);
  776. sc->lmc_gpio = 0; /* drive no signals yet */
  777. sc->lmc_media->defaults (sc);
  778. sc->lmc_media->set_link_status (sc, LMC_LINK_UP);
  779. /* verify that the PCI Sub System ID matches the Adapter Model number
  780. * from the MII register
  781. */
  782. AdapModelNum = (lmc_mii_readreg (sc, 0, 3) & 0x3f0) >> 4;
  783. if ((AdapModelNum != LMC_ADAP_T1 || /* detect LMC1200 */
  784. subdevice != PCI_DEVICE_ID_LMC_T1) &&
  785. (AdapModelNum != LMC_ADAP_SSI || /* detect LMC1000 */
  786. subdevice != PCI_DEVICE_ID_LMC_SSI) &&
  787. (AdapModelNum != LMC_ADAP_DS3 || /* detect LMC5245 */
  788. subdevice != PCI_DEVICE_ID_LMC_DS3) &&
  789. (AdapModelNum != LMC_ADAP_HSSI || /* detect LMC5200 */
  790. subdevice != PCI_DEVICE_ID_LMC_HSSI))
  791. printk(KERN_WARNING "%s: Model number (%d) miscompare for PCI"
  792. " Subsystem ID = 0x%04x\n",
  793. dev->name, AdapModelNum, subdevice);
  794. /*
  795. * reset clock
  796. */
  797. LMC_CSR_WRITE (sc, csr_gp_timer, 0xFFFFFFFFUL);
  798. sc->board_idx = cards_found++;
  799. sc->extra_stats.check = STATCHECK;
  800. sc->extra_stats.version_size = (DRIVER_VERSION << 16) +
  801. sizeof(sc->lmc_device->stats) + sizeof(sc->extra_stats);
  802. sc->extra_stats.lmc_cardtype = sc->lmc_cardtype;
  803. sc->lmc_ok = 0;
  804. sc->last_link_status = 0;
  805. lmc_trace(dev, "lmc_init_one out");
  806. return 0;
  807. err_hdlcdev:
  808. pci_set_drvdata(pdev, NULL);
  809. kfree(sc);
  810. err_kzalloc:
  811. pci_release_regions(pdev);
  812. err_req_io:
  813. pci_disable_device(pdev);
  814. return err;
  815. }
  816. /*
  817. * Called from pci when removing module.
  818. */
  819. static void __devexit lmc_remove_one(struct pci_dev *pdev)
  820. {
  821. struct net_device *dev = pci_get_drvdata(pdev);
  822. if (dev) {
  823. printk(KERN_DEBUG "%s: removing...\n", dev->name);
  824. unregister_hdlc_device(dev);
  825. free_netdev(dev);
  826. pci_release_regions(pdev);
  827. pci_disable_device(pdev);
  828. pci_set_drvdata(pdev, NULL);
  829. }
  830. }
  831. /* After this is called, packets can be sent.
  832. * Does not initialize the addresses
  833. */
  834. static int lmc_open(struct net_device *dev)
  835. {
  836. lmc_softc_t *sc = dev_to_sc(dev);
  837. int err;
  838. lmc_trace(dev, "lmc_open in");
  839. lmc_led_on(sc, LMC_DS3_LED0);
  840. lmc_dec_reset(sc);
  841. lmc_reset(sc);
  842. LMC_EVENT_LOG(LMC_EVENT_RESET1, LMC_CSR_READ(sc, csr_status), 0);
  843. LMC_EVENT_LOG(LMC_EVENT_RESET2, lmc_mii_readreg(sc, 0, 16),
  844. lmc_mii_readreg(sc, 0, 17));
  845. if (sc->lmc_ok){
  846. lmc_trace(dev, "lmc_open lmc_ok out");
  847. return 0;
  848. }
  849. lmc_softreset (sc);
  850. /* Since we have to use PCI bus, this should work on x86,alpha,ppc */
  851. if (request_irq (dev->irq, lmc_interrupt, IRQF_SHARED, dev->name, dev)){
  852. printk(KERN_WARNING "%s: could not get irq: %d\n", dev->name, dev->irq);
  853. lmc_trace(dev, "lmc_open irq failed out");
  854. return -EAGAIN;
  855. }
  856. sc->got_irq = 1;
  857. /* Assert Terminal Active */
  858. sc->lmc_miireg16 |= LMC_MII16_LED_ALL;
  859. sc->lmc_media->set_link_status (sc, LMC_LINK_UP);
  860. /*
  861. * reset to last state.
  862. */
  863. sc->lmc_media->set_status (sc, NULL);
  864. /* setup default bits to be used in tulip_desc_t transmit descriptor
  865. * -baz */
  866. sc->TxDescriptControlInit = (
  867. LMC_TDES_INTERRUPT_ON_COMPLETION
  868. | LMC_TDES_FIRST_SEGMENT
  869. | LMC_TDES_LAST_SEGMENT
  870. | LMC_TDES_SECOND_ADDR_CHAINED
  871. | LMC_TDES_DISABLE_PADDING
  872. );
  873. if (sc->ictl.crc_length == LMC_CTL_CRC_LENGTH_16) {
  874. /* disable 32 bit CRC generated by ASIC */
  875. sc->TxDescriptControlInit |= LMC_TDES_ADD_CRC_DISABLE;
  876. }
  877. sc->lmc_media->set_crc_length(sc, sc->ictl.crc_length);
  878. /* Acknoledge the Terminal Active and light LEDs */
  879. /* dev->flags |= IFF_UP; */
  880. if ((err = lmc_proto_open(sc)) != 0)
  881. return err;
  882. netif_start_queue(dev);
  883. sc->extra_stats.tx_tbusy0++;
  884. /*
  885. * select what interrupts we want to get
  886. */
  887. sc->lmc_intrmask = 0;
  888. /* Should be using the default interrupt mask defined in the .h file. */
  889. sc->lmc_intrmask |= (TULIP_STS_NORMALINTR
  890. | TULIP_STS_RXINTR
  891. | TULIP_STS_TXINTR
  892. | TULIP_STS_ABNRMLINTR
  893. | TULIP_STS_SYSERROR
  894. | TULIP_STS_TXSTOPPED
  895. | TULIP_STS_TXUNDERFLOW
  896. | TULIP_STS_RXSTOPPED
  897. | TULIP_STS_RXNOBUF
  898. );
  899. LMC_CSR_WRITE (sc, csr_intr, sc->lmc_intrmask);
  900. sc->lmc_cmdmode |= TULIP_CMD_TXRUN;
  901. sc->lmc_cmdmode |= TULIP_CMD_RXRUN;
  902. LMC_CSR_WRITE (sc, csr_command, sc->lmc_cmdmode);
  903. sc->lmc_ok = 1; /* Run watchdog */
  904. /*
  905. * Set the if up now - pfb
  906. */
  907. sc->last_link_status = 1;
  908. /*
  909. * Setup a timer for the watchdog on probe, and start it running.
  910. * Since lmc_ok == 0, it will be a NOP for now.
  911. */
  912. init_timer (&sc->timer);
  913. sc->timer.expires = jiffies + HZ;
  914. sc->timer.data = (unsigned long) dev;
  915. sc->timer.function = lmc_watchdog;
  916. add_timer (&sc->timer);
  917. lmc_trace(dev, "lmc_open out");
  918. return 0;
  919. }
  920. /* Total reset to compensate for the AdTran DSU doing bad things
  921. * under heavy load
  922. */
  923. static void lmc_running_reset (struct net_device *dev) /*fold00*/
  924. {
  925. lmc_softc_t *sc = dev_to_sc(dev);
  926. lmc_trace(dev, "lmc_runnig_reset in");
  927. /* stop interrupts */
  928. /* Clear the interrupt mask */
  929. LMC_CSR_WRITE (sc, csr_intr, 0x00000000);
  930. lmc_dec_reset (sc);
  931. lmc_reset (sc);
  932. lmc_softreset (sc);
  933. /* sc->lmc_miireg16 |= LMC_MII16_LED_ALL; */
  934. sc->lmc_media->set_link_status (sc, 1);
  935. sc->lmc_media->set_status (sc, NULL);
  936. netif_wake_queue(dev);
  937. sc->lmc_txfull = 0;
  938. sc->extra_stats.tx_tbusy0++;
  939. sc->lmc_intrmask = TULIP_DEFAULT_INTR_MASK;
  940. LMC_CSR_WRITE (sc, csr_intr, sc->lmc_intrmask);
  941. sc->lmc_cmdmode |= (TULIP_CMD_TXRUN | TULIP_CMD_RXRUN);
  942. LMC_CSR_WRITE (sc, csr_command, sc->lmc_cmdmode);
  943. lmc_trace(dev, "lmc_runnin_reset_out");
  944. }
  945. /* This is what is called when you ifconfig down a device.
  946. * This disables the timer for the watchdog and keepalives,
  947. * and disables the irq for dev.
  948. */
  949. static int lmc_close(struct net_device *dev)
  950. {
  951. /* not calling release_region() as we should */
  952. lmc_softc_t *sc = dev_to_sc(dev);
  953. lmc_trace(dev, "lmc_close in");
  954. sc->lmc_ok = 0;
  955. sc->lmc_media->set_link_status (sc, 0);
  956. del_timer (&sc->timer);
  957. lmc_proto_close(sc);
  958. lmc_ifdown (dev);
  959. lmc_trace(dev, "lmc_close out");
  960. return 0;
  961. }
  962. /* Ends the transfer of packets */
  963. /* When the interface goes down, this is called */
  964. static int lmc_ifdown (struct net_device *dev) /*fold00*/
  965. {
  966. lmc_softc_t *sc = dev_to_sc(dev);
  967. u32 csr6;
  968. int i;
  969. lmc_trace(dev, "lmc_ifdown in");
  970. /* Don't let anything else go on right now */
  971. // dev->start = 0;
  972. netif_stop_queue(dev);
  973. sc->extra_stats.tx_tbusy1++;
  974. /* stop interrupts */
  975. /* Clear the interrupt mask */
  976. LMC_CSR_WRITE (sc, csr_intr, 0x00000000);
  977. /* Stop Tx and Rx on the chip */
  978. csr6 = LMC_CSR_READ (sc, csr_command);
  979. csr6 &= ~LMC_DEC_ST; /* Turn off the Transmission bit */
  980. csr6 &= ~LMC_DEC_SR; /* Turn off the Receive bit */
  981. LMC_CSR_WRITE (sc, csr_command, csr6);
  982. sc->lmc_device->stats.rx_missed_errors +=
  983. LMC_CSR_READ(sc, csr_missed_frames) & 0xffff;
  984. /* release the interrupt */
  985. if(sc->got_irq == 1){
  986. free_irq (dev->irq, dev);
  987. sc->got_irq = 0;
  988. }
  989. /* free skbuffs in the Rx queue */
  990. for (i = 0; i < LMC_RXDESCS; i++)
  991. {
  992. struct sk_buff *skb = sc->lmc_rxq[i];
  993. sc->lmc_rxq[i] = NULL;
  994. sc->lmc_rxring[i].status = 0;
  995. sc->lmc_rxring[i].length = 0;
  996. sc->lmc_rxring[i].buffer1 = 0xDEADBEEF;
  997. if (skb != NULL)
  998. dev_kfree_skb(skb);
  999. sc->lmc_rxq[i] = NULL;
  1000. }
  1001. for (i = 0; i < LMC_TXDESCS; i++)
  1002. {
  1003. if (sc->lmc_txq[i] != NULL)
  1004. dev_kfree_skb(sc->lmc_txq[i]);
  1005. sc->lmc_txq[i] = NULL;
  1006. }
  1007. lmc_led_off (sc, LMC_MII16_LED_ALL);
  1008. netif_wake_queue(dev);
  1009. sc->extra_stats.tx_tbusy0++;
  1010. lmc_trace(dev, "lmc_ifdown out");
  1011. return 0;
  1012. }
  1013. /* Interrupt handling routine. This will take an incoming packet, or clean
  1014. * up after a trasmit.
  1015. */
  1016. static irqreturn_t lmc_interrupt (int irq, void *dev_instance) /*fold00*/
  1017. {
  1018. struct net_device *dev = (struct net_device *) dev_instance;
  1019. lmc_softc_t *sc = dev_to_sc(dev);
  1020. u32 csr;
  1021. int i;
  1022. s32 stat;
  1023. unsigned int badtx;
  1024. u32 firstcsr;
  1025. int max_work = LMC_RXDESCS;
  1026. int handled = 0;
  1027. lmc_trace(dev, "lmc_interrupt in");
  1028. spin_lock(&sc->lmc_lock);
  1029. /*
  1030. * Read the csr to find what interrupts we have (if any)
  1031. */
  1032. csr = LMC_CSR_READ (sc, csr_status);
  1033. /*
  1034. * Make sure this is our interrupt
  1035. */
  1036. if ( ! (csr & sc->lmc_intrmask)) {
  1037. goto lmc_int_fail_out;
  1038. }
  1039. firstcsr = csr;
  1040. /* always go through this loop at least once */
  1041. while (csr & sc->lmc_intrmask) {
  1042. handled = 1;
  1043. /*
  1044. * Clear interrupt bits, we handle all case below
  1045. */
  1046. LMC_CSR_WRITE (sc, csr_status, csr);
  1047. /*
  1048. * One of
  1049. * - Transmit process timed out CSR5<1>
  1050. * - Transmit jabber timeout CSR5<3>
  1051. * - Transmit underflow CSR5<5>
  1052. * - Transmit Receiver buffer unavailable CSR5<7>
  1053. * - Receive process stopped CSR5<8>
  1054. * - Receive watchdog timeout CSR5<9>
  1055. * - Early transmit interrupt CSR5<10>
  1056. *
  1057. * Is this really right? Should we do a running reset for jabber?
  1058. * (being a WAN card and all)
  1059. */
  1060. if (csr & TULIP_STS_ABNRMLINTR){
  1061. lmc_running_reset (dev);
  1062. break;
  1063. }
  1064. if (csr & TULIP_STS_RXINTR){
  1065. lmc_trace(dev, "rx interrupt");
  1066. lmc_rx (dev);
  1067. }
  1068. if (csr & (TULIP_STS_TXINTR | TULIP_STS_TXNOBUF | TULIP_STS_TXSTOPPED)) {
  1069. int n_compl = 0 ;
  1070. /* reset the transmit timeout detection flag -baz */
  1071. sc->extra_stats.tx_NoCompleteCnt = 0;
  1072. badtx = sc->lmc_taint_tx;
  1073. i = badtx % LMC_TXDESCS;
  1074. while ((badtx < sc->lmc_next_tx)) {
  1075. stat = sc->lmc_txring[i].status;
  1076. LMC_EVENT_LOG (LMC_EVENT_XMTINT, stat,
  1077. sc->lmc_txring[i].length);
  1078. /*
  1079. * If bit 31 is 1 the tulip owns it break out of the loop
  1080. */
  1081. if (stat & 0x80000000)
  1082. break;
  1083. n_compl++ ; /* i.e., have an empty slot in ring */
  1084. /*
  1085. * If we have no skbuff or have cleared it
  1086. * Already continue to the next buffer
  1087. */
  1088. if (sc->lmc_txq[i] == NULL)
  1089. continue;
  1090. /*
  1091. * Check the total error summary to look for any errors
  1092. */
  1093. if (stat & 0x8000) {
  1094. sc->lmc_device->stats.tx_errors++;
  1095. if (stat & 0x4104)
  1096. sc->lmc_device->stats.tx_aborted_errors++;
  1097. if (stat & 0x0C00)
  1098. sc->lmc_device->stats.tx_carrier_errors++;
  1099. if (stat & 0x0200)
  1100. sc->lmc_device->stats.tx_window_errors++;
  1101. if (stat & 0x0002)
  1102. sc->lmc_device->stats.tx_fifo_errors++;
  1103. } else {
  1104. sc->lmc_device->stats.tx_bytes += sc->lmc_txring[i].length & 0x7ff;
  1105. sc->lmc_device->stats.tx_packets++;
  1106. }
  1107. // dev_kfree_skb(sc->lmc_txq[i]);
  1108. dev_kfree_skb_irq(sc->lmc_txq[i]);
  1109. sc->lmc_txq[i] = NULL;
  1110. badtx++;
  1111. i = badtx % LMC_TXDESCS;
  1112. }
  1113. if (sc->lmc_next_tx - badtx > LMC_TXDESCS)
  1114. {
  1115. printk ("%s: out of sync pointer\n", dev->name);
  1116. badtx += LMC_TXDESCS;
  1117. }
  1118. LMC_EVENT_LOG(LMC_EVENT_TBUSY0, n_compl, 0);
  1119. sc->lmc_txfull = 0;
  1120. netif_wake_queue(dev);
  1121. sc->extra_stats.tx_tbusy0++;
  1122. #ifdef DEBUG
  1123. sc->extra_stats.dirtyTx = badtx;
  1124. sc->extra_stats.lmc_next_tx = sc->lmc_next_tx;
  1125. sc->extra_stats.lmc_txfull = sc->lmc_txfull;
  1126. #endif
  1127. sc->lmc_taint_tx = badtx;
  1128. /*
  1129. * Why was there a break here???
  1130. */
  1131. } /* end handle transmit interrupt */
  1132. if (csr & TULIP_STS_SYSERROR) {
  1133. u32 error;
  1134. printk (KERN_WARNING "%s: system bus error csr: %#8.8x\n", dev->name, csr);
  1135. error = csr>>23 & 0x7;
  1136. switch(error){
  1137. case 0x000:
  1138. printk(KERN_WARNING "%s: Parity Fault (bad)\n", dev->name);
  1139. break;
  1140. case 0x001:
  1141. printk(KERN_WARNING "%s: Master Abort (naughty)\n", dev->name);
  1142. break;
  1143. case 0x010:
  1144. printk(KERN_WARNING "%s: Target Abort (not so naughty)\n", dev->name);
  1145. break;
  1146. default:
  1147. printk(KERN_WARNING "%s: This bus error code was supposed to be reserved!\n", dev->name);
  1148. }
  1149. lmc_dec_reset (sc);
  1150. lmc_reset (sc);
  1151. LMC_EVENT_LOG(LMC_EVENT_RESET1, LMC_CSR_READ (sc, csr_status), 0);
  1152. LMC_EVENT_LOG(LMC_EVENT_RESET2,
  1153. lmc_mii_readreg (sc, 0, 16),
  1154. lmc_mii_readreg (sc, 0, 17));
  1155. }
  1156. if(max_work-- <= 0)
  1157. break;
  1158. /*
  1159. * Get current csr status to make sure
  1160. * we've cleared all interrupts
  1161. */
  1162. csr = LMC_CSR_READ (sc, csr_status);
  1163. } /* end interrupt loop */
  1164. LMC_EVENT_LOG(LMC_EVENT_INT, firstcsr, csr);
  1165. lmc_int_fail_out:
  1166. spin_unlock(&sc->lmc_lock);
  1167. lmc_trace(dev, "lmc_interrupt out");
  1168. return IRQ_RETVAL(handled);
  1169. }
  1170. static netdev_tx_t lmc_start_xmit(struct sk_buff *skb,
  1171. struct net_device *dev)
  1172. {
  1173. lmc_softc_t *sc = dev_to_sc(dev);
  1174. u32 flag;
  1175. int entry;
  1176. unsigned long flags;
  1177. lmc_trace(dev, "lmc_start_xmit in");
  1178. spin_lock_irqsave(&sc->lmc_lock, flags);
  1179. /* normal path, tbusy known to be zero */
  1180. entry = sc->lmc_next_tx % LMC_TXDESCS;
  1181. sc->lmc_txq[entry] = skb;
  1182. sc->lmc_txring[entry].buffer1 = virt_to_bus (skb->data);
  1183. LMC_CONSOLE_LOG("xmit", skb->data, skb->len);
  1184. #ifndef GCOM
  1185. /* If the queue is less than half full, don't interrupt */
  1186. if (sc->lmc_next_tx - sc->lmc_taint_tx < LMC_TXDESCS / 2)
  1187. {
  1188. /* Do not interrupt on completion of this packet */
  1189. flag = 0x60000000;
  1190. netif_wake_queue(dev);
  1191. }
  1192. else if (sc->lmc_next_tx - sc->lmc_taint_tx == LMC_TXDESCS / 2)
  1193. {
  1194. /* This generates an interrupt on completion of this packet */
  1195. flag = 0xe0000000;
  1196. netif_wake_queue(dev);
  1197. }
  1198. else if (sc->lmc_next_tx - sc->lmc_taint_tx < LMC_TXDESCS - 1)
  1199. {
  1200. /* Do not interrupt on completion of this packet */
  1201. flag = 0x60000000;
  1202. netif_wake_queue(dev);
  1203. }
  1204. else
  1205. {
  1206. /* This generates an interrupt on completion of this packet */
  1207. flag = 0xe0000000;
  1208. sc->lmc_txfull = 1;
  1209. netif_stop_queue(dev);
  1210. }
  1211. #else
  1212. flag = LMC_TDES_INTERRUPT_ON_COMPLETION;
  1213. if (sc->lmc_next_tx - sc->lmc_taint_tx >= LMC_TXDESCS - 1)
  1214. { /* ring full, go busy */
  1215. sc->lmc_txfull = 1;
  1216. netif_stop_queue(dev);
  1217. sc->extra_stats.tx_tbusy1++;
  1218. LMC_EVENT_LOG(LMC_EVENT_TBUSY1, entry, 0);
  1219. }
  1220. #endif
  1221. if (entry == LMC_TXDESCS - 1) /* last descriptor in ring */
  1222. flag |= LMC_TDES_END_OF_RING; /* flag as such for Tulip */
  1223. /* don't pad small packets either */
  1224. flag = sc->lmc_txring[entry].length = (skb->len) | flag |
  1225. sc->TxDescriptControlInit;
  1226. /* set the transmit timeout flag to be checked in
  1227. * the watchdog timer handler. -baz
  1228. */
  1229. sc->extra_stats.tx_NoCompleteCnt++;
  1230. sc->lmc_next_tx++;
  1231. /* give ownership to the chip */
  1232. LMC_EVENT_LOG(LMC_EVENT_XMT, flag, entry);
  1233. sc->lmc_txring[entry].status = 0x80000000;
  1234. /* send now! */
  1235. LMC_CSR_WRITE (sc, csr_txpoll, 0);
  1236. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  1237. lmc_trace(dev, "lmc_start_xmit_out");
  1238. return NETDEV_TX_OK;
  1239. }
  1240. static int lmc_rx(struct net_device *dev)
  1241. {
  1242. lmc_softc_t *sc = dev_to_sc(dev);
  1243. int i;
  1244. int rx_work_limit = LMC_RXDESCS;
  1245. unsigned int next_rx;
  1246. int rxIntLoopCnt; /* debug -baz */
  1247. int localLengthErrCnt = 0;
  1248. long stat;
  1249. struct sk_buff *skb, *nsb;
  1250. u16 len;
  1251. lmc_trace(dev, "lmc_rx in");
  1252. lmc_led_on(sc, LMC_DS3_LED3);
  1253. rxIntLoopCnt = 0; /* debug -baz */
  1254. i = sc->lmc_next_rx % LMC_RXDESCS;
  1255. next_rx = sc->lmc_next_rx;
  1256. while (((stat = sc->lmc_rxring[i].status) & LMC_RDES_OWN_BIT) != DESC_OWNED_BY_DC21X4)
  1257. {
  1258. rxIntLoopCnt++; /* debug -baz */
  1259. len = ((stat & LMC_RDES_FRAME_LENGTH) >> RDES_FRAME_LENGTH_BIT_NUMBER);
  1260. if ((stat & 0x0300) != 0x0300) { /* Check first segment and last segment */
  1261. if ((stat & 0x0000ffff) != 0x7fff) {
  1262. /* Oversized frame */
  1263. sc->lmc_device->stats.rx_length_errors++;
  1264. goto skip_packet;
  1265. }
  1266. }
  1267. if (stat & 0x00000008) { /* Catch a dribbling bit error */
  1268. sc->lmc_device->stats.rx_errors++;
  1269. sc->lmc_device->stats.rx_frame_errors++;
  1270. goto skip_packet;
  1271. }
  1272. if (stat & 0x00000004) { /* Catch a CRC error by the Xilinx */
  1273. sc->lmc_device->stats.rx_errors++;
  1274. sc->lmc_device->stats.rx_crc_errors++;
  1275. goto skip_packet;
  1276. }
  1277. if (len > LMC_PKT_BUF_SZ) {
  1278. sc->lmc_device->stats.rx_length_errors++;
  1279. localLengthErrCnt++;
  1280. goto skip_packet;
  1281. }
  1282. if (len < sc->lmc_crcSize + 2) {
  1283. sc->lmc_device->stats.rx_length_errors++;
  1284. sc->extra_stats.rx_SmallPktCnt++;
  1285. localLengthErrCnt++;
  1286. goto skip_packet;
  1287. }
  1288. if(stat & 0x00004000){
  1289. printk(KERN_WARNING "%s: Receiver descriptor error, receiver out of sync?\n", dev->name);
  1290. }
  1291. len -= sc->lmc_crcSize;
  1292. skb = sc->lmc_rxq[i];
  1293. /*
  1294. * We ran out of memory at some point
  1295. * just allocate an skb buff and continue.
  1296. */
  1297. if (!skb) {
  1298. nsb = dev_alloc_skb (LMC_PKT_BUF_SZ + 2);
  1299. if (nsb) {
  1300. sc->lmc_rxq[i] = nsb;
  1301. nsb->dev = dev;
  1302. sc->lmc_rxring[i].buffer1 = virt_to_bus(skb_tail_pointer(nsb));
  1303. }
  1304. sc->failed_recv_alloc = 1;
  1305. goto skip_packet;
  1306. }
  1307. sc->lmc_device->stats.rx_packets++;
  1308. sc->lmc_device->stats.rx_bytes += len;
  1309. LMC_CONSOLE_LOG("recv", skb->data, len);
  1310. /*
  1311. * I'm not sure of the sanity of this
  1312. * Packets could be arriving at a constant
  1313. * 44.210mbits/sec and we're going to copy
  1314. * them into a new buffer??
  1315. */
  1316. if(len > (LMC_MTU - (LMC_MTU>>2))){ /* len > LMC_MTU * 0.75 */
  1317. /*
  1318. * If it's a large packet don't copy it just hand it up
  1319. */
  1320. give_it_anyways:
  1321. sc->lmc_rxq[i] = NULL;
  1322. sc->lmc_rxring[i].buffer1 = 0x0;
  1323. skb_put (skb, len);
  1324. skb->protocol = lmc_proto_type(sc, skb);
  1325. skb_reset_mac_header(skb);
  1326. /* skb_reset_network_header(skb); */
  1327. skb->dev = dev;
  1328. lmc_proto_netif(sc, skb);
  1329. /*
  1330. * This skb will be destroyed by the upper layers, make a new one
  1331. */
  1332. nsb = dev_alloc_skb (LMC_PKT_BUF_SZ + 2);
  1333. if (nsb) {
  1334. sc->lmc_rxq[i] = nsb;
  1335. nsb->dev = dev;
  1336. sc->lmc_rxring[i].buffer1 = virt_to_bus(skb_tail_pointer(nsb));
  1337. /* Transferred to 21140 below */
  1338. }
  1339. else {
  1340. /*
  1341. * We've run out of memory, stop trying to allocate
  1342. * memory and exit the interrupt handler
  1343. *
  1344. * The chip may run out of receivers and stop
  1345. * in which care we'll try to allocate the buffer
  1346. * again. (once a second)
  1347. */
  1348. sc->extra_stats.rx_BuffAllocErr++;
  1349. LMC_EVENT_LOG(LMC_EVENT_RCVINT, stat, len);
  1350. sc->failed_recv_alloc = 1;
  1351. goto skip_out_of_mem;
  1352. }
  1353. }
  1354. else {
  1355. nsb = dev_alloc_skb(len);
  1356. if(!nsb) {
  1357. goto give_it_anyways;
  1358. }
  1359. skb_copy_from_linear_data(skb, skb_put(nsb, len), len);
  1360. nsb->protocol = lmc_proto_type(sc, nsb);
  1361. skb_reset_mac_header(nsb);
  1362. /* skb_reset_network_header(nsb); */
  1363. nsb->dev = dev;
  1364. lmc_proto_netif(sc, nsb);
  1365. }
  1366. skip_packet:
  1367. LMC_EVENT_LOG(LMC_EVENT_RCVINT, stat, len);
  1368. sc->lmc_rxring[i].status = DESC_OWNED_BY_DC21X4;
  1369. sc->lmc_next_rx++;
  1370. i = sc->lmc_next_rx % LMC_RXDESCS;
  1371. rx_work_limit--;
  1372. if (rx_work_limit < 0)
  1373. break;
  1374. }
  1375. /* detect condition for LMC1000 where DSU cable attaches and fills
  1376. * descriptors with bogus packets
  1377. *
  1378. if (localLengthErrCnt > LMC_RXDESCS - 3) {
  1379. sc->extra_stats.rx_BadPktSurgeCnt++;
  1380. LMC_EVENT_LOG(LMC_EVENT_BADPKTSURGE, localLengthErrCnt,
  1381. sc->extra_stats.rx_BadPktSurgeCnt);
  1382. } */
  1383. /* save max count of receive descriptors serviced */
  1384. if (rxIntLoopCnt > sc->extra_stats.rxIntLoopCnt)
  1385. sc->extra_stats.rxIntLoopCnt = rxIntLoopCnt; /* debug -baz */
  1386. #ifdef DEBUG
  1387. if (rxIntLoopCnt == 0)
  1388. {
  1389. for (i = 0; i < LMC_RXDESCS; i++)
  1390. {
  1391. if ((sc->lmc_rxring[i].status & LMC_RDES_OWN_BIT)
  1392. != DESC_OWNED_BY_DC21X4)
  1393. {
  1394. rxIntLoopCnt++;
  1395. }
  1396. }
  1397. LMC_EVENT_LOG(LMC_EVENT_RCVEND, rxIntLoopCnt, 0);
  1398. }
  1399. #endif
  1400. lmc_led_off(sc, LMC_DS3_LED3);
  1401. skip_out_of_mem:
  1402. lmc_trace(dev, "lmc_rx out");
  1403. return 0;
  1404. }
  1405. static struct net_device_stats *lmc_get_stats(struct net_device *dev)
  1406. {
  1407. lmc_softc_t *sc = dev_to_sc(dev);
  1408. unsigned long flags;
  1409. lmc_trace(dev, "lmc_get_stats in");
  1410. spin_lock_irqsave(&sc->lmc_lock, flags);
  1411. sc->lmc_device->stats.rx_missed_errors += LMC_CSR_READ(sc, csr_missed_frames) & 0xffff;
  1412. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  1413. lmc_trace(dev, "lmc_get_stats out");
  1414. return &sc->lmc_device->stats;
  1415. }
  1416. static struct pci_driver lmc_driver = {
  1417. .name = "lmc",
  1418. .id_table = lmc_pci_tbl,
  1419. .probe = lmc_init_one,
  1420. .remove = __devexit_p(lmc_remove_one),
  1421. };
  1422. static int __init init_lmc(void)
  1423. {
  1424. return pci_register_driver(&lmc_driver);
  1425. }
  1426. static void __exit exit_lmc(void)
  1427. {
  1428. pci_unregister_driver(&lmc_driver);
  1429. }
  1430. module_init(init_lmc);
  1431. module_exit(exit_lmc);
  1432. unsigned lmc_mii_readreg (lmc_softc_t * const sc, unsigned devaddr, unsigned regno) /*fold00*/
  1433. {
  1434. int i;
  1435. int command = (0xf6 << 10) | (devaddr << 5) | regno;
  1436. int retval = 0;
  1437. lmc_trace(sc->lmc_device, "lmc_mii_readreg in");
  1438. LMC_MII_SYNC (sc);
  1439. lmc_trace(sc->lmc_device, "lmc_mii_readreg: done sync");
  1440. for (i = 15; i >= 0; i--)
  1441. {
  1442. int dataval = (command & (1 << i)) ? 0x20000 : 0;
  1443. LMC_CSR_WRITE (sc, csr_9, dataval);
  1444. lmc_delay ();
  1445. /* __SLOW_DOWN_IO; */
  1446. LMC_CSR_WRITE (sc, csr_9, dataval | 0x10000);
  1447. lmc_delay ();
  1448. /* __SLOW_DOWN_IO; */
  1449. }
  1450. lmc_trace(sc->lmc_device, "lmc_mii_readreg: done1");
  1451. for (i = 19; i > 0; i--)
  1452. {
  1453. LMC_CSR_WRITE (sc, csr_9, 0x40000);
  1454. lmc_delay ();
  1455. /* __SLOW_DOWN_IO; */
  1456. retval = (retval << 1) | ((LMC_CSR_READ (sc, csr_9) & 0x80000) ? 1 : 0);
  1457. LMC_CSR_WRITE (sc, csr_9, 0x40000 | 0x10000);
  1458. lmc_delay ();
  1459. /* __SLOW_DOWN_IO; */
  1460. }
  1461. lmc_trace(sc->lmc_device, "lmc_mii_readreg out");
  1462. return (retval >> 1) & 0xffff;
  1463. }
  1464. void lmc_mii_writereg (lmc_softc_t * const sc, unsigned devaddr, unsigned regno, unsigned data) /*fold00*/
  1465. {
  1466. int i = 32;
  1467. int command = (0x5002 << 16) | (devaddr << 23) | (regno << 18) | data;
  1468. lmc_trace(sc->lmc_device, "lmc_mii_writereg in");
  1469. LMC_MII_SYNC (sc);
  1470. i = 31;
  1471. while (i >= 0)
  1472. {
  1473. int datav;
  1474. if (command & (1 << i))
  1475. datav = 0x20000;
  1476. else
  1477. datav = 0x00000;
  1478. LMC_CSR_WRITE (sc, csr_9, datav);
  1479. lmc_delay ();
  1480. /* __SLOW_DOWN_IO; */
  1481. LMC_CSR_WRITE (sc, csr_9, (datav | 0x10000));
  1482. lmc_delay ();
  1483. /* __SLOW_DOWN_IO; */
  1484. i--;
  1485. }
  1486. i = 2;
  1487. while (i > 0)
  1488. {
  1489. LMC_CSR_WRITE (sc, csr_9, 0x40000);
  1490. lmc_delay ();
  1491. /* __SLOW_DOWN_IO; */
  1492. LMC_CSR_WRITE (sc, csr_9, 0x50000);
  1493. lmc_delay ();
  1494. /* __SLOW_DOWN_IO; */
  1495. i--;
  1496. }
  1497. lmc_trace(sc->lmc_device, "lmc_mii_writereg out");
  1498. }
  1499. static void lmc_softreset (lmc_softc_t * const sc) /*fold00*/
  1500. {
  1501. int i;
  1502. lmc_trace(sc->lmc_device, "lmc_softreset in");
  1503. /* Initialize the receive rings and buffers. */
  1504. sc->lmc_txfull = 0;
  1505. sc->lmc_next_rx = 0;
  1506. sc->lmc_next_tx = 0;
  1507. sc->lmc_taint_rx = 0;
  1508. sc->lmc_taint_tx = 0;
  1509. /*
  1510. * Setup each one of the receiver buffers
  1511. * allocate an skbuff for each one, setup the descriptor table
  1512. * and point each buffer at the next one
  1513. */
  1514. for (i = 0; i < LMC_RXDESCS; i++)
  1515. {
  1516. struct sk_buff *skb;
  1517. if (sc->lmc_rxq[i] == NULL)
  1518. {
  1519. skb = dev_alloc_skb (LMC_PKT_BUF_SZ + 2);
  1520. if(skb == NULL){
  1521. printk(KERN_WARNING "%s: Failed to allocate receiver ring, will try again\n", sc->name);
  1522. sc->failed_ring = 1;
  1523. break;
  1524. }
  1525. else{
  1526. sc->lmc_rxq[i] = skb;
  1527. }
  1528. }
  1529. else
  1530. {
  1531. skb = sc->lmc_rxq[i];
  1532. }
  1533. skb->dev = sc->lmc_device;
  1534. /* owned by 21140 */
  1535. sc->lmc_rxring[i].status = 0x80000000;
  1536. /* used to be PKT_BUF_SZ now uses skb since we lose some to head room */
  1537. sc->lmc_rxring[i].length = skb_tailroom(skb);
  1538. /* use to be tail which is dumb since you're thinking why write
  1539. * to the end of the packj,et but since there's nothing there tail == data
  1540. */
  1541. sc->lmc_rxring[i].buffer1 = virt_to_bus (skb->data);
  1542. /* This is fair since the structure is static and we have the next address */
  1543. sc->lmc_rxring[i].buffer2 = virt_to_bus (&sc->lmc_rxring[i + 1]);
  1544. }
  1545. /*
  1546. * Sets end of ring
  1547. */
  1548. if (i != 0) {
  1549. sc->lmc_rxring[i - 1].length |= 0x02000000; /* Set end of buffers flag */
  1550. sc->lmc_rxring[i - 1].buffer2 = virt_to_bus(&sc->lmc_rxring[0]); /* Point back to the start */
  1551. }
  1552. LMC_CSR_WRITE (sc, csr_rxlist, virt_to_bus (sc->lmc_rxring)); /* write base address */
  1553. /* Initialize the transmit rings and buffers */
  1554. for (i = 0; i < LMC_TXDESCS; i++)
  1555. {
  1556. if (sc->lmc_txq[i] != NULL){ /* have buffer */
  1557. dev_kfree_skb(sc->lmc_txq[i]); /* free it */
  1558. sc->lmc_device->stats.tx_dropped++; /* We just dropped a packet */
  1559. }
  1560. sc->lmc_txq[i] = NULL;
  1561. sc->lmc_txring[i].status = 0x00000000;
  1562. sc->lmc_txring[i].buffer2 = virt_to_bus (&sc->lmc_txring[i + 1]);
  1563. }
  1564. sc->lmc_txring[i - 1].buffer2 = virt_to_bus (&sc->lmc_txring[0]);
  1565. LMC_CSR_WRITE (sc, csr_txlist, virt_to_bus (sc->lmc_txring));
  1566. lmc_trace(sc->lmc_device, "lmc_softreset out");
  1567. }
  1568. void lmc_gpio_mkinput(lmc_softc_t * const sc, u32 bits) /*fold00*/
  1569. {
  1570. lmc_trace(sc->lmc_device, "lmc_gpio_mkinput in");
  1571. sc->lmc_gpio_io &= ~bits;
  1572. LMC_CSR_WRITE(sc, csr_gp, TULIP_GP_PINSET | (sc->lmc_gpio_io));
  1573. lmc_trace(sc->lmc_device, "lmc_gpio_mkinput out");
  1574. }
  1575. void lmc_gpio_mkoutput(lmc_softc_t * const sc, u32 bits) /*fold00*/
  1576. {
  1577. lmc_trace(sc->lmc_device, "lmc_gpio_mkoutput in");
  1578. sc->lmc_gpio_io |= bits;
  1579. LMC_CSR_WRITE(sc, csr_gp, TULIP_GP_PINSET | (sc->lmc_gpio_io));
  1580. lmc_trace(sc->lmc_device, "lmc_gpio_mkoutput out");
  1581. }
  1582. void lmc_led_on(lmc_softc_t * const sc, u32 led) /*fold00*/
  1583. {
  1584. lmc_trace(sc->lmc_device, "lmc_led_on in");
  1585. if((~sc->lmc_miireg16) & led){ /* Already on! */
  1586. lmc_trace(sc->lmc_device, "lmc_led_on aon out");
  1587. return;
  1588. }
  1589. sc->lmc_miireg16 &= ~led;
  1590. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  1591. lmc_trace(sc->lmc_device, "lmc_led_on out");
  1592. }
  1593. void lmc_led_off(lmc_softc_t * const sc, u32 led) /*fold00*/
  1594. {
  1595. lmc_trace(sc->lmc_device, "lmc_led_off in");
  1596. if(sc->lmc_miireg16 & led){ /* Already set don't do anything */
  1597. lmc_trace(sc->lmc_device, "lmc_led_off aoff out");
  1598. return;
  1599. }
  1600. sc->lmc_miireg16 |= led;
  1601. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  1602. lmc_trace(sc->lmc_device, "lmc_led_off out");
  1603. }
  1604. static void lmc_reset(lmc_softc_t * const sc) /*fold00*/
  1605. {
  1606. lmc_trace(sc->lmc_device, "lmc_reset in");
  1607. sc->lmc_miireg16 |= LMC_MII16_FIFO_RESET;
  1608. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  1609. sc->lmc_miireg16 &= ~LMC_MII16_FIFO_RESET;
  1610. lmc_mii_writereg(sc, 0, 16, sc->lmc_miireg16);
  1611. /*
  1612. * make some of the GPIO pins be outputs
  1613. */
  1614. lmc_gpio_mkoutput(sc, LMC_GEP_RESET);
  1615. /*
  1616. * RESET low to force state reset. This also forces
  1617. * the transmitter clock to be internal, but we expect to reset
  1618. * that later anyway.
  1619. */
  1620. sc->lmc_gpio &= ~(LMC_GEP_RESET);
  1621. LMC_CSR_WRITE(sc, csr_gp, sc->lmc_gpio);
  1622. /*
  1623. * hold for more than 10 microseconds
  1624. */
  1625. udelay(50);
  1626. /*
  1627. * stop driving Xilinx-related signals
  1628. */
  1629. lmc_gpio_mkinput(sc, LMC_GEP_RESET);
  1630. /*
  1631. * Call media specific init routine
  1632. */
  1633. sc->lmc_media->init(sc);
  1634. sc->extra_stats.resetCount++;
  1635. lmc_trace(sc->lmc_device, "lmc_reset out");
  1636. }
  1637. static void lmc_dec_reset(lmc_softc_t * const sc) /*fold00*/
  1638. {
  1639. u32 val;
  1640. lmc_trace(sc->lmc_device, "lmc_dec_reset in");
  1641. /*
  1642. * disable all interrupts
  1643. */
  1644. sc->lmc_intrmask = 0;
  1645. LMC_CSR_WRITE(sc, csr_intr, sc->lmc_intrmask);
  1646. /*
  1647. * Reset the chip with a software reset command.
  1648. * Wait 10 microseconds (actually 50 PCI cycles but at
  1649. * 33MHz that comes to two microseconds but wait a
  1650. * bit longer anyways)
  1651. */
  1652. LMC_CSR_WRITE(sc, csr_busmode, TULIP_BUSMODE_SWRESET);
  1653. udelay(25);
  1654. #ifdef __sparc__
  1655. sc->lmc_busmode = LMC_CSR_READ(sc, csr_busmode);
  1656. sc->lmc_busmode = 0x00100000;
  1657. sc->lmc_busmode &= ~TULIP_BUSMODE_SWRESET;
  1658. LMC_CSR_WRITE(sc, csr_busmode, sc->lmc_busmode);
  1659. #endif
  1660. sc->lmc_cmdmode = LMC_CSR_READ(sc, csr_command);
  1661. /*
  1662. * We want:
  1663. * no ethernet address in frames we write
  1664. * disable padding (txdesc, padding disable)
  1665. * ignore runt frames (rdes0 bit 15)
  1666. * no receiver watchdog or transmitter jabber timer
  1667. * (csr15 bit 0,14 == 1)
  1668. * if using 16-bit CRC, turn off CRC (trans desc, crc disable)
  1669. */
  1670. sc->lmc_cmdmode |= ( TULIP_CMD_PROMISCUOUS
  1671. | TULIP_CMD_FULLDUPLEX
  1672. | TULIP_CMD_PASSBADPKT
  1673. | TULIP_CMD_NOHEARTBEAT
  1674. | TULIP_CMD_PORTSELECT
  1675. | TULIP_CMD_RECEIVEALL
  1676. | TULIP_CMD_MUSTBEONE
  1677. );
  1678. sc->lmc_cmdmode &= ~( TULIP_CMD_OPERMODE
  1679. | TULIP_CMD_THRESHOLDCTL
  1680. | TULIP_CMD_STOREFWD
  1681. | TULIP_CMD_TXTHRSHLDCTL
  1682. );
  1683. LMC_CSR_WRITE(sc, csr_command, sc->lmc_cmdmode);
  1684. /*
  1685. * disable receiver watchdog and transmit jabber
  1686. */
  1687. val = LMC_CSR_READ(sc, csr_sia_general);
  1688. val |= (TULIP_WATCHDOG_TXDISABLE | TULIP_WATCHDOG_RXDISABLE);
  1689. LMC_CSR_WRITE(sc, csr_sia_general, val);
  1690. lmc_trace(sc->lmc_device, "lmc_dec_reset out");
  1691. }
  1692. static void lmc_initcsrs(lmc_softc_t * const sc, lmc_csrptr_t csr_base, /*fold00*/
  1693. size_t csr_size)
  1694. {
  1695. lmc_trace(sc->lmc_device, "lmc_initcsrs in");
  1696. sc->lmc_csrs.csr_busmode = csr_base + 0 * csr_size;
  1697. sc->lmc_csrs.csr_txpoll = csr_base + 1 * csr_size;
  1698. sc->lmc_csrs.csr_rxpoll = csr_base + 2 * csr_size;
  1699. sc->lmc_csrs.csr_rxlist = csr_base + 3 * csr_size;
  1700. sc->lmc_csrs.csr_txlist = csr_base + 4 * csr_size;
  1701. sc->lmc_csrs.csr_status = csr_base + 5 * csr_size;
  1702. sc->lmc_csrs.csr_command = csr_base + 6 * csr_size;
  1703. sc->lmc_csrs.csr_intr = csr_base + 7 * csr_size;
  1704. sc->lmc_csrs.csr_missed_frames = csr_base + 8 * csr_size;
  1705. sc->lmc_csrs.csr_9 = csr_base + 9 * csr_size;
  1706. sc->lmc_csrs.csr_10 = csr_base + 10 * csr_size;
  1707. sc->lmc_csrs.csr_11 = csr_base + 11 * csr_size;
  1708. sc->lmc_csrs.csr_12 = csr_base + 12 * csr_size;
  1709. sc->lmc_csrs.csr_13 = csr_base + 13 * csr_size;
  1710. sc->lmc_csrs.csr_14 = csr_base + 14 * csr_size;
  1711. sc->lmc_csrs.csr_15 = csr_base + 15 * csr_size;
  1712. lmc_trace(sc->lmc_device, "lmc_initcsrs out");
  1713. }
  1714. static void lmc_driver_timeout(struct net_device *dev)
  1715. {
  1716. lmc_softc_t *sc = dev_to_sc(dev);
  1717. u32 csr6;
  1718. unsigned long flags;
  1719. lmc_trace(dev, "lmc_driver_timeout in");
  1720. spin_lock_irqsave(&sc->lmc_lock, flags);
  1721. printk("%s: Xmitter busy|\n", dev->name);
  1722. sc->extra_stats.tx_tbusy_calls++;
  1723. if (jiffies - dev_trans_start(dev) < TX_TIMEOUT)
  1724. goto bug_out;
  1725. /*
  1726. * Chip seems to have locked up
  1727. * Reset it
  1728. * This whips out all our decriptor
  1729. * table and starts from scartch
  1730. */
  1731. LMC_EVENT_LOG(LMC_EVENT_XMTPRCTMO,
  1732. LMC_CSR_READ (sc, csr_status),
  1733. sc->extra_stats.tx_ProcTimeout);
  1734. lmc_running_reset (dev);
  1735. LMC_EVENT_LOG(LMC_EVENT_RESET1, LMC_CSR_READ (sc, csr_status), 0);
  1736. LMC_EVENT_LOG(LMC_EVENT_RESET2,
  1737. lmc_mii_readreg (sc, 0, 16),
  1738. lmc_mii_readreg (sc, 0, 17));
  1739. /* restart the tx processes */
  1740. csr6 = LMC_CSR_READ (sc, csr_command);
  1741. LMC_CSR_WRITE (sc, csr_command, csr6 | 0x0002);
  1742. LMC_CSR_WRITE (sc, csr_command, csr6 | 0x2002);
  1743. /* immediate transmit */
  1744. LMC_CSR_WRITE (sc, csr_txpoll, 0);
  1745. sc->lmc_device->stats.tx_errors++;
  1746. sc->extra_stats.tx_ProcTimeout++; /* -baz */
  1747. dev->trans_start = jiffies; /* prevent tx timeout */
  1748. bug_out:
  1749. spin_unlock_irqrestore(&sc->lmc_lock, flags);
  1750. lmc_trace(dev, "lmc_driver_timout out");
  1751. }