ibmtr.c 62 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976
  1. /* ibmtr.c: A shared-memory IBM Token Ring 16/4 driver for linux
  2. *
  3. * Written 1993 by Mark Swanson and Peter De Schrijver.
  4. * This software may be used and distributed according to the terms
  5. * of the GNU General Public License, incorporated herein by reference.
  6. *
  7. * This device driver should work with Any IBM Token Ring Card that does
  8. * not use DMA.
  9. *
  10. * I used Donald Becker's (becker@scyld.com) device driver work
  11. * as a base for most of my initial work.
  12. *
  13. * Changes by Peter De Schrijver
  14. * (Peter.Deschrijver@linux.cc.kuleuven.ac.be) :
  15. *
  16. * + changed name to ibmtr.c in anticipation of other tr boards.
  17. * + changed reset code and adapter open code.
  18. * + added SAP open code.
  19. * + a first attempt to write interrupt, transmit and receive routines.
  20. *
  21. * Changes by David W. Morris (dwm@shell.portal.com) :
  22. * 941003 dwm: - Restructure tok_probe for multiple adapters, devices.
  23. * + Add comments, misc reorg for clarity.
  24. * + Flatten interrupt handler levels.
  25. *
  26. * Changes by Farzad Farid (farzy@zen.via.ecp.fr)
  27. * and Pascal Andre (andre@chimay.via.ecp.fr) (March 9 1995) :
  28. * + multi ring support clean up.
  29. * + RFC1042 compliance enhanced.
  30. *
  31. * Changes by Pascal Andre (andre@chimay.via.ecp.fr) (September 7 1995) :
  32. * + bug correction in tr_tx
  33. * + removed redundant information display
  34. * + some code reworking
  35. *
  36. * Changes by Michel Lespinasse (walken@via.ecp.fr),
  37. * Yann Doussot (doussot@via.ecp.fr) and Pascal Andre (andre@via.ecp.fr)
  38. * (February 18, 1996) :
  39. * + modified shared memory and mmio access port the driver to
  40. * alpha platform (structure access -> readb/writeb)
  41. *
  42. * Changes by Steve Kipisz (bungy@ibm.net or kipisz@vnet.ibm.com)
  43. * (January 18 1996):
  44. * + swapped WWOR and WWCR in ibmtr.h
  45. * + moved some init code from tok_probe into trdev_init. The
  46. * PCMCIA code can call trdev_init to complete initializing
  47. * the driver.
  48. * + added -DPCMCIA to support PCMCIA
  49. * + detecting PCMCIA Card Removal in interrupt handler. If
  50. * ISRP is FF, then a PCMCIA card has been removed
  51. * 10/2000 Burt needed a new method to avoid crashing the OS
  52. *
  53. * Changes by Paul Norton (pnorton@cts.com) :
  54. * + restructured the READ.LOG logic to prevent the transmit SRB
  55. * from being rudely overwritten before the transmit cycle is
  56. * complete. (August 15 1996)
  57. * + completed multiple adapter support. (November 20 1996)
  58. * + implemented csum_partial_copy in tr_rx and increased receive
  59. * buffer size and count. Minor fixes. (March 15, 1997)
  60. *
  61. * Changes by Christopher Turcksin <wabbit@rtfc.demon.co.uk>
  62. * + Now compiles ok as a module again.
  63. *
  64. * Changes by Paul Norton (pnorton@ieee.org) :
  65. * + moved the header manipulation code in tr_tx and tr_rx to
  66. * net/802/tr.c. (July 12 1997)
  67. * + add retry and timeout on open if cable disconnected. (May 5 1998)
  68. * + lifted 2000 byte mtu limit. now depends on shared-RAM size.
  69. * May 25 1998)
  70. * + can't allocate 2k recv buff at 8k shared-RAM. (20 October 1998)
  71. *
  72. * Changes by Joel Sloan (jjs@c-me.com) :
  73. * + disable verbose debug messages by default - to enable verbose
  74. * debugging, edit the IBMTR_DEBUG_MESSAGES define below
  75. *
  76. * Changes by Mike Phillips <phillim@amtrak.com> :
  77. * + Added extra #ifdef's to work with new PCMCIA Token Ring Code.
  78. * The PCMCIA code now just sets up the card so it can be recognized
  79. * by ibmtr_probe. Also checks allocated memory vs. on-board memory
  80. * for correct figure to use.
  81. *
  82. * Changes by Tim Hockin (thockin@isunix.it.ilstu.edu) :
  83. * + added spinlocks for SMP sanity (10 March 1999)
  84. *
  85. * Changes by Jochen Friedrich to enable RFC1469 Option 2 multicasting
  86. * i.e. using functional address C0 00 00 04 00 00 to transmit and
  87. * receive multicast packets.
  88. *
  89. * Changes by Mike Sullivan (based on original sram patch by Dave Grothe
  90. * to support windowing into on adapter shared ram.
  91. * i.e. Use LANAID to setup a PnP configuration with 16K RAM. Paging
  92. * will shift this 16K window over the entire available shared RAM.
  93. *
  94. * Changes by Peter De Schrijver (p2@mind.be) :
  95. * + fixed a problem with PCMCIA card removal
  96. *
  97. * Change by Mike Sullivan et al.:
  98. * + added turbo card support. No need to use lanaid to configure
  99. * the adapter into isa compatiblity mode.
  100. *
  101. * Changes by Burt Silverman to allow the computer to behave nicely when
  102. * a cable is pulled or not in place, or a PCMCIA card is removed hot.
  103. */
  104. /* change the define of IBMTR_DEBUG_MESSAGES to a nonzero value
  105. in the event that chatty debug messages are desired - jjs 12/30/98 */
  106. #define IBMTR_DEBUG_MESSAGES 0
  107. #include <linux/module.h>
  108. #ifdef PCMCIA /* required for ibmtr_cs.c to build */
  109. #undef MODULE /* yes, really */
  110. #undef ENABLE_PAGING
  111. #else
  112. #define ENABLE_PAGING 1
  113. #endif
  114. #define FALSE 0
  115. #define TRUE (!FALSE)
  116. /* changes the output format of driver initialization */
  117. #define TR_VERBOSE 0
  118. /* some 95 OS send many non UI frame; this allow removing the warning */
  119. #define TR_FILTERNONUI 1
  120. #include <linux/ioport.h>
  121. #include <linux/netdevice.h>
  122. #include <linux/ip.h>
  123. #include <linux/trdevice.h>
  124. #include <linux/ibmtr.h>
  125. #include <net/checksum.h>
  126. #include <asm/io.h>
  127. #define DPRINTK(format, args...) printk("%s: " format, dev->name , ## args)
  128. #define DPRINTD(format, args...) DummyCall("%s: " format, dev->name , ## args)
  129. /* version and credits */
  130. #ifndef PCMCIA
  131. static char version[] __initdata =
  132. "\nibmtr.c: v1.3.57 8/ 7/94 Peter De Schrijver and Mark Swanson\n"
  133. " v2.1.125 10/20/98 Paul Norton <pnorton@ieee.org>\n"
  134. " v2.2.0 12/30/98 Joel Sloan <jjs@c-me.com>\n"
  135. " v2.2.1 02/08/00 Mike Sullivan <sullivam@us.ibm.com>\n"
  136. " v2.2.2 07/27/00 Burt Silverman <burts@us.ibm.com>\n"
  137. " v2.4.0 03/01/01 Mike Sullivan <sullivan@us.ibm.com>\n";
  138. #endif
  139. /* this allows displaying full adapter information */
  140. static char *channel_def[] __devinitdata = { "ISA", "MCA", "ISA P&P" };
  141. static char pcchannelid[] __devinitdata = {
  142. 0x05, 0x00, 0x04, 0x09,
  143. 0x04, 0x03, 0x04, 0x0f,
  144. 0x03, 0x06, 0x03, 0x01,
  145. 0x03, 0x01, 0x03, 0x00,
  146. 0x03, 0x09, 0x03, 0x09,
  147. 0x03, 0x00, 0x02, 0x00
  148. };
  149. static char mcchannelid[] __devinitdata = {
  150. 0x04, 0x0d, 0x04, 0x01,
  151. 0x05, 0x02, 0x05, 0x03,
  152. 0x03, 0x06, 0x03, 0x03,
  153. 0x05, 0x08, 0x03, 0x04,
  154. 0x03, 0x05, 0x03, 0x01,
  155. 0x03, 0x08, 0x02, 0x00
  156. };
  157. static char __devinit *adapter_def(char type)
  158. {
  159. switch (type) {
  160. case 0xF: return "PC Adapter | PC Adapter II | Adapter/A";
  161. case 0xE: return "16/4 Adapter | 16/4 Adapter/A (long)";
  162. case 0xD: return "16/4 Adapter/A (short) | 16/4 ISA-16 Adapter";
  163. case 0xC: return "Auto 16/4 Adapter";
  164. default: return "adapter (unknown type)";
  165. };
  166. };
  167. #define TRC_INIT 0x01 /* Trace initialization & PROBEs */
  168. #define TRC_INITV 0x02 /* verbose init trace points */
  169. static unsigned char ibmtr_debug_trace = 0;
  170. static int ibmtr_probe(struct net_device *dev);
  171. static int ibmtr_probe1(struct net_device *dev, int ioaddr);
  172. static unsigned char get_sram_size(struct tok_info *adapt_info);
  173. static int trdev_init(struct net_device *dev);
  174. static int tok_open(struct net_device *dev);
  175. static int tok_init_card(struct net_device *dev);
  176. static void tok_open_adapter(unsigned long dev_addr);
  177. static void open_sap(unsigned char type, struct net_device *dev);
  178. static void tok_set_multicast_list(struct net_device *dev);
  179. static int tok_send_packet(struct sk_buff *skb, struct net_device *dev);
  180. static int tok_close(struct net_device *dev);
  181. static irqreturn_t tok_interrupt(int irq, void *dev_id, struct pt_regs *regs);
  182. static void initial_tok_int(struct net_device *dev);
  183. static void tr_tx(struct net_device *dev);
  184. static void tr_rx(struct net_device *dev);
  185. static void ibmtr_reset_timer(struct timer_list*tmr,struct net_device *dev);
  186. static void tok_rerun(unsigned long dev_addr);
  187. static void ibmtr_readlog(struct net_device *dev);
  188. static struct net_device_stats *tok_get_stats(struct net_device *dev);
  189. static int ibmtr_change_mtu(struct net_device *dev, int mtu);
  190. static void find_turbo_adapters(int *iolist);
  191. static int ibmtr_portlist[IBMTR_MAX_ADAPTERS+1] __devinitdata = {
  192. 0xa20, 0xa24, 0, 0, 0
  193. };
  194. static int __devinitdata turbo_io[IBMTR_MAX_ADAPTERS] = {0};
  195. static int __devinitdata turbo_irq[IBMTR_MAX_ADAPTERS] = {0};
  196. static int __devinitdata turbo_searched = 0;
  197. #ifndef PCMCIA
  198. static __u32 ibmtr_mem_base __initdata = 0xd0000;
  199. #endif
  200. static void __devinit PrtChanID(char *pcid, short stride)
  201. {
  202. short i, j;
  203. for (i = 0, j = 0; i < 24; i++, j += stride)
  204. printk("%1x", ((int) pcid[j]) & 0x0f);
  205. printk("\n");
  206. }
  207. static void __devinit HWPrtChanID(void __iomem *pcid, short stride)
  208. {
  209. short i, j;
  210. for (i = 0, j = 0; i < 24; i++, j += stride)
  211. printk("%1x", ((int) readb(pcid + j)) & 0x0f);
  212. printk("\n");
  213. }
  214. /* We have to ioremap every checked address, because isa_readb is
  215. * going away.
  216. */
  217. static void __devinit find_turbo_adapters(int *iolist)
  218. {
  219. int ram_addr;
  220. int index=0;
  221. void __iomem *chanid;
  222. int found_turbo=0;
  223. unsigned char *tchanid, ctemp;
  224. int i, j;
  225. unsigned long jif;
  226. void __iomem *ram_mapped ;
  227. if (turbo_searched == 1) return;
  228. turbo_searched=1;
  229. for (ram_addr=0xC0000; ram_addr < 0xE0000; ram_addr+=0x2000) {
  230. __u32 intf_tbl=0;
  231. found_turbo=1;
  232. ram_mapped = ioremap((u32)ram_addr,0x1fff) ;
  233. if (ram_mapped==NULL)
  234. continue ;
  235. chanid=(CHANNEL_ID + ram_mapped);
  236. tchanid=pcchannelid;
  237. ctemp=readb(chanid) & 0x0f;
  238. if (ctemp != *tchanid) continue;
  239. for (i=2,j=1; i<=46; i=i+2,j++) {
  240. if ((readb(chanid+i) & 0x0f) != tchanid[j]){
  241. found_turbo=0;
  242. break;
  243. }
  244. }
  245. if (!found_turbo) continue;
  246. writeb(0x90, ram_mapped+0x1E01);
  247. for(i=2; i<0x0f; i++) {
  248. writeb(0x00, ram_mapped+0x1E01+i);
  249. }
  250. writeb(0x00, ram_mapped+0x1E01);
  251. for(jif=jiffies+TR_BUSY_INTERVAL; time_before_eq(jiffies,jif););
  252. intf_tbl=ntohs(readw(ram_mapped+ACA_OFFSET+ACA_RW+WRBR_EVEN));
  253. if (intf_tbl) {
  254. #if IBMTR_DEBUG_MESSAGES
  255. printk("ibmtr::find_turbo_adapters, Turbo found at "
  256. "ram_addr %x\n",ram_addr);
  257. printk("ibmtr::find_turbo_adapters, interface_table ");
  258. for(i=0; i<6; i++) {
  259. printk("%x:",readb(ram_addr+intf_tbl+i));
  260. }
  261. printk("\n");
  262. #endif
  263. turbo_io[index]=ntohs(readw(ram_mapped+intf_tbl+4));
  264. turbo_irq[index]=readb(ram_mapped+intf_tbl+3);
  265. outb(0, turbo_io[index] + ADAPTRESET);
  266. for(jif=jiffies+TR_RST_TIME;time_before_eq(jiffies,jif););
  267. outb(0, turbo_io[index] + ADAPTRESETREL);
  268. index++;
  269. continue;
  270. }
  271. #if IBMTR_DEBUG_MESSAGES
  272. printk("ibmtr::find_turbo_adapters, ibmtr card found at"
  273. " %x but not a Turbo model\n",ram_addr);
  274. #endif
  275. iounmap(ram_mapped) ;
  276. } /* for */
  277. for(i=0; i<IBMTR_MAX_ADAPTERS; i++) {
  278. if(!turbo_io[i]) break;
  279. for (j=0; j<IBMTR_MAX_ADAPTERS; j++) {
  280. if ( iolist[j] && iolist[j] != turbo_io[i]) continue;
  281. iolist[j]=turbo_io[i];
  282. break;
  283. }
  284. }
  285. }
  286. static void ibmtr_cleanup_card(struct net_device *dev)
  287. {
  288. if (dev->base_addr) {
  289. outb(0,dev->base_addr+ADAPTRESET);
  290. schedule_timeout_uninterruptible(TR_RST_TIME); /* wait 50ms */
  291. outb(0,dev->base_addr+ADAPTRESETREL);
  292. }
  293. #ifndef PCMCIA
  294. free_irq(dev->irq, dev);
  295. release_region(dev->base_addr, IBMTR_IO_EXTENT);
  296. {
  297. struct tok_info *ti = (struct tok_info *) dev->priv;
  298. iounmap(ti->mmio);
  299. iounmap(ti->sram_virt);
  300. }
  301. #endif
  302. }
  303. int ibmtr_probe_card(struct net_device *dev)
  304. {
  305. int err = ibmtr_probe(dev);
  306. if (!err) {
  307. err = register_netdev(dev);
  308. if (err)
  309. ibmtr_cleanup_card(dev);
  310. }
  311. return err;
  312. }
  313. /****************************************************************************
  314. * ibmtr_probe(): Routine specified in the network device structure
  315. * to probe for an IBM Token Ring Adapter. Routine outline:
  316. * I. Interrogate hardware to determine if an adapter exists
  317. * and what the speeds and feeds are
  318. * II. Setup data structures to control execution based upon
  319. * adapter characteristics.
  320. *
  321. * We expect ibmtr_probe to be called once for each device entry
  322. * which references it.
  323. ****************************************************************************/
  324. static int ibmtr_probe(struct net_device *dev)
  325. {
  326. int i;
  327. int base_addr = dev->base_addr;
  328. if (base_addr && base_addr <= 0x1ff) /* Don't probe at all. */
  329. return -ENXIO;
  330. if (base_addr > 0x1ff) { /* Check a single specified location. */
  331. if (!ibmtr_probe1(dev, base_addr)) return 0;
  332. return -ENODEV;
  333. }
  334. find_turbo_adapters(ibmtr_portlist);
  335. for (i = 0; ibmtr_portlist[i]; i++) {
  336. int ioaddr = ibmtr_portlist[i];
  337. if (!ibmtr_probe1(dev, ioaddr)) return 0;
  338. }
  339. return -ENODEV;
  340. }
  341. /*****************************************************************************/
  342. static int __devinit ibmtr_probe1(struct net_device *dev, int PIOaddr)
  343. {
  344. unsigned char segment, intr=0, irq=0, i, j, cardpresent=NOTOK, temp=0;
  345. void __iomem * t_mmio = NULL;
  346. struct tok_info *ti = dev->priv;
  347. void __iomem *cd_chanid;
  348. unsigned char *tchanid, ctemp;
  349. #ifndef PCMCIA
  350. unsigned char t_irq=0;
  351. unsigned long timeout;
  352. static int version_printed;
  353. #endif
  354. /* Query the adapter PIO base port which will return
  355. * indication of where MMIO was placed. We also have a
  356. * coded interrupt number.
  357. */
  358. segment = inb(PIOaddr);
  359. if (segment < 0x40 || segment > 0xe0) {
  360. /* Out of range values so we'll assume non-existent IO device
  361. * but this is not necessarily a problem, esp if a turbo
  362. * adapter is being used. */
  363. #if IBMTR_DEBUG_MESSAGES
  364. DPRINTK("ibmtr_probe1(): unhappy that inb(0x%X) == 0x%X, "
  365. "Hardware Problem?\n",PIOaddr,segment);
  366. #endif
  367. return -ENODEV;
  368. }
  369. /*
  370. * Compute the linear base address of the MMIO area
  371. * as LINUX doesn't care about segments
  372. */
  373. t_mmio = ioremap(((__u32) (segment & 0xfc) << 11) + 0x80000,2048);
  374. if (!t_mmio) {
  375. DPRINTK("Cannot remap mmiobase memory area") ;
  376. return -ENODEV ;
  377. }
  378. intr = segment & 0x03; /* low bits is coded interrupt # */
  379. if (ibmtr_debug_trace & TRC_INIT)
  380. DPRINTK("PIOaddr: %4hx seg/intr: %2x mmio base: %p intr: %d\n"
  381. , PIOaddr, (int) segment, t_mmio, (int) intr);
  382. /*
  383. * Now we will compare expected 'channelid' strings with
  384. * what we is there to learn of ISA/MCA or not TR card
  385. */
  386. #ifdef PCMCIA
  387. iounmap(t_mmio);
  388. t_mmio = ti->mmio; /*BMS to get virtual address */
  389. irq = ti->irq; /*BMS to display the irq! */
  390. #endif
  391. cd_chanid = (CHANNEL_ID + t_mmio); /* for efficiency */
  392. tchanid = pcchannelid;
  393. cardpresent = TR_ISA; /* try ISA */
  394. /* Suboptimize knowing first byte different */
  395. ctemp = readb(cd_chanid) & 0x0f;
  396. if (ctemp != *tchanid) { /* NOT ISA card, try MCA */
  397. tchanid = mcchannelid;
  398. cardpresent = TR_MCA;
  399. if (ctemp != *tchanid) /* Neither ISA nor MCA */
  400. cardpresent = NOTOK;
  401. }
  402. if (cardpresent != NOTOK) {
  403. /* Know presumed type, try rest of ID */
  404. for (i = 2, j = 1; i <= 46; i = i + 2, j++) {
  405. if( (readb(cd_chanid+i)&0x0f) == tchanid[j]) continue;
  406. /* match failed, not TR card */
  407. cardpresent = NOTOK;
  408. break;
  409. }
  410. }
  411. /*
  412. * If we have an ISA board check for the ISA P&P version,
  413. * as it has different IRQ settings
  414. */
  415. if (cardpresent == TR_ISA && (readb(AIPFID + t_mmio) == 0x0e))
  416. cardpresent = TR_ISAPNP;
  417. if (cardpresent == NOTOK) { /* "channel_id" did not match, report */
  418. if (!(ibmtr_debug_trace & TRC_INIT)) {
  419. #ifndef PCMCIA
  420. iounmap(t_mmio);
  421. #endif
  422. return -ENODEV;
  423. }
  424. DPRINTK( "Channel ID string not found for PIOaddr: %4hx\n",
  425. PIOaddr);
  426. DPRINTK("Expected for ISA: ");
  427. PrtChanID(pcchannelid, 1);
  428. DPRINTK(" found: ");
  429. /* BMS Note that this can be misleading, when hardware is flaky, because you
  430. are reading it a second time here. So with my flaky hardware, I'll see my-
  431. self in this block, with the HW ID matching the ISA ID exactly! */
  432. HWPrtChanID(cd_chanid, 2);
  433. DPRINTK("Expected for MCA: ");
  434. PrtChanID(mcchannelid, 1);
  435. }
  436. /* Now, setup some of the pl0 buffers for this driver.. */
  437. /* If called from PCMCIA, it is already set up, so no need to
  438. waste the memory, just use the existing structure */
  439. #ifndef PCMCIA
  440. ti->mmio = t_mmio;
  441. for (i = 0; i < IBMTR_MAX_ADAPTERS; i++) {
  442. if (turbo_io[i] != PIOaddr)
  443. continue;
  444. #if IBMTR_DEBUG_MESSAGES
  445. printk("ibmtr::tr_probe1, setting PIOaddr %x to Turbo\n",
  446. PIOaddr);
  447. #endif
  448. ti->turbo = 1;
  449. t_irq = turbo_irq[i];
  450. }
  451. #endif /* !PCMCIA */
  452. ti->readlog_pending = 0;
  453. init_waitqueue_head(&ti->wait_for_reset);
  454. /* if PCMCIA, the card can be recognized as either TR_ISA or TR_ISAPNP
  455. * depending which card is inserted. */
  456. #ifndef PCMCIA
  457. switch (cardpresent) {
  458. case TR_ISA:
  459. if (intr == 0) irq = 9; /* irq2 really is irq9 */
  460. if (intr == 1) irq = 3;
  461. if (intr == 2) irq = 6;
  462. if (intr == 3) irq = 7;
  463. ti->adapter_int_enable = PIOaddr + ADAPTINTREL;
  464. break;
  465. case TR_MCA:
  466. if (intr == 0) irq = 9;
  467. if (intr == 1) irq = 3;
  468. if (intr == 2) irq = 10;
  469. if (intr == 3) irq = 11;
  470. ti->global_int_enable = 0;
  471. ti->adapter_int_enable = 0;
  472. ti->sram_phys=(__u32)(inb(PIOaddr+ADAPTRESETREL) & 0xfe) << 12;
  473. break;
  474. case TR_ISAPNP:
  475. if (!t_irq) {
  476. if (intr == 0) irq = 9;
  477. if (intr == 1) irq = 3;
  478. if (intr == 2) irq = 10;
  479. if (intr == 3) irq = 11;
  480. } else
  481. irq=t_irq;
  482. timeout = jiffies + TR_SPIN_INTERVAL;
  483. while (!readb(ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN)){
  484. if (!time_after(jiffies, timeout)) continue;
  485. DPRINTK( "Hardware timeout during initialization.\n");
  486. iounmap(t_mmio);
  487. return -ENODEV;
  488. }
  489. ti->sram_phys =
  490. ((__u32)readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_EVEN)<<12);
  491. ti->adapter_int_enable = PIOaddr + ADAPTINTREL;
  492. break;
  493. } /*end switch (cardpresent) */
  494. #endif /*not PCMCIA */
  495. if (ibmtr_debug_trace & TRC_INIT) { /* just report int */
  496. DPRINTK("irq=%d", irq);
  497. printk(", sram_phys=0x%x", ti->sram_phys);
  498. if(ibmtr_debug_trace&TRC_INITV){ /* full chat in verbose only */
  499. DPRINTK(", ti->mmio=%p", ti->mmio);
  500. printk(", segment=%02X", segment);
  501. }
  502. printk(".\n");
  503. }
  504. /* Get hw address of token ring card */
  505. j = 0;
  506. for (i = 0; i < 0x18; i = i + 2) {
  507. /* technical reference states to do this */
  508. temp = readb(ti->mmio + AIP + i) & 0x0f;
  509. ti->hw_address[j] = temp;
  510. if (j & 1)
  511. dev->dev_addr[(j / 2)] =
  512. ti->hw_address[j]+ (ti->hw_address[j - 1] << 4);
  513. ++j;
  514. }
  515. /* get Adapter type: 'F' = Adapter/A, 'E' = 16/4 Adapter II,... */
  516. ti->adapter_type = readb(ti->mmio + AIPADAPTYPE);
  517. /* get Data Rate: F=4Mb, E=16Mb, D=4Mb & 16Mb ?? */
  518. ti->data_rate = readb(ti->mmio + AIPDATARATE);
  519. /* Get Early Token Release support?: F=no, E=4Mb, D=16Mb, C=4&16Mb */
  520. ti->token_release = readb(ti->mmio + AIPEARLYTOKEN);
  521. /* How much shared RAM is on adapter ? */
  522. if (ti->turbo) {
  523. ti->avail_shared_ram=127;
  524. } else {
  525. ti->avail_shared_ram = get_sram_size(ti);/*in 512 byte units */
  526. }
  527. /* We need to set or do a bunch of work here based on previous results*/
  528. /* Support paging? What sizes?: F=no, E=16k, D=32k, C=16 & 32k */
  529. ti->shared_ram_paging = readb(ti->mmio + AIPSHRAMPAGE);
  530. /* Available DHB 4Mb size: F=2048, E=4096, D=4464 */
  531. switch (readb(ti->mmio + AIP4MBDHB)) {
  532. case 0xe: ti->dhb_size4mb = 4096; break;
  533. case 0xd: ti->dhb_size4mb = 4464; break;
  534. default: ti->dhb_size4mb = 2048; break;
  535. }
  536. /* Available DHB 16Mb size: F=2048, E=4096, D=8192, C=16384, B=17960 */
  537. switch (readb(ti->mmio + AIP16MBDHB)) {
  538. case 0xe: ti->dhb_size16mb = 4096; break;
  539. case 0xd: ti->dhb_size16mb = 8192; break;
  540. case 0xc: ti->dhb_size16mb = 16384; break;
  541. case 0xb: ti->dhb_size16mb = 17960; break;
  542. default: ti->dhb_size16mb = 2048; break;
  543. }
  544. /* We must figure out how much shared memory space this adapter
  545. * will occupy so that if there are two adapters we can fit both
  546. * in. Given a choice, we will limit this adapter to 32K. The
  547. * maximum space will will use for two adapters is 64K so if the
  548. * adapter we are working on demands 64K (it also doesn't support
  549. * paging), then only one adapter can be supported.
  550. */
  551. /*
  552. * determine how much of total RAM is mapped into PC space
  553. */
  554. ti->mapped_ram_size= /*sixteen to onehundredtwentyeight 512byte blocks*/
  555. 1<< ((readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_ODD) >> 2 & 0x03) + 4);
  556. ti->page_mask = 0;
  557. if (ti->turbo) ti->page_mask=0xf0;
  558. else if (ti->shared_ram_paging == 0xf); /* No paging in adapter */
  559. else {
  560. #ifdef ENABLE_PAGING
  561. unsigned char pg_size = 0;
  562. /* BMS: page size: PCMCIA, use configuration register;
  563. ISAPNP, use LANAIDC config tool from www.ibm.com */
  564. switch (ti->shared_ram_paging) {
  565. case 0xf:
  566. break;
  567. case 0xe:
  568. ti->page_mask = (ti->mapped_ram_size == 32) ? 0xc0 : 0;
  569. pg_size = 32; /* 16KB page size */
  570. break;
  571. case 0xd:
  572. ti->page_mask = (ti->mapped_ram_size == 64) ? 0x80 : 0;
  573. pg_size = 64; /* 32KB page size */
  574. break;
  575. case 0xc:
  576. switch (ti->mapped_ram_size) {
  577. case 32:
  578. ti->page_mask = 0xc0;
  579. pg_size = 32;
  580. break;
  581. case 64:
  582. ti->page_mask = 0x80;
  583. pg_size = 64;
  584. break;
  585. }
  586. break;
  587. default:
  588. DPRINTK("Unknown shared ram paging info %01X\n",
  589. ti->shared_ram_paging);
  590. iounmap(t_mmio);
  591. return -ENODEV;
  592. break;
  593. } /*end switch shared_ram_paging */
  594. if (ibmtr_debug_trace & TRC_INIT)
  595. DPRINTK("Shared RAM paging code: %02X, "
  596. "mapped RAM size: %dK, shared RAM size: %dK, "
  597. "page mask: %02X\n:",
  598. ti->shared_ram_paging, ti->mapped_ram_size / 2,
  599. ti->avail_shared_ram / 2, ti->page_mask);
  600. #endif /*ENABLE_PAGING */
  601. }
  602. #ifndef PCMCIA
  603. /* finish figuring the shared RAM address */
  604. if (cardpresent == TR_ISA) {
  605. static __u32 ram_bndry_mask[] =
  606. { 0xffffe000, 0xffffc000, 0xffff8000, 0xffff0000 };
  607. __u32 new_base, rrr_32, chk_base, rbm;
  608. rrr_32=readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_ODD) >> 2 & 0x03;
  609. rbm = ram_bndry_mask[rrr_32];
  610. new_base = (ibmtr_mem_base + (~rbm)) & rbm;/* up to boundary */
  611. chk_base = new_base + (ti->mapped_ram_size << 9);
  612. if (chk_base > (ibmtr_mem_base + IBMTR_SHARED_RAM_SIZE)) {
  613. DPRINTK("Shared RAM for this adapter (%05x) exceeds "
  614. "driver limit (%05x), adapter not started.\n",
  615. chk_base, ibmtr_mem_base + IBMTR_SHARED_RAM_SIZE);
  616. iounmap(t_mmio);
  617. return -ENODEV;
  618. } else { /* seems cool, record what we have figured out */
  619. ti->sram_base = new_base >> 12;
  620. ibmtr_mem_base = chk_base;
  621. }
  622. }
  623. else ti->sram_base = ti->sram_phys >> 12;
  624. /* The PCMCIA has already got the interrupt line and the io port,
  625. so no chance of anybody else getting it - MLP */
  626. if (request_irq(dev->irq = irq, &tok_interrupt, 0, "ibmtr", dev) != 0) {
  627. DPRINTK("Could not grab irq %d. Halting Token Ring driver.\n",
  628. irq);
  629. iounmap(t_mmio);
  630. return -ENODEV;
  631. }
  632. /*?? Now, allocate some of the PIO PORTs for this driver.. */
  633. /* record PIOaddr range as busy */
  634. if (!request_region(PIOaddr, IBMTR_IO_EXTENT, "ibmtr")) {
  635. DPRINTK("Could not grab PIO range. Halting driver.\n");
  636. free_irq(dev->irq, dev);
  637. iounmap(t_mmio);
  638. return -EBUSY;
  639. }
  640. if (!version_printed++) {
  641. printk(version);
  642. }
  643. #endif /* !PCMCIA */
  644. DPRINTK("%s %s found\n",
  645. channel_def[cardpresent - 1], adapter_def(ti->adapter_type));
  646. DPRINTK("using irq %d, PIOaddr %hx, %dK shared RAM.\n",
  647. irq, PIOaddr, ti->mapped_ram_size / 2);
  648. DPRINTK("Hardware address : %02X:%02X:%02X:%02X:%02X:%02X\n",
  649. dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
  650. dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]);
  651. if (ti->page_mask)
  652. DPRINTK("Shared RAM paging enabled. "
  653. "Page size: %uK Shared Ram size %dK\n",
  654. ((ti->page_mask^0xff)+1) >>2, ti->avail_shared_ram / 2);
  655. else
  656. DPRINTK("Shared RAM paging disabled. ti->page_mask %x\n",
  657. ti->page_mask);
  658. /* Calculate the maximum DHB we can use */
  659. /* two cases where avail_shared_ram doesn't equal mapped_ram_size:
  660. 1. avail_shared_ram is 127 but mapped_ram_size is 128 (typical)
  661. 2. user has configured adapter for less than avail_shared_ram
  662. but is not using paging (she should use paging, I believe)
  663. */
  664. if (!ti->page_mask) {
  665. ti->avail_shared_ram=
  666. min(ti->mapped_ram_size,ti->avail_shared_ram);
  667. }
  668. switch (ti->avail_shared_ram) {
  669. case 16: /* 8KB shared RAM */
  670. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)2048);
  671. ti->rbuf_len4 = 1032;
  672. ti->rbuf_cnt4=2;
  673. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)2048);
  674. ti->rbuf_len16 = 1032;
  675. ti->rbuf_cnt16=2;
  676. break;
  677. case 32: /* 16KB shared RAM */
  678. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  679. ti->rbuf_len4 = 1032;
  680. ti->rbuf_cnt4=4;
  681. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)4096);
  682. ti->rbuf_len16 = 1032; /*1024 usable */
  683. ti->rbuf_cnt16=4;
  684. break;
  685. case 64: /* 32KB shared RAM */
  686. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  687. ti->rbuf_len4 = 1032;
  688. ti->rbuf_cnt4=6;
  689. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)10240);
  690. ti->rbuf_len16 = 1032;
  691. ti->rbuf_cnt16=6;
  692. break;
  693. case 127: /* 63.5KB shared RAM */
  694. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  695. ti->rbuf_len4 = 1032;
  696. ti->rbuf_cnt4=6;
  697. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)16384);
  698. ti->rbuf_len16 = 1032;
  699. ti->rbuf_cnt16=16;
  700. break;
  701. case 128: /* 64KB shared RAM */
  702. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  703. ti->rbuf_len4 = 1032;
  704. ti->rbuf_cnt4=6;
  705. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)17960);
  706. ti->rbuf_len16 = 1032;
  707. ti->rbuf_cnt16=16;
  708. break;
  709. default:
  710. ti->dhb_size4mb = 2048;
  711. ti->rbuf_len4 = 1032;
  712. ti->rbuf_cnt4=2;
  713. ti->dhb_size16mb = 2048;
  714. ti->rbuf_len16 = 1032;
  715. ti->rbuf_cnt16=2;
  716. break;
  717. }
  718. /* this formula is not smart enough for the paging case
  719. ti->rbuf_cnt<x> = (ti->avail_shared_ram * BLOCKSZ - ADAPT_PRIVATE -
  720. ARBLENGTH - SSBLENGTH - DLC_MAX_SAP * SAPLENGTH -
  721. DLC_MAX_STA * STALENGTH - ti->dhb_size<x>mb * NUM_DHB -
  722. SRBLENGTH - ASBLENGTH) / ti->rbuf_len<x>;
  723. */
  724. ti->maxmtu16 = (ti->rbuf_len16 - 8) * ti->rbuf_cnt16 - TR_HLEN;
  725. ti->maxmtu4 = (ti->rbuf_len4 - 8) * ti->rbuf_cnt4 - TR_HLEN;
  726. /*BMS assuming 18 bytes of Routing Information (usually works) */
  727. DPRINTK("Maximum Receive Internet Protocol MTU 16Mbps: %d, 4Mbps: %d\n",
  728. ti->maxmtu16, ti->maxmtu4);
  729. dev->base_addr = PIOaddr; /* set the value for device */
  730. dev->mem_start = ti->sram_base << 12;
  731. dev->mem_end = dev->mem_start + (ti->mapped_ram_size << 9) - 1;
  732. trdev_init(dev);
  733. return 0; /* Return 0 to indicate we have found a Token Ring card. */
  734. } /*ibmtr_probe1() */
  735. /*****************************************************************************/
  736. /* query the adapter for the size of shared RAM */
  737. /* the function returns the RAM size in units of 512 bytes */
  738. static unsigned char __devinit get_sram_size(struct tok_info *adapt_info)
  739. {
  740. unsigned char avail_sram_code;
  741. static unsigned char size_code[] = { 0, 16, 32, 64, 127, 128 };
  742. /* Adapter gives
  743. 'F' -- use RRR bits 3,2
  744. 'E' -- 8kb 'D' -- 16kb
  745. 'C' -- 32kb 'A' -- 64KB
  746. 'B' - 64KB less 512 bytes at top
  747. (WARNING ... must zero top bytes in INIT */
  748. avail_sram_code = 0xf - readb(adapt_info->mmio + AIPAVAILSHRAM);
  749. if (avail_sram_code) return size_code[avail_sram_code];
  750. else /* for code 'F', must compute size from RRR(3,2) bits */
  751. return 1 <<
  752. ((readb(adapt_info->mmio+ACA_OFFSET+ACA_RW+RRR_ODD)>>2&3)+4);
  753. }
  754. /*****************************************************************************/
  755. static int __devinit trdev_init(struct net_device *dev)
  756. {
  757. struct tok_info *ti = (struct tok_info *) dev->priv;
  758. SET_PAGE(ti->srb_page);
  759. ti->open_failure = NO ;
  760. dev->open = tok_open;
  761. dev->stop = tok_close;
  762. dev->hard_start_xmit = tok_send_packet;
  763. dev->get_stats = tok_get_stats;
  764. dev->set_multicast_list = tok_set_multicast_list;
  765. dev->change_mtu = ibmtr_change_mtu;
  766. return 0;
  767. }
  768. /*****************************************************************************/
  769. static int tok_init_card(struct net_device *dev)
  770. {
  771. struct tok_info *ti;
  772. short PIOaddr;
  773. unsigned long i;
  774. PIOaddr = dev->base_addr;
  775. ti = (struct tok_info *) dev->priv;
  776. /* Special processing for first interrupt after reset */
  777. ti->do_tok_int = FIRST_INT;
  778. /* Reset adapter */
  779. writeb(~INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  780. outb(0, PIOaddr + ADAPTRESET);
  781. schedule_timeout_uninterruptible(TR_RST_TIME); /* wait 50ms */
  782. outb(0, PIOaddr + ADAPTRESETREL);
  783. #ifdef ENABLE_PAGING
  784. if (ti->page_mask)
  785. writeb(SRPR_ENABLE_PAGING,ti->mmio+ACA_OFFSET+ACA_RW+SRPR_EVEN);
  786. #endif
  787. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  788. i = sleep_on_timeout(&ti->wait_for_reset, 4 * HZ);
  789. return i? 0 : -EAGAIN;
  790. }
  791. /*****************************************************************************/
  792. static int tok_open(struct net_device *dev)
  793. {
  794. struct tok_info *ti = (struct tok_info *) dev->priv;
  795. int i;
  796. /*the case we were left in a failure state during a previous open */
  797. if (ti->open_failure == YES) {
  798. DPRINTK("Last time you were disconnected, how about now?\n");
  799. printk("You can't insert with an ICS connector half-cocked.\n");
  800. }
  801. ti->open_status = CLOSED; /* CLOSED or OPEN */
  802. ti->sap_status = CLOSED; /* CLOSED or OPEN */
  803. ti->open_failure = NO; /* NO or YES */
  804. ti->open_mode = MANUAL; /* MANUAL or AUTOMATIC */
  805. ti->sram_phys &= ~1; /* to reverse what we do in tok_close */
  806. /* init the spinlock */
  807. spin_lock_init(&ti->lock);
  808. init_timer(&ti->tr_timer);
  809. i = tok_init_card(dev);
  810. if (i) return i;
  811. while (1){
  812. tok_open_adapter((unsigned long) dev);
  813. i= interruptible_sleep_on_timeout(&ti->wait_for_reset, 25 * HZ);
  814. /* sig catch: estimate opening adapter takes more than .5 sec*/
  815. if (i>(245*HZ)/10) break; /* fancier than if (i==25*HZ) */
  816. if (i==0) break;
  817. if (ti->open_status == OPEN && ti->sap_status==OPEN) {
  818. netif_start_queue(dev);
  819. DPRINTK("Adapter is up and running\n");
  820. return 0;
  821. }
  822. i=schedule_timeout_interruptible(TR_RETRY_INTERVAL);
  823. /* wait 30 seconds */
  824. if(i!=0) break; /*prob. a signal, like the i>24*HZ case above */
  825. }
  826. outb(0, dev->base_addr + ADAPTRESET);/* kill pending interrupts*/
  827. DPRINTK("TERMINATED via signal\n"); /*BMS useful */
  828. return -EAGAIN;
  829. }
  830. /*****************************************************************************/
  831. #define COMMAND_OFST 0
  832. #define OPEN_OPTIONS_OFST 8
  833. #define NUM_RCV_BUF_OFST 24
  834. #define RCV_BUF_LEN_OFST 26
  835. #define DHB_LENGTH_OFST 28
  836. #define NUM_DHB_OFST 30
  837. #define DLC_MAX_SAP_OFST 32
  838. #define DLC_MAX_STA_OFST 33
  839. static void tok_open_adapter(unsigned long dev_addr)
  840. {
  841. struct net_device *dev = (struct net_device *) dev_addr;
  842. struct tok_info *ti;
  843. int i;
  844. ti = (struct tok_info *) dev->priv;
  845. SET_PAGE(ti->init_srb_page);
  846. writeb(~SRB_RESP_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
  847. for (i = 0; i < sizeof(struct dir_open_adapter); i++)
  848. writeb(0, ti->init_srb + i);
  849. writeb(DIR_OPEN_ADAPTER, ti->init_srb + COMMAND_OFST);
  850. writew(htons(OPEN_PASS_BCON_MAC), ti->init_srb + OPEN_OPTIONS_OFST);
  851. if (ti->ring_speed == 16) {
  852. writew(htons(ti->dhb_size16mb), ti->init_srb + DHB_LENGTH_OFST);
  853. writew(htons(ti->rbuf_cnt16), ti->init_srb + NUM_RCV_BUF_OFST);
  854. writew(htons(ti->rbuf_len16), ti->init_srb + RCV_BUF_LEN_OFST);
  855. } else {
  856. writew(htons(ti->dhb_size4mb), ti->init_srb + DHB_LENGTH_OFST);
  857. writew(htons(ti->rbuf_cnt4), ti->init_srb + NUM_RCV_BUF_OFST);
  858. writew(htons(ti->rbuf_len4), ti->init_srb + RCV_BUF_LEN_OFST);
  859. }
  860. writeb(NUM_DHB, /* always 2 */ ti->init_srb + NUM_DHB_OFST);
  861. writeb(DLC_MAX_SAP, ti->init_srb + DLC_MAX_SAP_OFST);
  862. writeb(DLC_MAX_STA, ti->init_srb + DLC_MAX_STA_OFST);
  863. ti->srb = ti->init_srb; /* We use this one in the interrupt handler */
  864. ti->srb_page = ti->init_srb_page;
  865. DPRINTK("Opening adapter: Xmit bfrs: %d X %d, Rcv bfrs: %d X %d\n",
  866. readb(ti->init_srb + NUM_DHB_OFST),
  867. ntohs(readw(ti->init_srb + DHB_LENGTH_OFST)),
  868. ntohs(readw(ti->init_srb + NUM_RCV_BUF_OFST)),
  869. ntohs(readw(ti->init_srb + RCV_BUF_LEN_OFST)));
  870. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  871. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  872. }
  873. /*****************************************************************************/
  874. static void open_sap(unsigned char type, struct net_device *dev)
  875. {
  876. int i;
  877. struct tok_info *ti = (struct tok_info *) dev->priv;
  878. SET_PAGE(ti->srb_page);
  879. for (i = 0; i < sizeof(struct dlc_open_sap); i++)
  880. writeb(0, ti->srb + i);
  881. #define MAX_I_FIELD_OFST 14
  882. #define SAP_VALUE_OFST 16
  883. #define SAP_OPTIONS_OFST 17
  884. #define STATION_COUNT_OFST 18
  885. writeb(DLC_OPEN_SAP, ti->srb + COMMAND_OFST);
  886. writew(htons(MAX_I_FIELD), ti->srb + MAX_I_FIELD_OFST);
  887. writeb(SAP_OPEN_IND_SAP | SAP_OPEN_PRIORITY, ti->srb+ SAP_OPTIONS_OFST);
  888. writeb(SAP_OPEN_STATION_CNT, ti->srb + STATION_COUNT_OFST);
  889. writeb(type, ti->srb + SAP_VALUE_OFST);
  890. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  891. }
  892. /*****************************************************************************/
  893. static void tok_set_multicast_list(struct net_device *dev)
  894. {
  895. struct tok_info *ti = (struct tok_info *) dev->priv;
  896. struct dev_mc_list *mclist;
  897. unsigned char address[4];
  898. int i;
  899. /*BMS the next line is CRUCIAL or you may be sad when you */
  900. /*BMS ifconfig tr down or hot unplug a PCMCIA card ??hownowbrowncow*/
  901. if (/*BMSHELPdev->start == 0 ||*/ ti->open_status != OPEN) return;
  902. address[0] = address[1] = address[2] = address[3] = 0;
  903. mclist = dev->mc_list;
  904. for (i = 0; i < dev->mc_count; i++) {
  905. address[0] |= mclist->dmi_addr[2];
  906. address[1] |= mclist->dmi_addr[3];
  907. address[2] |= mclist->dmi_addr[4];
  908. address[3] |= mclist->dmi_addr[5];
  909. mclist = mclist->next;
  910. }
  911. SET_PAGE(ti->srb_page);
  912. for (i = 0; i < sizeof(struct srb_set_funct_addr); i++)
  913. writeb(0, ti->srb + i);
  914. #define FUNCT_ADDRESS_OFST 6
  915. writeb(DIR_SET_FUNC_ADDR, ti->srb + COMMAND_OFST);
  916. for (i = 0; i < 4; i++)
  917. writeb(address[i], ti->srb + FUNCT_ADDRESS_OFST + i);
  918. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  919. #if TR_VERBOSE
  920. DPRINTK("Setting functional address: ");
  921. for (i=0;i<4;i++) printk("%02X ", address[i]);
  922. printk("\n");
  923. #endif
  924. }
  925. /*****************************************************************************/
  926. #define STATION_ID_OFST 4
  927. static int tok_send_packet(struct sk_buff *skb, struct net_device *dev)
  928. {
  929. struct tok_info *ti;
  930. unsigned long flags;
  931. ti = (struct tok_info *) dev->priv;
  932. netif_stop_queue(dev);
  933. /* lock against other CPUs */
  934. spin_lock_irqsave(&(ti->lock), flags);
  935. /* Save skb; we'll need it when the adapter asks for the data */
  936. ti->current_skb = skb;
  937. SET_PAGE(ti->srb_page);
  938. writeb(XMIT_UI_FRAME, ti->srb + COMMAND_OFST);
  939. writew(ti->exsap_station_id, ti->srb + STATION_ID_OFST);
  940. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  941. spin_unlock_irqrestore(&(ti->lock), flags);
  942. dev->trans_start = jiffies;
  943. return 0;
  944. }
  945. /*****************************************************************************/
  946. static int tok_close(struct net_device *dev)
  947. {
  948. struct tok_info *ti = (struct tok_info *) dev->priv;
  949. /* Important for PCMCIA hot unplug, otherwise, we'll pull the card, */
  950. /* unloading the module from memory, and then if a timer pops, ouch */
  951. del_timer_sync(&ti->tr_timer);
  952. outb(0, dev->base_addr + ADAPTRESET);
  953. ti->sram_phys |= 1;
  954. ti->open_status = CLOSED;
  955. netif_stop_queue(dev);
  956. DPRINTK("Adapter is closed.\n");
  957. return 0;
  958. }
  959. /*****************************************************************************/
  960. #define RETCODE_OFST 2
  961. #define OPEN_ERROR_CODE_OFST 6
  962. #define ASB_ADDRESS_OFST 8
  963. #define SRB_ADDRESS_OFST 10
  964. #define ARB_ADDRESS_OFST 12
  965. #define SSB_ADDRESS_OFST 14
  966. static char *printphase[]= {"Lobe media test","Physical insertion",
  967. "Address verification","Roll call poll","Request Parameters"};
  968. static char *printerror[]={"Function failure","Signal loss","Reserved",
  969. "Frequency error","Timeout","Ring failure","Ring beaconing",
  970. "Duplicate node address",
  971. "Parameter request-retry count exceeded","Remove received",
  972. "IMPL force received","Duplicate modifier",
  973. "No monitor detected","Monitor contention failed for RPL"};
  974. static void __iomem *map_address(struct tok_info *ti, unsigned index, __u8 *page)
  975. {
  976. if (ti->page_mask) {
  977. *page = (index >> 8) & ti->page_mask;
  978. index &= ~(ti->page_mask << 8);
  979. }
  980. return ti->sram_virt + index;
  981. }
  982. static void dir_open_adapter (struct net_device *dev)
  983. {
  984. struct tok_info *ti = (struct tok_info *) dev->priv;
  985. unsigned char ret_code;
  986. __u16 err;
  987. ti->srb = map_address(ti,
  988. ntohs(readw(ti->init_srb + SRB_ADDRESS_OFST)),
  989. &ti->srb_page);
  990. ti->ssb = map_address(ti,
  991. ntohs(readw(ti->init_srb + SSB_ADDRESS_OFST)),
  992. &ti->ssb_page);
  993. ti->arb = map_address(ti,
  994. ntohs(readw(ti->init_srb + ARB_ADDRESS_OFST)),
  995. &ti->arb_page);
  996. ti->asb = map_address(ti,
  997. ntohs(readw(ti->init_srb + ASB_ADDRESS_OFST)),
  998. &ti->asb_page);
  999. ti->current_skb = NULL;
  1000. ret_code = readb(ti->init_srb + RETCODE_OFST);
  1001. err = ntohs(readw(ti->init_srb + OPEN_ERROR_CODE_OFST));
  1002. if (!ret_code) {
  1003. ti->open_status = OPEN; /* TR adapter is now available */
  1004. if (ti->open_mode == AUTOMATIC) {
  1005. DPRINTK("Adapter reopened.\n");
  1006. }
  1007. writeb(~SRB_RESP_INT, ti->mmio+ACA_OFFSET+ACA_RESET+ISRP_ODD);
  1008. open_sap(EXTENDED_SAP, dev);
  1009. return;
  1010. }
  1011. ti->open_failure = YES;
  1012. if (ret_code == 7){
  1013. if (err == 0x24) {
  1014. if (!ti->auto_speedsave) {
  1015. DPRINTK("Open failed: Adapter speed must match "
  1016. "ring speed if Automatic Ring Speed Save is "
  1017. "disabled.\n");
  1018. ti->open_action = FAIL;
  1019. }else
  1020. DPRINTK("Retrying open to adjust to "
  1021. "ring speed, ");
  1022. } else if (err == 0x2d) {
  1023. DPRINTK("Physical Insertion: No Monitor Detected, ");
  1024. printk("retrying after %ds delay...\n",
  1025. TR_RETRY_INTERVAL/HZ);
  1026. } else if (err == 0x11) {
  1027. DPRINTK("Lobe Media Function Failure (0x11), ");
  1028. printk(" retrying after %ds delay...\n",
  1029. TR_RETRY_INTERVAL/HZ);
  1030. } else {
  1031. char **prphase = printphase;
  1032. char **prerror = printerror;
  1033. DPRINTK("TR Adapter misc open failure, error code = ");
  1034. printk("0x%x, Phase: %s, Error: %s\n",
  1035. err, prphase[err/16 -1], prerror[err%16 -1]);
  1036. printk(" retrying after %ds delay...\n",
  1037. TR_RETRY_INTERVAL/HZ);
  1038. }
  1039. } else DPRINTK("open failed: ret_code = %02X..., ", ret_code);
  1040. if (ti->open_action != FAIL) {
  1041. if (ti->open_mode==AUTOMATIC){
  1042. ti->open_action = REOPEN;
  1043. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1044. return;
  1045. }
  1046. wake_up(&ti->wait_for_reset);
  1047. return;
  1048. }
  1049. DPRINTK("FAILURE, CAPUT\n");
  1050. }
  1051. /******************************************************************************/
  1052. static irqreturn_t tok_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  1053. {
  1054. unsigned char status;
  1055. /* unsigned char status_even ; */
  1056. struct tok_info *ti;
  1057. struct net_device *dev;
  1058. #ifdef ENABLE_PAGING
  1059. unsigned char save_srpr;
  1060. #endif
  1061. dev = dev_id;
  1062. #if TR_VERBOSE
  1063. DPRINTK("Int from tok_driver, dev : %p irq%d regs=%p\n", dev,irq,regs);
  1064. #endif
  1065. ti = (struct tok_info *) dev->priv;
  1066. if (ti->sram_phys & 1)
  1067. return IRQ_NONE; /* PCMCIA card extraction flag */
  1068. spin_lock(&(ti->lock));
  1069. #ifdef ENABLE_PAGING
  1070. save_srpr = readb(ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1071. #endif
  1072. /* Disable interrupts till processing is finished */
  1073. writeb((~INT_ENABLE), ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  1074. /* Reset interrupt for ISA boards */
  1075. if (ti->adapter_int_enable)
  1076. outb(0, ti->adapter_int_enable);
  1077. else /* used for PCMCIA cards */
  1078. outb(0, ti->global_int_enable);
  1079. if (ti->do_tok_int == FIRST_INT){
  1080. initial_tok_int(dev);
  1081. #ifdef ENABLE_PAGING
  1082. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1083. #endif
  1084. spin_unlock(&(ti->lock));
  1085. return IRQ_HANDLED;
  1086. }
  1087. /* Begin interrupt handler HERE inline to avoid the extra
  1088. levels of logic and call depth for the original solution. */
  1089. status = readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_ODD);
  1090. /*BMSstatus_even = readb (ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN) */
  1091. /*BMSdebugprintk("tok_interrupt: ISRP_ODD = 0x%x ISRP_EVEN = 0x%x\n", */
  1092. /*BMS status,status_even); */
  1093. if (status & ADAP_CHK_INT) {
  1094. int i;
  1095. void __iomem *check_reason;
  1096. __u8 check_reason_page = 0;
  1097. check_reason = map_address(ti,
  1098. ntohs(readw(ti->mmio+ ACA_OFFSET+ACA_RW + WWCR_EVEN)),
  1099. &check_reason_page);
  1100. SET_PAGE(check_reason_page);
  1101. DPRINTK("Adapter check interrupt\n");
  1102. DPRINTK("8 reason bytes follow: ");
  1103. for (i = 0; i < 8; i++, check_reason++)
  1104. printk("%02X ", (int) readb(check_reason));
  1105. printk("\n");
  1106. writeb(~ADAP_CHK_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1107. status = readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRA_EVEN);
  1108. DPRINTK("ISRA_EVEN == 0x02%x\n",status);
  1109. ti->open_status = CLOSED;
  1110. ti->sap_status = CLOSED;
  1111. ti->open_mode = AUTOMATIC;
  1112. netif_carrier_off(dev);
  1113. netif_stop_queue(dev);
  1114. ti->open_action = RESTART;
  1115. outb(0, dev->base_addr + ADAPTRESET);
  1116. ibmtr_reset_timer(&(ti->tr_timer), dev);/*BMS try to reopen*/
  1117. spin_unlock(&(ti->lock));
  1118. return IRQ_HANDLED;
  1119. }
  1120. if (readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN)
  1121. & (TCR_INT | ERR_INT | ACCESS_INT)) {
  1122. DPRINTK("adapter error: ISRP_EVEN : %02x\n",
  1123. (int)readb(ti->mmio+ ACA_OFFSET + ACA_RW + ISRP_EVEN));
  1124. writeb(~(TCR_INT | ERR_INT | ACCESS_INT),
  1125. ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  1126. status= readb(ti->mmio+ ACA_OFFSET + ACA_RW + ISRA_EVEN);/*BMS*/
  1127. DPRINTK("ISRA_EVEN == 0x02%x\n",status);/*BMS*/
  1128. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1129. #ifdef ENABLE_PAGING
  1130. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1131. #endif
  1132. spin_unlock(&(ti->lock));
  1133. return IRQ_HANDLED;
  1134. }
  1135. if (status & SRB_RESP_INT) { /* SRB response */
  1136. SET_PAGE(ti->srb_page);
  1137. #if TR_VERBOSE
  1138. DPRINTK("SRB resp: cmd=%02X rsp=%02X\n",
  1139. readb(ti->srb), readb(ti->srb + RETCODE_OFST));
  1140. #endif
  1141. switch (readb(ti->srb)) { /* SRB command check */
  1142. case XMIT_DIR_FRAME:{
  1143. unsigned char xmit_ret_code;
  1144. xmit_ret_code = readb(ti->srb + RETCODE_OFST);
  1145. if (xmit_ret_code == 0xff) break;
  1146. DPRINTK("error on xmit_dir_frame request: %02X\n",
  1147. xmit_ret_code);
  1148. if (ti->current_skb) {
  1149. dev_kfree_skb_irq(ti->current_skb);
  1150. ti->current_skb = NULL;
  1151. }
  1152. /*dev->tbusy = 0;*/
  1153. netif_wake_queue(dev);
  1154. if (ti->readlog_pending)
  1155. ibmtr_readlog(dev);
  1156. break;
  1157. }
  1158. case XMIT_UI_FRAME:{
  1159. unsigned char xmit_ret_code;
  1160. xmit_ret_code = readb(ti->srb + RETCODE_OFST);
  1161. if (xmit_ret_code == 0xff) break;
  1162. DPRINTK("error on xmit_ui_frame request: %02X\n",
  1163. xmit_ret_code);
  1164. if (ti->current_skb) {
  1165. dev_kfree_skb_irq(ti->current_skb);
  1166. ti->current_skb = NULL;
  1167. }
  1168. netif_wake_queue(dev);
  1169. if (ti->readlog_pending)
  1170. ibmtr_readlog(dev);
  1171. break;
  1172. }
  1173. case DIR_OPEN_ADAPTER:
  1174. dir_open_adapter(dev);
  1175. break;
  1176. case DLC_OPEN_SAP:
  1177. if (readb(ti->srb + RETCODE_OFST)) {
  1178. DPRINTK("open_sap failed: ret_code = %02X, "
  1179. "retrying\n",
  1180. (int) readb(ti->srb + RETCODE_OFST));
  1181. ti->open_action = REOPEN;
  1182. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1183. break;
  1184. }
  1185. ti->exsap_station_id = readw(ti->srb + STATION_ID_OFST);
  1186. ti->sap_status = OPEN;/* TR adapter is now available */
  1187. if (ti->open_mode==MANUAL){
  1188. wake_up(&ti->wait_for_reset);
  1189. break;
  1190. }
  1191. netif_wake_queue(dev);
  1192. netif_carrier_on(dev);
  1193. break;
  1194. case DIR_INTERRUPT:
  1195. case DIR_MOD_OPEN_PARAMS:
  1196. case DIR_SET_GRP_ADDR:
  1197. case DIR_SET_FUNC_ADDR:
  1198. case DLC_CLOSE_SAP:
  1199. if (readb(ti->srb + RETCODE_OFST))
  1200. DPRINTK("error on %02X: %02X\n",
  1201. (int) readb(ti->srb + COMMAND_OFST),
  1202. (int) readb(ti->srb + RETCODE_OFST));
  1203. break;
  1204. case DIR_READ_LOG:
  1205. if (readb(ti->srb + RETCODE_OFST)){
  1206. DPRINTK("error on dir_read_log: %02X\n",
  1207. (int) readb(ti->srb + RETCODE_OFST));
  1208. netif_wake_queue(dev);
  1209. break;
  1210. }
  1211. #if IBMTR_DEBUG_MESSAGES
  1212. #define LINE_ERRORS_OFST 0
  1213. #define INTERNAL_ERRORS_OFST 1
  1214. #define BURST_ERRORS_OFST 2
  1215. #define AC_ERRORS_OFST 3
  1216. #define ABORT_DELIMITERS_OFST 4
  1217. #define LOST_FRAMES_OFST 6
  1218. #define RECV_CONGEST_COUNT_OFST 7
  1219. #define FRAME_COPIED_ERRORS_OFST 8
  1220. #define FREQUENCY_ERRORS_OFST 9
  1221. #define TOKEN_ERRORS_OFST 10
  1222. DPRINTK("Line errors %02X, Internal errors %02X, "
  1223. "Burst errors %02X\n" "A/C errors %02X, "
  1224. "Abort delimiters %02X, Lost frames %02X\n"
  1225. "Receive congestion count %02X, "
  1226. "Frame copied errors %02X\nFrequency errors %02X, "
  1227. "Token errors %02X\n",
  1228. (int) readb(ti->srb + LINE_ERRORS_OFST),
  1229. (int) readb(ti->srb + INTERNAL_ERRORS_OFST),
  1230. (int) readb(ti->srb + BURST_ERRORS_OFST),
  1231. (int) readb(ti->srb + AC_ERRORS_OFST),
  1232. (int) readb(ti->srb + ABORT_DELIMITERS_OFST),
  1233. (int) readb(ti->srb + LOST_FRAMES_OFST),
  1234. (int) readb(ti->srb + RECV_CONGEST_COUNT_OFST),
  1235. (int) readb(ti->srb + FRAME_COPIED_ERRORS_OFST),
  1236. (int) readb(ti->srb + FREQUENCY_ERRORS_OFST),
  1237. (int) readb(ti->srb + TOKEN_ERRORS_OFST));
  1238. #endif
  1239. netif_wake_queue(dev);
  1240. break;
  1241. default:
  1242. DPRINTK("Unknown command %02X encountered\n",
  1243. (int) readb(ti->srb));
  1244. } /* end switch SRB command check */
  1245. writeb(~SRB_RESP_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1246. } /* if SRB response */
  1247. if (status & ASB_FREE_INT) { /* ASB response */
  1248. SET_PAGE(ti->asb_page);
  1249. #if TR_VERBOSE
  1250. DPRINTK("ASB resp: cmd=%02X\n", readb(ti->asb));
  1251. #endif
  1252. switch (readb(ti->asb)) { /* ASB command check */
  1253. case REC_DATA:
  1254. case XMIT_UI_FRAME:
  1255. case XMIT_DIR_FRAME:
  1256. break;
  1257. default:
  1258. DPRINTK("unknown command in asb %02X\n",
  1259. (int) readb(ti->asb));
  1260. } /* switch ASB command check */
  1261. if (readb(ti->asb + 2) != 0xff) /* checks ret_code */
  1262. DPRINTK("ASB error %02X in cmd %02X\n",
  1263. (int) readb(ti->asb + 2), (int) readb(ti->asb));
  1264. writeb(~ASB_FREE_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1265. } /* if ASB response */
  1266. #define STATUS_OFST 6
  1267. #define NETW_STATUS_OFST 6
  1268. if (status & ARB_CMD_INT) { /* ARB response */
  1269. SET_PAGE(ti->arb_page);
  1270. #if TR_VERBOSE
  1271. DPRINTK("ARB resp: cmd=%02X\n", readb(ti->arb));
  1272. #endif
  1273. switch (readb(ti->arb)) { /* ARB command check */
  1274. case DLC_STATUS:
  1275. DPRINTK("DLC_STATUS new status: %02X on station %02X\n",
  1276. ntohs(readw(ti->arb + STATUS_OFST)),
  1277. ntohs(readw(ti->arb+ STATION_ID_OFST)));
  1278. break;
  1279. case REC_DATA:
  1280. tr_rx(dev);
  1281. break;
  1282. case RING_STAT_CHANGE:{
  1283. unsigned short ring_status;
  1284. ring_status= ntohs(readw(ti->arb + NETW_STATUS_OFST));
  1285. if (ibmtr_debug_trace & TRC_INIT)
  1286. DPRINTK("Ring Status Change...(0x%x)\n",
  1287. ring_status);
  1288. if(ring_status& (REMOVE_RECV|AUTO_REMOVAL|LOBE_FAULT)){
  1289. netif_stop_queue(dev);
  1290. netif_carrier_off(dev);
  1291. DPRINTK("Remove received, or Auto-removal error"
  1292. ", or Lobe fault\n");
  1293. DPRINTK("We'll try to reopen the closed adapter"
  1294. " after a %d second delay.\n",
  1295. TR_RETRY_INTERVAL/HZ);
  1296. /*I was confused: I saw the TR reopening but */
  1297. /*forgot:with an RJ45 in an RJ45/ICS adapter */
  1298. /*but adapter not in the ring, the TR will */
  1299. /* open, and then soon close and come here. */
  1300. ti->open_mode = AUTOMATIC;
  1301. ti->open_status = CLOSED; /*12/2000 BMS*/
  1302. ti->open_action = REOPEN;
  1303. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1304. } else if (ring_status & LOG_OVERFLOW) {
  1305. if(netif_queue_stopped(dev))
  1306. ti->readlog_pending = 1;
  1307. else
  1308. ibmtr_readlog(dev);
  1309. }
  1310. break;
  1311. }
  1312. case XMIT_DATA_REQ:
  1313. tr_tx(dev);
  1314. break;
  1315. default:
  1316. DPRINTK("Unknown command %02X in arb\n",
  1317. (int) readb(ti->arb));
  1318. break;
  1319. } /* switch ARB command check */
  1320. writeb(~ARB_CMD_INT, ti->mmio+ ACA_OFFSET+ACA_RESET + ISRP_ODD);
  1321. writeb(ARB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1322. } /* if ARB response */
  1323. if (status & SSB_RESP_INT) { /* SSB response */
  1324. unsigned char retcode;
  1325. SET_PAGE(ti->ssb_page);
  1326. #if TR_VERBOSE
  1327. DPRINTK("SSB resp: cmd=%02X rsp=%02X\n",
  1328. readb(ti->ssb), readb(ti->ssb + 2));
  1329. #endif
  1330. switch (readb(ti->ssb)) { /* SSB command check */
  1331. case XMIT_DIR_FRAME:
  1332. case XMIT_UI_FRAME:
  1333. retcode = readb(ti->ssb + 2);
  1334. if (retcode && (retcode != 0x22))/* checks ret_code */
  1335. DPRINTK("xmit ret_code: %02X xmit error code: "
  1336. "%02X\n",
  1337. (int)retcode, (int)readb(ti->ssb + 6));
  1338. else
  1339. ti->tr_stats.tx_packets++;
  1340. break;
  1341. case XMIT_XID_CMD:
  1342. DPRINTK("xmit xid ret_code: %02X\n",
  1343. (int) readb(ti->ssb + 2));
  1344. default:
  1345. DPRINTK("Unknown command %02X in ssb\n",
  1346. (int) readb(ti->ssb));
  1347. } /* SSB command check */
  1348. writeb(~SSB_RESP_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1349. writeb(SSB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1350. } /* if SSB response */
  1351. #ifdef ENABLE_PAGING
  1352. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1353. #endif
  1354. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1355. spin_unlock(&(ti->lock));
  1356. return IRQ_HANDLED;
  1357. } /*tok_interrupt */
  1358. /*****************************************************************************/
  1359. #define INIT_STATUS_OFST 1
  1360. #define INIT_STATUS_2_OFST 2
  1361. #define ENCODED_ADDRESS_OFST 8
  1362. static void initial_tok_int(struct net_device *dev)
  1363. {
  1364. __u32 encoded_addr, hw_encoded_addr;
  1365. struct tok_info *ti;
  1366. unsigned char init_status; /*BMS 12/2000*/
  1367. ti = (struct tok_info *) dev->priv;
  1368. ti->do_tok_int = NOT_FIRST;
  1369. /* we assign the shared-ram address for ISA devices */
  1370. writeb(ti->sram_base, ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN);
  1371. #ifndef PCMCIA
  1372. ti->sram_virt = ioremap(((__u32)ti->sram_base << 12), ti->avail_shared_ram);
  1373. #endif
  1374. ti->init_srb = map_address(ti,
  1375. ntohs(readw(ti->mmio + ACA_OFFSET + WRBR_EVEN)),
  1376. &ti->init_srb_page);
  1377. if (ti->page_mask && ti->avail_shared_ram == 127) {
  1378. void __iomem *last_512;
  1379. __u8 last_512_page=0;
  1380. int i;
  1381. last_512 = map_address(ti, 0xfe00, &last_512_page);
  1382. /* initialize high section of ram (if necessary) */
  1383. SET_PAGE(last_512_page);
  1384. for (i = 0; i < 512; i++)
  1385. writeb(0, last_512 + i);
  1386. }
  1387. SET_PAGE(ti->init_srb_page);
  1388. #if TR_VERBOSE
  1389. {
  1390. int i;
  1391. DPRINTK("ti->init_srb_page=0x%x\n", ti->init_srb_page);
  1392. DPRINTK("init_srb(%p):", ti->init_srb );
  1393. for (i = 0; i < 20; i++)
  1394. printk("%02X ", (int) readb(ti->init_srb + i));
  1395. printk("\n");
  1396. }
  1397. #endif
  1398. hw_encoded_addr = readw(ti->init_srb + ENCODED_ADDRESS_OFST);
  1399. encoded_addr = ntohs(hw_encoded_addr);
  1400. init_status= /*BMS 12/2000 check for shallow mode possibility (Turbo)*/
  1401. readb(ti->init_srb+offsetof(struct srb_init_response,init_status));
  1402. /*printk("Initial interrupt: init_status= 0x%02x\n",init_status);*/
  1403. ti->ring_speed = init_status & 0x01 ? 16 : 4;
  1404. DPRINTK("Initial interrupt : %d Mbps, shared RAM base %08x.\n",
  1405. ti->ring_speed, (unsigned int)dev->mem_start);
  1406. ti->auto_speedsave=readb(ti->init_srb+INIT_STATUS_2_OFST)&4?TRUE:FALSE;
  1407. if (ti->open_mode == MANUAL) wake_up(&ti->wait_for_reset);
  1408. else tok_open_adapter((unsigned long)dev);
  1409. } /*initial_tok_int() */
  1410. /*****************************************************************************/
  1411. #define CMD_CORRELATE_OFST 1
  1412. #define DHB_ADDRESS_OFST 6
  1413. #define FRAME_LENGTH_OFST 6
  1414. #define HEADER_LENGTH_OFST 8
  1415. #define RSAP_VALUE_OFST 9
  1416. static void tr_tx(struct net_device *dev)
  1417. {
  1418. struct tok_info *ti = (struct tok_info *) dev->priv;
  1419. struct trh_hdr *trhdr = (struct trh_hdr *) ti->current_skb->data;
  1420. unsigned int hdr_len;
  1421. __u32 dhb=0,dhb_base;
  1422. void __iomem *dhbuf = NULL;
  1423. unsigned char xmit_command;
  1424. int i,dhb_len=0x4000,src_len,src_offset;
  1425. struct trllc *llc;
  1426. struct srb_xmit xsrb;
  1427. __u8 dhb_page = 0;
  1428. __u8 llc_ssap;
  1429. SET_PAGE(ti->asb_page);
  1430. if (readb(ti->asb+RETCODE_OFST) != 0xFF) DPRINTK("ASB not free !!!\n");
  1431. /* in providing the transmit interrupts, is telling us it is ready for
  1432. data and providing a shared memory address for us to stuff with data.
  1433. Here we compute the effective address where we will place data.
  1434. */
  1435. SET_PAGE(ti->arb_page);
  1436. dhb=dhb_base=ntohs(readw(ti->arb + DHB_ADDRESS_OFST));
  1437. if (ti->page_mask) {
  1438. dhb_page = (dhb_base >> 8) & ti->page_mask;
  1439. dhb=dhb_base & ~(ti->page_mask << 8);
  1440. }
  1441. dhbuf = ti->sram_virt + dhb;
  1442. /* Figure out the size of the 802.5 header */
  1443. if (!(trhdr->saddr[0] & 0x80)) /* RIF present? */
  1444. hdr_len = sizeof(struct trh_hdr) - TR_MAXRIFLEN;
  1445. else
  1446. hdr_len = ((ntohs(trhdr->rcf) & TR_RCF_LEN_MASK) >> 8)
  1447. + sizeof(struct trh_hdr) - TR_MAXRIFLEN;
  1448. llc = (struct trllc *) (ti->current_skb->data + hdr_len);
  1449. llc_ssap = llc->ssap;
  1450. SET_PAGE(ti->srb_page);
  1451. memcpy_fromio(&xsrb, ti->srb, sizeof(xsrb));
  1452. SET_PAGE(ti->asb_page);
  1453. xmit_command = xsrb.command;
  1454. writeb(xmit_command, ti->asb + COMMAND_OFST);
  1455. writew(xsrb.station_id, ti->asb + STATION_ID_OFST);
  1456. writeb(llc_ssap, ti->asb + RSAP_VALUE_OFST);
  1457. writeb(xsrb.cmd_corr, ti->asb + CMD_CORRELATE_OFST);
  1458. writeb(0, ti->asb + RETCODE_OFST);
  1459. if ((xmit_command == XMIT_XID_CMD) || (xmit_command == XMIT_TEST_CMD)) {
  1460. writew(htons(0x11), ti->asb + FRAME_LENGTH_OFST);
  1461. writeb(0x0e, ti->asb + HEADER_LENGTH_OFST);
  1462. SET_PAGE(dhb_page);
  1463. writeb(AC, dhbuf);
  1464. writeb(LLC_FRAME, dhbuf + 1);
  1465. for (i = 0; i < TR_ALEN; i++)
  1466. writeb((int) 0x0FF, dhbuf + i + 2);
  1467. for (i = 0; i < TR_ALEN; i++)
  1468. writeb(0, dhbuf + i + TR_ALEN + 2);
  1469. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1470. return;
  1471. }
  1472. /*
  1473. * the token ring packet is copied from sk_buff to the adapter
  1474. * buffer identified in the command data received with the interrupt.
  1475. */
  1476. writeb(hdr_len, ti->asb + HEADER_LENGTH_OFST);
  1477. writew(htons(ti->current_skb->len), ti->asb + FRAME_LENGTH_OFST);
  1478. src_len=ti->current_skb->len;
  1479. src_offset=0;
  1480. dhb=dhb_base;
  1481. while(1) {
  1482. if (ti->page_mask) {
  1483. dhb_page=(dhb >> 8) & ti->page_mask;
  1484. dhb=dhb & ~(ti->page_mask << 8);
  1485. dhb_len=0x4000-dhb; /* remaining size of this page */
  1486. }
  1487. dhbuf = ti->sram_virt + dhb;
  1488. SET_PAGE(dhb_page);
  1489. if (src_len > dhb_len) {
  1490. memcpy_toio(dhbuf,&ti->current_skb->data[src_offset],
  1491. dhb_len);
  1492. src_len -= dhb_len;
  1493. src_offset += dhb_len;
  1494. dhb_base+=dhb_len;
  1495. dhb=dhb_base;
  1496. continue;
  1497. }
  1498. memcpy_toio(dhbuf, &ti->current_skb->data[src_offset], src_len);
  1499. break;
  1500. }
  1501. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1502. ti->tr_stats.tx_bytes += ti->current_skb->len;
  1503. dev_kfree_skb_irq(ti->current_skb);
  1504. ti->current_skb = NULL;
  1505. netif_wake_queue(dev);
  1506. if (ti->readlog_pending)
  1507. ibmtr_readlog(dev);
  1508. } /*tr_tx */
  1509. /*****************************************************************************/
  1510. #define RECEIVE_BUFFER_OFST 6
  1511. #define LAN_HDR_LENGTH_OFST 8
  1512. #define DLC_HDR_LENGTH_OFST 9
  1513. #define DSAP_OFST 0
  1514. #define SSAP_OFST 1
  1515. #define LLC_OFST 2
  1516. #define PROTID_OFST 3
  1517. #define ETHERTYPE_OFST 6
  1518. static void tr_rx(struct net_device *dev)
  1519. {
  1520. struct tok_info *ti = (struct tok_info *) dev->priv;
  1521. __u32 rbuffer;
  1522. void __iomem *rbuf, *rbufdata, *llc;
  1523. __u8 rbuffer_page = 0;
  1524. unsigned char *data;
  1525. unsigned int rbuffer_len, lan_hdr_len, hdr_len, ip_len, length;
  1526. unsigned char dlc_hdr_len;
  1527. struct sk_buff *skb;
  1528. unsigned int skb_size = 0;
  1529. int IPv4_p = 0;
  1530. unsigned int chksum = 0;
  1531. struct iphdr *iph;
  1532. struct arb_rec_req rarb;
  1533. SET_PAGE(ti->arb_page);
  1534. memcpy_fromio(&rarb, ti->arb, sizeof(rarb));
  1535. rbuffer = ntohs(rarb.rec_buf_addr) ;
  1536. rbuf = map_address(ti, rbuffer, &rbuffer_page);
  1537. SET_PAGE(ti->asb_page);
  1538. if (readb(ti->asb + RETCODE_OFST) !=0xFF) DPRINTK("ASB not free !!!\n");
  1539. writeb(REC_DATA, ti->asb + COMMAND_OFST);
  1540. writew(rarb.station_id, ti->asb + STATION_ID_OFST);
  1541. writew(rarb.rec_buf_addr, ti->asb + RECEIVE_BUFFER_OFST);
  1542. lan_hdr_len = rarb.lan_hdr_len;
  1543. if (lan_hdr_len > sizeof(struct trh_hdr)) {
  1544. DPRINTK("Linux cannot handle greater than 18 bytes RIF\n");
  1545. return;
  1546. } /*BMS I added this above just to be very safe */
  1547. dlc_hdr_len = readb(ti->arb + DLC_HDR_LENGTH_OFST);
  1548. hdr_len = lan_hdr_len + sizeof(struct trllc) + sizeof(struct iphdr);
  1549. SET_PAGE(rbuffer_page);
  1550. llc = rbuf + offsetof(struct rec_buf, data) + lan_hdr_len;
  1551. #if TR_VERBOSE
  1552. DPRINTK("offsetof data: %02X lan_hdr_len: %02X\n",
  1553. (__u32) offsetof(struct rec_buf, data), (unsigned int) lan_hdr_len);
  1554. DPRINTK("llc: %08X rec_buf_addr: %04X dev->mem_start: %lX\n",
  1555. llc, ntohs(rarb.rec_buf_addr), dev->mem_start);
  1556. DPRINTK("dsap: %02X, ssap: %02X, llc: %02X, protid: %02X%02X%02X, "
  1557. "ethertype: %04X\n",
  1558. (int) readb(llc + DSAP_OFST), (int) readb(llc + SSAP_OFST),
  1559. (int) readb(llc + LLC_OFST), (int) readb(llc + PROTID_OFST),
  1560. (int) readb(llc+PROTID_OFST+1),(int)readb(llc+PROTID_OFST + 2),
  1561. (int) ntohs(readw(llc + ETHERTYPE_OFST)));
  1562. #endif
  1563. if (readb(llc + offsetof(struct trllc, llc)) != UI_CMD) {
  1564. SET_PAGE(ti->asb_page);
  1565. writeb(DATA_LOST, ti->asb + RETCODE_OFST);
  1566. ti->tr_stats.rx_dropped++;
  1567. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1568. return;
  1569. }
  1570. length = ntohs(rarb.frame_len);
  1571. if (readb(llc + DSAP_OFST) == EXTENDED_SAP &&
  1572. readb(llc + SSAP_OFST) == EXTENDED_SAP &&
  1573. length >= hdr_len) IPv4_p = 1;
  1574. #if TR_VERBOSE
  1575. #define SADDR_OFST 8
  1576. #define DADDR_OFST 2
  1577. if (!IPv4_p) {
  1578. void __iomem *trhhdr = rbuf + offsetof(struct rec_buf, data);
  1579. DPRINTK("Probably non-IP frame received.\n");
  1580. DPRINTK("ssap: %02X dsap: %02X "
  1581. "saddr: %02X:%02X:%02X:%02X:%02X:%02X "
  1582. "daddr: %02X:%02X:%02X:%02X:%02X:%02X\n",
  1583. readb(llc + SSAP_OFST), readb(llc + DSAP_OFST),
  1584. readb(trhhdr+SADDR_OFST), readb(trhhdr+ SADDR_OFST+1),
  1585. readb(trhhdr+SADDR_OFST+2), readb(trhhdr+SADDR_OFST+3),
  1586. readb(trhhdr+SADDR_OFST+4), readb(trhhdr+SADDR_OFST+5),
  1587. readb(trhhdr+DADDR_OFST), readb(trhhdr+DADDR_OFST + 1),
  1588. readb(trhhdr+DADDR_OFST+2), readb(trhhdr+DADDR_OFST+3),
  1589. readb(trhhdr+DADDR_OFST+4), readb(trhhdr+DADDR_OFST+5));
  1590. }
  1591. #endif
  1592. /*BMS handle the case she comes in with few hops but leaves with many */
  1593. skb_size=length-lan_hdr_len+sizeof(struct trh_hdr)+sizeof(struct trllc);
  1594. if (!(skb = dev_alloc_skb(skb_size))) {
  1595. DPRINTK("out of memory. frame dropped.\n");
  1596. ti->tr_stats.rx_dropped++;
  1597. SET_PAGE(ti->asb_page);
  1598. writeb(DATA_LOST, ti->asb + offsetof(struct asb_rec, ret_code));
  1599. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1600. return;
  1601. }
  1602. /*BMS again, if she comes in with few but leaves with many */
  1603. skb_reserve(skb, sizeof(struct trh_hdr) - lan_hdr_len);
  1604. skb_put(skb, length);
  1605. skb->dev = dev;
  1606. data = skb->data;
  1607. rbuffer_len = ntohs(readw(rbuf + offsetof(struct rec_buf, buf_len)));
  1608. rbufdata = rbuf + offsetof(struct rec_buf, data);
  1609. if (IPv4_p) {
  1610. /* Copy the headers without checksumming */
  1611. memcpy_fromio(data, rbufdata, hdr_len);
  1612. /* Watch for padded packets and bogons */
  1613. iph= (struct iphdr *)(data+ lan_hdr_len + sizeof(struct trllc));
  1614. ip_len = ntohs(iph->tot_len) - sizeof(struct iphdr);
  1615. length -= hdr_len;
  1616. if ((ip_len <= length) && (ip_len > 7))
  1617. length = ip_len;
  1618. data += hdr_len;
  1619. rbuffer_len -= hdr_len;
  1620. rbufdata += hdr_len;
  1621. }
  1622. /* Copy the payload... */
  1623. #define BUFFER_POINTER_OFST 2
  1624. #define BUFFER_LENGTH_OFST 6
  1625. for (;;) {
  1626. if (ibmtr_debug_trace&TRC_INITV && length < rbuffer_len)
  1627. DPRINTK("CURIOUS, length=%d < rbuffer_len=%d\n",
  1628. length,rbuffer_len);
  1629. if (IPv4_p)
  1630. chksum=csum_partial_copy_nocheck((void*)rbufdata,
  1631. data,length<rbuffer_len?length:rbuffer_len,chksum);
  1632. else
  1633. memcpy_fromio(data, rbufdata, rbuffer_len);
  1634. rbuffer = ntohs(readw(rbuf+BUFFER_POINTER_OFST)) ;
  1635. if (!rbuffer)
  1636. break;
  1637. rbuffer -= 2;
  1638. length -= rbuffer_len;
  1639. data += rbuffer_len;
  1640. rbuf = map_address(ti, rbuffer, &rbuffer_page);
  1641. SET_PAGE(rbuffer_page);
  1642. rbuffer_len = ntohs(readw(rbuf + BUFFER_LENGTH_OFST));
  1643. rbufdata = rbuf + offsetof(struct rec_buf, data);
  1644. }
  1645. SET_PAGE(ti->asb_page);
  1646. writeb(0, ti->asb + offsetof(struct asb_rec, ret_code));
  1647. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1648. ti->tr_stats.rx_bytes += skb->len;
  1649. ti->tr_stats.rx_packets++;
  1650. skb->protocol = tr_type_trans(skb, dev);
  1651. if (IPv4_p) {
  1652. skb->csum = chksum;
  1653. skb->ip_summed = 1;
  1654. }
  1655. netif_rx(skb);
  1656. dev->last_rx = jiffies;
  1657. } /*tr_rx */
  1658. /*****************************************************************************/
  1659. static void ibmtr_reset_timer(struct timer_list *tmr, struct net_device *dev)
  1660. {
  1661. tmr->expires = jiffies + TR_RETRY_INTERVAL;
  1662. tmr->data = (unsigned long) dev;
  1663. tmr->function = tok_rerun;
  1664. init_timer(tmr);
  1665. add_timer(tmr);
  1666. }
  1667. /*****************************************************************************/
  1668. void tok_rerun(unsigned long dev_addr){
  1669. struct net_device *dev = (struct net_device *)dev_addr;
  1670. struct tok_info *ti = (struct tok_info *) dev->priv;
  1671. if ( ti->open_action == RESTART){
  1672. ti->do_tok_int = FIRST_INT;
  1673. outb(0, dev->base_addr + ADAPTRESETREL);
  1674. #ifdef ENABLE_PAGING
  1675. if (ti->page_mask)
  1676. writeb(SRPR_ENABLE_PAGING,
  1677. ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1678. #endif
  1679. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1680. } else
  1681. tok_open_adapter(dev_addr);
  1682. }
  1683. /*****************************************************************************/
  1684. static void ibmtr_readlog(struct net_device *dev)
  1685. {
  1686. struct tok_info *ti;
  1687. ti = (struct tok_info *) dev->priv;
  1688. ti->readlog_pending = 0;
  1689. SET_PAGE(ti->srb_page);
  1690. writeb(DIR_READ_LOG, ti->srb);
  1691. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1692. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1693. netif_stop_queue(dev);
  1694. }
  1695. /*****************************************************************************/
  1696. /* tok_get_stats(): Basically a scaffold routine which will return
  1697. the address of the tr_statistics structure associated with
  1698. this device -- the tr.... structure is an ethnet look-alike
  1699. so at least for this iteration may suffice. */
  1700. static struct net_device_stats *tok_get_stats(struct net_device *dev)
  1701. {
  1702. struct tok_info *toki;
  1703. toki = (struct tok_info *) dev->priv;
  1704. return (struct net_device_stats *) &toki->tr_stats;
  1705. }
  1706. /*****************************************************************************/
  1707. static int ibmtr_change_mtu(struct net_device *dev, int mtu)
  1708. {
  1709. struct tok_info *ti = (struct tok_info *) dev->priv;
  1710. if (ti->ring_speed == 16 && mtu > ti->maxmtu16)
  1711. return -EINVAL;
  1712. if (ti->ring_speed == 4 && mtu > ti->maxmtu4)
  1713. return -EINVAL;
  1714. dev->mtu = mtu;
  1715. return 0;
  1716. }
  1717. /*****************************************************************************/
  1718. #ifdef MODULE
  1719. /* 3COM 3C619C supports 8 interrupts, 32 I/O ports */
  1720. static struct net_device *dev_ibmtr[IBMTR_MAX_ADAPTERS];
  1721. static int io[IBMTR_MAX_ADAPTERS] = { 0xa20, 0xa24 };
  1722. static int irq[IBMTR_MAX_ADAPTERS];
  1723. static int mem[IBMTR_MAX_ADAPTERS];
  1724. MODULE_LICENSE("GPL");
  1725. module_param_array(io, int, NULL, 0);
  1726. module_param_array(irq, int, NULL, 0);
  1727. module_param_array(mem, int, NULL, 0);
  1728. static int __init ibmtr_init(void)
  1729. {
  1730. int i;
  1731. int count=0;
  1732. find_turbo_adapters(io);
  1733. for (i = 0; io[i] && (i < IBMTR_MAX_ADAPTERS); i++) {
  1734. struct net_device *dev;
  1735. irq[i] = 0;
  1736. mem[i] = 0;
  1737. dev = alloc_trdev(sizeof(struct tok_info));
  1738. if (dev == NULL) {
  1739. if (i == 0)
  1740. return -ENOMEM;
  1741. break;
  1742. }
  1743. dev->base_addr = io[i];
  1744. dev->irq = irq[i];
  1745. dev->mem_start = mem[i];
  1746. if (ibmtr_probe_card(dev)) {
  1747. free_netdev(dev);
  1748. continue;
  1749. }
  1750. dev_ibmtr[i] = dev;
  1751. count++;
  1752. }
  1753. if (count) return 0;
  1754. printk("ibmtr: register_netdev() returned non-zero.\n");
  1755. return -EIO;
  1756. }
  1757. module_init(ibmtr_init);
  1758. static void __exit ibmtr_cleanup(void)
  1759. {
  1760. int i;
  1761. for (i = 0; i < IBMTR_MAX_ADAPTERS; i++){
  1762. if (!dev_ibmtr[i])
  1763. continue;
  1764. unregister_netdev(dev_ibmtr[i]);
  1765. ibmtr_cleanup_card(dev_ibmtr[i]);
  1766. free_netdev(dev_ibmtr[i]);
  1767. }
  1768. }
  1769. module_exit(ibmtr_cleanup);
  1770. #endif