ibmtr.c 63 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987
  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. 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. 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. 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. 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. 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. void ibmtr_reset_timer(struct timer_list*tmr,struct net_device *dev);
  186. static void tok_rerun(unsigned long dev_addr);
  187. void ibmtr_readlog(struct net_device *dev);
  188. static struct net_device_stats *tok_get_stats(struct net_device *dev);
  189. 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(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. kfree(ti);
  488. return -ENODEV;
  489. }
  490. ti->sram_phys =
  491. ((__u32)readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_EVEN)<<12);
  492. ti->adapter_int_enable = PIOaddr + ADAPTINTREL;
  493. break;
  494. } /*end switch (cardpresent) */
  495. #endif /*not PCMCIA */
  496. if (ibmtr_debug_trace & TRC_INIT) { /* just report int */
  497. DPRINTK("irq=%d", irq);
  498. printk(", sram_phys=0x%x", ti->sram_phys);
  499. if(ibmtr_debug_trace&TRC_INITV){ /* full chat in verbose only */
  500. DPRINTK(", ti->mmio=%p", ti->mmio);
  501. printk(", segment=%02X", segment);
  502. }
  503. printk(".\n");
  504. }
  505. /* Get hw address of token ring card */
  506. j = 0;
  507. for (i = 0; i < 0x18; i = i + 2) {
  508. /* technical reference states to do this */
  509. temp = readb(ti->mmio + AIP + i) & 0x0f;
  510. ti->hw_address[j] = temp;
  511. if (j & 1)
  512. dev->dev_addr[(j / 2)] =
  513. ti->hw_address[j]+ (ti->hw_address[j - 1] << 4);
  514. ++j;
  515. }
  516. /* get Adapter type: 'F' = Adapter/A, 'E' = 16/4 Adapter II,... */
  517. ti->adapter_type = readb(ti->mmio + AIPADAPTYPE);
  518. /* get Data Rate: F=4Mb, E=16Mb, D=4Mb & 16Mb ?? */
  519. ti->data_rate = readb(ti->mmio + AIPDATARATE);
  520. /* Get Early Token Release support?: F=no, E=4Mb, D=16Mb, C=4&16Mb */
  521. ti->token_release = readb(ti->mmio + AIPEARLYTOKEN);
  522. /* How much shared RAM is on adapter ? */
  523. if (ti->turbo) {
  524. ti->avail_shared_ram=127;
  525. } else {
  526. ti->avail_shared_ram = get_sram_size(ti);/*in 512 byte units */
  527. }
  528. /* We need to set or do a bunch of work here based on previous results*/
  529. /* Support paging? What sizes?: F=no, E=16k, D=32k, C=16 & 32k */
  530. ti->shared_ram_paging = readb(ti->mmio + AIPSHRAMPAGE);
  531. /* Available DHB 4Mb size: F=2048, E=4096, D=4464 */
  532. switch (readb(ti->mmio + AIP4MBDHB)) {
  533. case 0xe: ti->dhb_size4mb = 4096; break;
  534. case 0xd: ti->dhb_size4mb = 4464; break;
  535. default: ti->dhb_size4mb = 2048; break;
  536. }
  537. /* Available DHB 16Mb size: F=2048, E=4096, D=8192, C=16384, B=17960 */
  538. switch (readb(ti->mmio + AIP16MBDHB)) {
  539. case 0xe: ti->dhb_size16mb = 4096; break;
  540. case 0xd: ti->dhb_size16mb = 8192; break;
  541. case 0xc: ti->dhb_size16mb = 16384; break;
  542. case 0xb: ti->dhb_size16mb = 17960; break;
  543. default: ti->dhb_size16mb = 2048; break;
  544. }
  545. /* We must figure out how much shared memory space this adapter
  546. * will occupy so that if there are two adapters we can fit both
  547. * in. Given a choice, we will limit this adapter to 32K. The
  548. * maximum space will will use for two adapters is 64K so if the
  549. * adapter we are working on demands 64K (it also doesn't support
  550. * paging), then only one adapter can be supported.
  551. */
  552. /*
  553. * determine how much of total RAM is mapped into PC space
  554. */
  555. ti->mapped_ram_size= /*sixteen to onehundredtwentyeight 512byte blocks*/
  556. 1<< ((readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_ODD) >> 2 & 0x03) + 4);
  557. ti->page_mask = 0;
  558. if (ti->turbo) ti->page_mask=0xf0;
  559. else if (ti->shared_ram_paging == 0xf); /* No paging in adapter */
  560. else {
  561. #ifdef ENABLE_PAGING
  562. unsigned char pg_size = 0;
  563. /* BMS: page size: PCMCIA, use configuration register;
  564. ISAPNP, use LANAIDC config tool from www.ibm.com */
  565. switch (ti->shared_ram_paging) {
  566. case 0xf:
  567. break;
  568. case 0xe:
  569. ti->page_mask = (ti->mapped_ram_size == 32) ? 0xc0 : 0;
  570. pg_size = 32; /* 16KB page size */
  571. break;
  572. case 0xd:
  573. ti->page_mask = (ti->mapped_ram_size == 64) ? 0x80 : 0;
  574. pg_size = 64; /* 32KB page size */
  575. break;
  576. case 0xc:
  577. switch (ti->mapped_ram_size) {
  578. case 32:
  579. ti->page_mask = 0xc0;
  580. pg_size = 32;
  581. break;
  582. case 64:
  583. ti->page_mask = 0x80;
  584. pg_size = 64;
  585. break;
  586. }
  587. break;
  588. default:
  589. DPRINTK("Unknown shared ram paging info %01X\n",
  590. ti->shared_ram_paging);
  591. iounmap(t_mmio);
  592. kfree(ti);
  593. return -ENODEV;
  594. break;
  595. } /*end switch shared_ram_paging */
  596. if (ibmtr_debug_trace & TRC_INIT)
  597. DPRINTK("Shared RAM paging code: %02X, "
  598. "mapped RAM size: %dK, shared RAM size: %dK, "
  599. "page mask: %02X\n:",
  600. ti->shared_ram_paging, ti->mapped_ram_size / 2,
  601. ti->avail_shared_ram / 2, ti->page_mask);
  602. #endif /*ENABLE_PAGING */
  603. }
  604. #ifndef PCMCIA
  605. /* finish figuring the shared RAM address */
  606. if (cardpresent == TR_ISA) {
  607. static __u32 ram_bndry_mask[] =
  608. { 0xffffe000, 0xffffc000, 0xffff8000, 0xffff0000 };
  609. __u32 new_base, rrr_32, chk_base, rbm;
  610. rrr_32=readb(ti->mmio+ACA_OFFSET+ACA_RW+RRR_ODD) >> 2 & 0x03;
  611. rbm = ram_bndry_mask[rrr_32];
  612. new_base = (ibmtr_mem_base + (~rbm)) & rbm;/* up to boundary */
  613. chk_base = new_base + (ti->mapped_ram_size << 9);
  614. if (chk_base > (ibmtr_mem_base + IBMTR_SHARED_RAM_SIZE)) {
  615. DPRINTK("Shared RAM for this adapter (%05x) exceeds "
  616. "driver limit (%05x), adapter not started.\n",
  617. chk_base, ibmtr_mem_base + IBMTR_SHARED_RAM_SIZE);
  618. iounmap(t_mmio);
  619. kfree(ti);
  620. return -ENODEV;
  621. } else { /* seems cool, record what we have figured out */
  622. ti->sram_base = new_base >> 12;
  623. ibmtr_mem_base = chk_base;
  624. }
  625. }
  626. else ti->sram_base = ti->sram_phys >> 12;
  627. /* The PCMCIA has already got the interrupt line and the io port,
  628. so no chance of anybody else getting it - MLP */
  629. if (request_irq(dev->irq = irq, &tok_interrupt, 0, "ibmtr", dev) != 0) {
  630. DPRINTK("Could not grab irq %d. Halting Token Ring driver.\n",
  631. irq);
  632. iounmap(t_mmio);
  633. kfree(ti);
  634. return -ENODEV;
  635. }
  636. /*?? Now, allocate some of the PIO PORTs for this driver.. */
  637. /* record PIOaddr range as busy */
  638. if (!request_region(PIOaddr, IBMTR_IO_EXTENT, "ibmtr")) {
  639. DPRINTK("Could not grab PIO range. Halting driver.\n");
  640. free_irq(dev->irq, dev);
  641. iounmap(t_mmio);
  642. kfree(ti);
  643. return -EBUSY;
  644. }
  645. if (!version_printed++) {
  646. printk(version);
  647. }
  648. #endif /* !PCMCIA */
  649. DPRINTK("%s %s found\n",
  650. channel_def[cardpresent - 1], adapter_def(ti->adapter_type));
  651. DPRINTK("using irq %d, PIOaddr %hx, %dK shared RAM.\n",
  652. irq, PIOaddr, ti->mapped_ram_size / 2);
  653. DPRINTK("Hardware address : %02X:%02X:%02X:%02X:%02X:%02X\n",
  654. dev->dev_addr[0], dev->dev_addr[1], dev->dev_addr[2],
  655. dev->dev_addr[3], dev->dev_addr[4], dev->dev_addr[5]);
  656. if (ti->page_mask)
  657. DPRINTK("Shared RAM paging enabled. "
  658. "Page size: %uK Shared Ram size %dK\n",
  659. ((ti->page_mask^0xff)+1) >>2, ti->avail_shared_ram / 2);
  660. else
  661. DPRINTK("Shared RAM paging disabled. ti->page_mask %x\n",
  662. ti->page_mask);
  663. /* Calculate the maximum DHB we can use */
  664. /* two cases where avail_shared_ram doesn't equal mapped_ram_size:
  665. 1. avail_shared_ram is 127 but mapped_ram_size is 128 (typical)
  666. 2. user has configured adapter for less than avail_shared_ram
  667. but is not using paging (she should use paging, I believe)
  668. */
  669. if (!ti->page_mask) {
  670. ti->avail_shared_ram=
  671. min(ti->mapped_ram_size,ti->avail_shared_ram);
  672. }
  673. switch (ti->avail_shared_ram) {
  674. case 16: /* 8KB shared RAM */
  675. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)2048);
  676. ti->rbuf_len4 = 1032;
  677. ti->rbuf_cnt4=2;
  678. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)2048);
  679. ti->rbuf_len16 = 1032;
  680. ti->rbuf_cnt16=2;
  681. break;
  682. case 32: /* 16KB shared RAM */
  683. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  684. ti->rbuf_len4 = 1032;
  685. ti->rbuf_cnt4=4;
  686. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)4096);
  687. ti->rbuf_len16 = 1032; /*1024 usable */
  688. ti->rbuf_cnt16=4;
  689. break;
  690. case 64: /* 32KB shared RAM */
  691. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  692. ti->rbuf_len4 = 1032;
  693. ti->rbuf_cnt4=6;
  694. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)10240);
  695. ti->rbuf_len16 = 1032;
  696. ti->rbuf_cnt16=6;
  697. break;
  698. case 127: /* 63.5KB shared RAM */
  699. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  700. ti->rbuf_len4 = 1032;
  701. ti->rbuf_cnt4=6;
  702. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)16384);
  703. ti->rbuf_len16 = 1032;
  704. ti->rbuf_cnt16=16;
  705. break;
  706. case 128: /* 64KB shared RAM */
  707. ti->dhb_size4mb = min(ti->dhb_size4mb, (unsigned short)4464);
  708. ti->rbuf_len4 = 1032;
  709. ti->rbuf_cnt4=6;
  710. ti->dhb_size16mb = min(ti->dhb_size16mb, (unsigned short)17960);
  711. ti->rbuf_len16 = 1032;
  712. ti->rbuf_cnt16=16;
  713. break;
  714. default:
  715. ti->dhb_size4mb = 2048;
  716. ti->rbuf_len4 = 1032;
  717. ti->rbuf_cnt4=2;
  718. ti->dhb_size16mb = 2048;
  719. ti->rbuf_len16 = 1032;
  720. ti->rbuf_cnt16=2;
  721. break;
  722. }
  723. /* this formula is not smart enough for the paging case
  724. ti->rbuf_cnt<x> = (ti->avail_shared_ram * BLOCKSZ - ADAPT_PRIVATE -
  725. ARBLENGTH - SSBLENGTH - DLC_MAX_SAP * SAPLENGTH -
  726. DLC_MAX_STA * STALENGTH - ti->dhb_size<x>mb * NUM_DHB -
  727. SRBLENGTH - ASBLENGTH) / ti->rbuf_len<x>;
  728. */
  729. ti->maxmtu16 = (ti->rbuf_len16 - 8) * ti->rbuf_cnt16 - TR_HLEN;
  730. ti->maxmtu4 = (ti->rbuf_len4 - 8) * ti->rbuf_cnt4 - TR_HLEN;
  731. /*BMS assuming 18 bytes of Routing Information (usually works) */
  732. DPRINTK("Maximum Receive Internet Protocol MTU 16Mbps: %d, 4Mbps: %d\n",
  733. ti->maxmtu16, ti->maxmtu4);
  734. dev->base_addr = PIOaddr; /* set the value for device */
  735. dev->mem_start = ti->sram_base << 12;
  736. dev->mem_end = dev->mem_start + (ti->mapped_ram_size << 9) - 1;
  737. trdev_init(dev);
  738. return 0; /* Return 0 to indicate we have found a Token Ring card. */
  739. } /*ibmtr_probe1() */
  740. /*****************************************************************************/
  741. /* query the adapter for the size of shared RAM */
  742. /* the function returns the RAM size in units of 512 bytes */
  743. static unsigned char __devinit get_sram_size(struct tok_info *adapt_info)
  744. {
  745. unsigned char avail_sram_code;
  746. static unsigned char size_code[] = { 0, 16, 32, 64, 127, 128 };
  747. /* Adapter gives
  748. 'F' -- use RRR bits 3,2
  749. 'E' -- 8kb 'D' -- 16kb
  750. 'C' -- 32kb 'A' -- 64KB
  751. 'B' - 64KB less 512 bytes at top
  752. (WARNING ... must zero top bytes in INIT */
  753. avail_sram_code = 0xf - readb(adapt_info->mmio + AIPAVAILSHRAM);
  754. if (avail_sram_code) return size_code[avail_sram_code];
  755. else /* for code 'F', must compute size from RRR(3,2) bits */
  756. return 1 <<
  757. ((readb(adapt_info->mmio+ACA_OFFSET+ACA_RW+RRR_ODD)>>2&3)+4);
  758. }
  759. /*****************************************************************************/
  760. static int __devinit trdev_init(struct net_device *dev)
  761. {
  762. struct tok_info *ti = (struct tok_info *) dev->priv;
  763. SET_PAGE(ti->srb_page);
  764. ti->open_failure = NO ;
  765. dev->open = tok_open;
  766. dev->stop = tok_close;
  767. dev->hard_start_xmit = tok_send_packet;
  768. dev->get_stats = tok_get_stats;
  769. dev->set_multicast_list = tok_set_multicast_list;
  770. dev->change_mtu = ibmtr_change_mtu;
  771. return 0;
  772. }
  773. /*****************************************************************************/
  774. static int tok_init_card(struct net_device *dev)
  775. {
  776. struct tok_info *ti;
  777. short PIOaddr;
  778. unsigned long i;
  779. PIOaddr = dev->base_addr;
  780. ti = (struct tok_info *) dev->priv;
  781. /* Special processing for first interrupt after reset */
  782. ti->do_tok_int = FIRST_INT;
  783. /* Reset adapter */
  784. writeb(~INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  785. outb(0, PIOaddr + ADAPTRESET);
  786. current->state=TASK_UNINTERRUPTIBLE;
  787. schedule_timeout(TR_RST_TIME); /* wait 50ms */
  788. outb(0, PIOaddr + ADAPTRESETREL);
  789. #ifdef ENABLE_PAGING
  790. if (ti->page_mask)
  791. writeb(SRPR_ENABLE_PAGING,ti->mmio+ACA_OFFSET+ACA_RW+SRPR_EVEN);
  792. #endif
  793. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  794. i = sleep_on_timeout(&ti->wait_for_reset, 4 * HZ);
  795. return i? 0 : -EAGAIN;
  796. }
  797. /*****************************************************************************/
  798. static int tok_open(struct net_device *dev)
  799. {
  800. struct tok_info *ti = (struct tok_info *) dev->priv;
  801. int i;
  802. /*the case we were left in a failure state during a previous open */
  803. if (ti->open_failure == YES) {
  804. DPRINTK("Last time you were disconnected, how about now?\n");
  805. printk("You can't insert with an ICS connector half-cocked.\n");
  806. }
  807. ti->open_status = CLOSED; /* CLOSED or OPEN */
  808. ti->sap_status = CLOSED; /* CLOSED or OPEN */
  809. ti->open_failure = NO; /* NO or YES */
  810. ti->open_mode = MANUAL; /* MANUAL or AUTOMATIC */
  811. /* 12/2000 not typical Linux, but we can use RUNNING to let us know when
  812. the network has crapped out or cables are disconnected. Useful because
  813. the IFF_UP flag stays up the whole time, until ifconfig tr0 down.
  814. */
  815. dev->flags &= ~IFF_RUNNING;
  816. ti->sram_phys &= ~1; /* to reverse what we do in tok_close */
  817. /* init the spinlock */
  818. spin_lock_init(&ti->lock);
  819. init_timer(&ti->tr_timer);
  820. i = tok_init_card(dev);
  821. if (i) return i;
  822. while (1){
  823. tok_open_adapter((unsigned long) dev);
  824. i= interruptible_sleep_on_timeout(&ti->wait_for_reset, 25 * HZ);
  825. /* sig catch: estimate opening adapter takes more than .5 sec*/
  826. if (i>(245*HZ)/10) break; /* fancier than if (i==25*HZ) */
  827. if (i==0) break;
  828. if (ti->open_status == OPEN && ti->sap_status==OPEN) {
  829. netif_start_queue(dev);
  830. DPRINTK("Adapter is up and running\n");
  831. return 0;
  832. }
  833. current->state=TASK_INTERRUPTIBLE;
  834. i=schedule_timeout(TR_RETRY_INTERVAL); /* wait 30 seconds */
  835. if(i!=0) break; /*prob. a signal, like the i>24*HZ case above */
  836. }
  837. outb(0, dev->base_addr + ADAPTRESET);/* kill pending interrupts*/
  838. DPRINTK("TERMINATED via signal\n"); /*BMS useful */
  839. return -EAGAIN;
  840. }
  841. /*****************************************************************************/
  842. #define COMMAND_OFST 0
  843. #define OPEN_OPTIONS_OFST 8
  844. #define NUM_RCV_BUF_OFST 24
  845. #define RCV_BUF_LEN_OFST 26
  846. #define DHB_LENGTH_OFST 28
  847. #define NUM_DHB_OFST 30
  848. #define DLC_MAX_SAP_OFST 32
  849. #define DLC_MAX_STA_OFST 33
  850. void tok_open_adapter(unsigned long dev_addr)
  851. {
  852. struct net_device *dev = (struct net_device *) dev_addr;
  853. struct tok_info *ti;
  854. int i;
  855. ti = (struct tok_info *) dev->priv;
  856. SET_PAGE(ti->init_srb_page);
  857. writeb(~SRB_RESP_INT, ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_ODD);
  858. for (i = 0; i < sizeof(struct dir_open_adapter); i++)
  859. writeb(0, ti->init_srb + i);
  860. writeb(DIR_OPEN_ADAPTER, ti->init_srb + COMMAND_OFST);
  861. writew(htons(OPEN_PASS_BCON_MAC), ti->init_srb + OPEN_OPTIONS_OFST);
  862. if (ti->ring_speed == 16) {
  863. writew(htons(ti->dhb_size16mb), ti->init_srb + DHB_LENGTH_OFST);
  864. writew(htons(ti->rbuf_cnt16), ti->init_srb + NUM_RCV_BUF_OFST);
  865. writew(htons(ti->rbuf_len16), ti->init_srb + RCV_BUF_LEN_OFST);
  866. } else {
  867. writew(htons(ti->dhb_size4mb), ti->init_srb + DHB_LENGTH_OFST);
  868. writew(htons(ti->rbuf_cnt4), ti->init_srb + NUM_RCV_BUF_OFST);
  869. writew(htons(ti->rbuf_len4), ti->init_srb + RCV_BUF_LEN_OFST);
  870. }
  871. writeb(NUM_DHB, /* always 2 */ ti->init_srb + NUM_DHB_OFST);
  872. writeb(DLC_MAX_SAP, ti->init_srb + DLC_MAX_SAP_OFST);
  873. writeb(DLC_MAX_STA, ti->init_srb + DLC_MAX_STA_OFST);
  874. ti->srb = ti->init_srb; /* We use this one in the interrupt handler */
  875. ti->srb_page = ti->init_srb_page;
  876. DPRINTK("Opening adapter: Xmit bfrs: %d X %d, Rcv bfrs: %d X %d\n",
  877. readb(ti->init_srb + NUM_DHB_OFST),
  878. ntohs(readw(ti->init_srb + DHB_LENGTH_OFST)),
  879. ntohs(readw(ti->init_srb + NUM_RCV_BUF_OFST)),
  880. ntohs(readw(ti->init_srb + RCV_BUF_LEN_OFST)));
  881. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  882. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  883. }
  884. /*****************************************************************************/
  885. static void open_sap(unsigned char type, struct net_device *dev)
  886. {
  887. int i;
  888. struct tok_info *ti = (struct tok_info *) dev->priv;
  889. SET_PAGE(ti->srb_page);
  890. for (i = 0; i < sizeof(struct dlc_open_sap); i++)
  891. writeb(0, ti->srb + i);
  892. #define MAX_I_FIELD_OFST 14
  893. #define SAP_VALUE_OFST 16
  894. #define SAP_OPTIONS_OFST 17
  895. #define STATION_COUNT_OFST 18
  896. writeb(DLC_OPEN_SAP, ti->srb + COMMAND_OFST);
  897. writew(htons(MAX_I_FIELD), ti->srb + MAX_I_FIELD_OFST);
  898. writeb(SAP_OPEN_IND_SAP | SAP_OPEN_PRIORITY, ti->srb+ SAP_OPTIONS_OFST);
  899. writeb(SAP_OPEN_STATION_CNT, ti->srb + STATION_COUNT_OFST);
  900. writeb(type, ti->srb + SAP_VALUE_OFST);
  901. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  902. }
  903. /*****************************************************************************/
  904. static void tok_set_multicast_list(struct net_device *dev)
  905. {
  906. struct tok_info *ti = (struct tok_info *) dev->priv;
  907. struct dev_mc_list *mclist;
  908. unsigned char address[4];
  909. int i;
  910. /*BMS the next line is CRUCIAL or you may be sad when you */
  911. /*BMS ifconfig tr down or hot unplug a PCMCIA card ??hownowbrowncow*/
  912. if (/*BMSHELPdev->start == 0 ||*/ ti->open_status != OPEN) return;
  913. address[0] = address[1] = address[2] = address[3] = 0;
  914. mclist = dev->mc_list;
  915. for (i = 0; i < dev->mc_count; i++) {
  916. address[0] |= mclist->dmi_addr[2];
  917. address[1] |= mclist->dmi_addr[3];
  918. address[2] |= mclist->dmi_addr[4];
  919. address[3] |= mclist->dmi_addr[5];
  920. mclist = mclist->next;
  921. }
  922. SET_PAGE(ti->srb_page);
  923. for (i = 0; i < sizeof(struct srb_set_funct_addr); i++)
  924. writeb(0, ti->srb + i);
  925. #define FUNCT_ADDRESS_OFST 6
  926. writeb(DIR_SET_FUNC_ADDR, ti->srb + COMMAND_OFST);
  927. for (i = 0; i < 4; i++)
  928. writeb(address[i], ti->srb + FUNCT_ADDRESS_OFST + i);
  929. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  930. #if TR_VERBOSE
  931. DPRINTK("Setting functional address: ");
  932. for (i=0;i<4;i++) printk("%02X ", address[i]);
  933. printk("\n");
  934. #endif
  935. }
  936. /*****************************************************************************/
  937. #define STATION_ID_OFST 4
  938. static int tok_send_packet(struct sk_buff *skb, struct net_device *dev)
  939. {
  940. struct tok_info *ti;
  941. unsigned long flags;
  942. ti = (struct tok_info *) dev->priv;
  943. netif_stop_queue(dev);
  944. /* lock against other CPUs */
  945. spin_lock_irqsave(&(ti->lock), flags);
  946. /* Save skb; we'll need it when the adapter asks for the data */
  947. ti->current_skb = skb;
  948. SET_PAGE(ti->srb_page);
  949. writeb(XMIT_UI_FRAME, ti->srb + COMMAND_OFST);
  950. writew(ti->exsap_station_id, ti->srb + STATION_ID_OFST);
  951. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  952. spin_unlock_irqrestore(&(ti->lock), flags);
  953. dev->trans_start = jiffies;
  954. return 0;
  955. }
  956. /*****************************************************************************/
  957. static int tok_close(struct net_device *dev)
  958. {
  959. struct tok_info *ti = (struct tok_info *) dev->priv;
  960. /* Important for PCMCIA hot unplug, otherwise, we'll pull the card, */
  961. /* unloading the module from memory, and then if a timer pops, ouch */
  962. del_timer_sync(&ti->tr_timer);
  963. outb(0, dev->base_addr + ADAPTRESET);
  964. ti->sram_phys |= 1;
  965. ti->open_status = CLOSED;
  966. netif_stop_queue(dev);
  967. DPRINTK("Adapter is closed.\n");
  968. return 0;
  969. }
  970. /*****************************************************************************/
  971. #define RETCODE_OFST 2
  972. #define OPEN_ERROR_CODE_OFST 6
  973. #define ASB_ADDRESS_OFST 8
  974. #define SRB_ADDRESS_OFST 10
  975. #define ARB_ADDRESS_OFST 12
  976. #define SSB_ADDRESS_OFST 14
  977. static char *printphase[]= {"Lobe media test","Physical insertion",
  978. "Address verification","Roll call poll","Request Parameters"};
  979. static char *printerror[]={"Function failure","Signal loss","Reserved",
  980. "Frequency error","Timeout","Ring failure","Ring beaconing",
  981. "Duplicate node address",
  982. "Parameter request-retry count exceeded","Remove received",
  983. "IMPL force received","Duplicate modifier",
  984. "No monitor detected","Monitor contention failed for RPL"};
  985. static void __iomem *map_address(struct tok_info *ti, unsigned index, __u8 *page)
  986. {
  987. if (ti->page_mask) {
  988. *page = (index >> 8) & ti->page_mask;
  989. index &= ~(ti->page_mask << 8);
  990. }
  991. return ti->sram_virt + index;
  992. }
  993. void dir_open_adapter (struct net_device *dev)
  994. {
  995. struct tok_info *ti = (struct tok_info *) dev->priv;
  996. unsigned char ret_code;
  997. __u16 err;
  998. ti->srb = map_address(ti,
  999. ntohs(readw(ti->init_srb + SRB_ADDRESS_OFST)),
  1000. &ti->srb_page);
  1001. ti->ssb = map_address(ti,
  1002. ntohs(readw(ti->init_srb + SSB_ADDRESS_OFST)),
  1003. &ti->ssb_page);
  1004. ti->arb = map_address(ti,
  1005. ntohs(readw(ti->init_srb + ARB_ADDRESS_OFST)),
  1006. &ti->arb_page);
  1007. ti->asb = map_address(ti,
  1008. ntohs(readw(ti->init_srb + ASB_ADDRESS_OFST)),
  1009. &ti->asb_page);
  1010. ti->current_skb = NULL;
  1011. ret_code = readb(ti->init_srb + RETCODE_OFST);
  1012. err = ntohs(readw(ti->init_srb + OPEN_ERROR_CODE_OFST));
  1013. if (!ret_code) {
  1014. ti->open_status = OPEN; /* TR adapter is now available */
  1015. if (ti->open_mode == AUTOMATIC) {
  1016. DPRINTK("Adapter reopened.\n");
  1017. }
  1018. writeb(~SRB_RESP_INT, ti->mmio+ACA_OFFSET+ACA_RESET+ISRP_ODD);
  1019. open_sap(EXTENDED_SAP, dev);
  1020. return;
  1021. }
  1022. ti->open_failure = YES;
  1023. if (ret_code == 7){
  1024. if (err == 0x24) {
  1025. if (!ti->auto_speedsave) {
  1026. DPRINTK("Open failed: Adapter speed must match "
  1027. "ring speed if Automatic Ring Speed Save is "
  1028. "disabled.\n");
  1029. ti->open_action = FAIL;
  1030. }else
  1031. DPRINTK("Retrying open to adjust to "
  1032. "ring speed, ");
  1033. } else if (err == 0x2d) {
  1034. DPRINTK("Physical Insertion: No Monitor Detected, ");
  1035. printk("retrying after %ds delay...\n",
  1036. TR_RETRY_INTERVAL/HZ);
  1037. } else if (err == 0x11) {
  1038. DPRINTK("Lobe Media Function Failure (0x11), ");
  1039. printk(" retrying after %ds delay...\n",
  1040. TR_RETRY_INTERVAL/HZ);
  1041. } else {
  1042. char **prphase = printphase;
  1043. char **prerror = printerror;
  1044. DPRINTK("TR Adapter misc open failure, error code = ");
  1045. printk("0x%x, Phase: %s, Error: %s\n",
  1046. err, prphase[err/16 -1], prerror[err%16 -1]);
  1047. printk(" retrying after %ds delay...\n",
  1048. TR_RETRY_INTERVAL/HZ);
  1049. }
  1050. } else DPRINTK("open failed: ret_code = %02X..., ", ret_code);
  1051. if (ti->open_action != FAIL) {
  1052. if (ti->open_mode==AUTOMATIC){
  1053. ti->open_action = REOPEN;
  1054. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1055. return;
  1056. }
  1057. wake_up(&ti->wait_for_reset);
  1058. return;
  1059. }
  1060. DPRINTK("FAILURE, CAPUT\n");
  1061. }
  1062. /******************************************************************************/
  1063. irqreturn_t tok_interrupt(int irq, void *dev_id, struct pt_regs *regs)
  1064. {
  1065. unsigned char status;
  1066. /* unsigned char status_even ; */
  1067. struct tok_info *ti;
  1068. struct net_device *dev;
  1069. #ifdef ENABLE_PAGING
  1070. unsigned char save_srpr;
  1071. #endif
  1072. dev = dev_id;
  1073. #if TR_VERBOSE
  1074. DPRINTK("Int from tok_driver, dev : %p irq%d regs=%p\n", dev,irq,regs);
  1075. #endif
  1076. ti = (struct tok_info *) dev->priv;
  1077. if (ti->sram_phys & 1)
  1078. return IRQ_NONE; /* PCMCIA card extraction flag */
  1079. spin_lock(&(ti->lock));
  1080. #ifdef ENABLE_PAGING
  1081. save_srpr = readb(ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1082. #endif
  1083. /* Disable interrupts till processing is finished */
  1084. writeb((~INT_ENABLE), ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  1085. /* Reset interrupt for ISA boards */
  1086. if (ti->adapter_int_enable)
  1087. outb(0, ti->adapter_int_enable);
  1088. else /* used for PCMCIA cards */
  1089. outb(0, ti->global_int_enable);
  1090. if (ti->do_tok_int == FIRST_INT){
  1091. initial_tok_int(dev);
  1092. #ifdef ENABLE_PAGING
  1093. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1094. #endif
  1095. spin_unlock(&(ti->lock));
  1096. return IRQ_HANDLED;
  1097. }
  1098. /* Begin interrupt handler HERE inline to avoid the extra
  1099. levels of logic and call depth for the original solution. */
  1100. status = readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_ODD);
  1101. /*BMSstatus_even = readb (ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN) */
  1102. /*BMSdebugprintk("tok_interrupt: ISRP_ODD = 0x%x ISRP_EVEN = 0x%x\n", */
  1103. /*BMS status,status_even); */
  1104. if (status & ADAP_CHK_INT) {
  1105. int i;
  1106. void __iomem *check_reason;
  1107. __u8 check_reason_page = 0;
  1108. check_reason = map_address(ti,
  1109. ntohs(readw(ti->mmio+ ACA_OFFSET+ACA_RW + WWCR_EVEN)),
  1110. &check_reason_page);
  1111. SET_PAGE(check_reason_page);
  1112. DPRINTK("Adapter check interrupt\n");
  1113. DPRINTK("8 reason bytes follow: ");
  1114. for (i = 0; i < 8; i++, check_reason++)
  1115. printk("%02X ", (int) readb(check_reason));
  1116. printk("\n");
  1117. writeb(~ADAP_CHK_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1118. status = readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRA_EVEN);
  1119. DPRINTK("ISRA_EVEN == 0x02%x\n",status);
  1120. ti->open_status = CLOSED;
  1121. ti->sap_status = CLOSED;
  1122. ti->open_mode = AUTOMATIC;
  1123. dev->flags &= ~IFF_RUNNING;
  1124. netif_stop_queue(dev);
  1125. ti->open_action = RESTART;
  1126. outb(0, dev->base_addr + ADAPTRESET);
  1127. ibmtr_reset_timer(&(ti->tr_timer), dev);/*BMS try to reopen*/
  1128. spin_unlock(&(ti->lock));
  1129. return IRQ_HANDLED;
  1130. }
  1131. if (readb(ti->mmio + ACA_OFFSET + ACA_RW + ISRP_EVEN)
  1132. & (TCR_INT | ERR_INT | ACCESS_INT)) {
  1133. DPRINTK("adapter error: ISRP_EVEN : %02x\n",
  1134. (int)readb(ti->mmio+ ACA_OFFSET + ACA_RW + ISRP_EVEN));
  1135. writeb(~(TCR_INT | ERR_INT | ACCESS_INT),
  1136. ti->mmio + ACA_OFFSET + ACA_RESET + ISRP_EVEN);
  1137. status= readb(ti->mmio+ ACA_OFFSET + ACA_RW + ISRA_EVEN);/*BMS*/
  1138. DPRINTK("ISRA_EVEN == 0x02%x\n",status);/*BMS*/
  1139. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1140. #ifdef ENABLE_PAGING
  1141. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1142. #endif
  1143. spin_unlock(&(ti->lock));
  1144. return IRQ_HANDLED;
  1145. }
  1146. if (status & SRB_RESP_INT) { /* SRB response */
  1147. SET_PAGE(ti->srb_page);
  1148. #if TR_VERBOSE
  1149. DPRINTK("SRB resp: cmd=%02X rsp=%02X\n",
  1150. readb(ti->srb), readb(ti->srb + RETCODE_OFST));
  1151. #endif
  1152. switch (readb(ti->srb)) { /* SRB command check */
  1153. case XMIT_DIR_FRAME:{
  1154. unsigned char xmit_ret_code;
  1155. xmit_ret_code = readb(ti->srb + RETCODE_OFST);
  1156. if (xmit_ret_code == 0xff) break;
  1157. DPRINTK("error on xmit_dir_frame request: %02X\n",
  1158. xmit_ret_code);
  1159. if (ti->current_skb) {
  1160. dev_kfree_skb_irq(ti->current_skb);
  1161. ti->current_skb = NULL;
  1162. }
  1163. /*dev->tbusy = 0;*/
  1164. netif_wake_queue(dev);
  1165. if (ti->readlog_pending)
  1166. ibmtr_readlog(dev);
  1167. break;
  1168. }
  1169. case XMIT_UI_FRAME:{
  1170. unsigned char xmit_ret_code;
  1171. xmit_ret_code = readb(ti->srb + RETCODE_OFST);
  1172. if (xmit_ret_code == 0xff) break;
  1173. DPRINTK("error on xmit_ui_frame request: %02X\n",
  1174. xmit_ret_code);
  1175. if (ti->current_skb) {
  1176. dev_kfree_skb_irq(ti->current_skb);
  1177. ti->current_skb = NULL;
  1178. }
  1179. netif_wake_queue(dev);
  1180. if (ti->readlog_pending)
  1181. ibmtr_readlog(dev);
  1182. break;
  1183. }
  1184. case DIR_OPEN_ADAPTER:
  1185. dir_open_adapter(dev);
  1186. break;
  1187. case DLC_OPEN_SAP:
  1188. if (readb(ti->srb + RETCODE_OFST)) {
  1189. DPRINTK("open_sap failed: ret_code = %02X, "
  1190. "retrying\n",
  1191. (int) readb(ti->srb + RETCODE_OFST));
  1192. ti->open_action = REOPEN;
  1193. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1194. break;
  1195. }
  1196. ti->exsap_station_id = readw(ti->srb + STATION_ID_OFST);
  1197. ti->sap_status = OPEN;/* TR adapter is now available */
  1198. if (ti->open_mode==MANUAL){
  1199. wake_up(&ti->wait_for_reset);
  1200. break;
  1201. }
  1202. netif_wake_queue(dev);
  1203. dev->flags |= IFF_RUNNING;/*BMS 12/2000*/
  1204. break;
  1205. case DIR_INTERRUPT:
  1206. case DIR_MOD_OPEN_PARAMS:
  1207. case DIR_SET_GRP_ADDR:
  1208. case DIR_SET_FUNC_ADDR:
  1209. case DLC_CLOSE_SAP:
  1210. if (readb(ti->srb + RETCODE_OFST))
  1211. DPRINTK("error on %02X: %02X\n",
  1212. (int) readb(ti->srb + COMMAND_OFST),
  1213. (int) readb(ti->srb + RETCODE_OFST));
  1214. break;
  1215. case DIR_READ_LOG:
  1216. if (readb(ti->srb + RETCODE_OFST)){
  1217. DPRINTK("error on dir_read_log: %02X\n",
  1218. (int) readb(ti->srb + RETCODE_OFST));
  1219. netif_wake_queue(dev);
  1220. break;
  1221. }
  1222. #if IBMTR_DEBUG_MESSAGES
  1223. #define LINE_ERRORS_OFST 0
  1224. #define INTERNAL_ERRORS_OFST 1
  1225. #define BURST_ERRORS_OFST 2
  1226. #define AC_ERRORS_OFST 3
  1227. #define ABORT_DELIMITERS_OFST 4
  1228. #define LOST_FRAMES_OFST 6
  1229. #define RECV_CONGEST_COUNT_OFST 7
  1230. #define FRAME_COPIED_ERRORS_OFST 8
  1231. #define FREQUENCY_ERRORS_OFST 9
  1232. #define TOKEN_ERRORS_OFST 10
  1233. DPRINTK("Line errors %02X, Internal errors %02X, "
  1234. "Burst errors %02X\n" "A/C errors %02X, "
  1235. "Abort delimiters %02X, Lost frames %02X\n"
  1236. "Receive congestion count %02X, "
  1237. "Frame copied errors %02X\nFrequency errors %02X, "
  1238. "Token errors %02X\n",
  1239. (int) readb(ti->srb + LINE_ERRORS_OFST),
  1240. (int) readb(ti->srb + INTERNAL_ERRORS_OFST),
  1241. (int) readb(ti->srb + BURST_ERRORS_OFST),
  1242. (int) readb(ti->srb + AC_ERRORS_OFST),
  1243. (int) readb(ti->srb + ABORT_DELIMITERS_OFST),
  1244. (int) readb(ti->srb + LOST_FRAMES_OFST),
  1245. (int) readb(ti->srb + RECV_CONGEST_COUNT_OFST),
  1246. (int) readb(ti->srb + FRAME_COPIED_ERRORS_OFST),
  1247. (int) readb(ti->srb + FREQUENCY_ERRORS_OFST),
  1248. (int) readb(ti->srb + TOKEN_ERRORS_OFST));
  1249. #endif
  1250. netif_wake_queue(dev);
  1251. break;
  1252. default:
  1253. DPRINTK("Unknown command %02X encountered\n",
  1254. (int) readb(ti->srb));
  1255. } /* end switch SRB command check */
  1256. writeb(~SRB_RESP_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1257. } /* if SRB response */
  1258. if (status & ASB_FREE_INT) { /* ASB response */
  1259. SET_PAGE(ti->asb_page);
  1260. #if TR_VERBOSE
  1261. DPRINTK("ASB resp: cmd=%02X\n", readb(ti->asb));
  1262. #endif
  1263. switch (readb(ti->asb)) { /* ASB command check */
  1264. case REC_DATA:
  1265. case XMIT_UI_FRAME:
  1266. case XMIT_DIR_FRAME:
  1267. break;
  1268. default:
  1269. DPRINTK("unknown command in asb %02X\n",
  1270. (int) readb(ti->asb));
  1271. } /* switch ASB command check */
  1272. if (readb(ti->asb + 2) != 0xff) /* checks ret_code */
  1273. DPRINTK("ASB error %02X in cmd %02X\n",
  1274. (int) readb(ti->asb + 2), (int) readb(ti->asb));
  1275. writeb(~ASB_FREE_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1276. } /* if ASB response */
  1277. #define STATUS_OFST 6
  1278. #define NETW_STATUS_OFST 6
  1279. if (status & ARB_CMD_INT) { /* ARB response */
  1280. SET_PAGE(ti->arb_page);
  1281. #if TR_VERBOSE
  1282. DPRINTK("ARB resp: cmd=%02X\n", readb(ti->arb));
  1283. #endif
  1284. switch (readb(ti->arb)) { /* ARB command check */
  1285. case DLC_STATUS:
  1286. DPRINTK("DLC_STATUS new status: %02X on station %02X\n",
  1287. ntohs(readw(ti->arb + STATUS_OFST)),
  1288. ntohs(readw(ti->arb+ STATION_ID_OFST)));
  1289. break;
  1290. case REC_DATA:
  1291. tr_rx(dev);
  1292. break;
  1293. case RING_STAT_CHANGE:{
  1294. unsigned short ring_status;
  1295. ring_status= ntohs(readw(ti->arb + NETW_STATUS_OFST));
  1296. if (ibmtr_debug_trace & TRC_INIT)
  1297. DPRINTK("Ring Status Change...(0x%x)\n",
  1298. ring_status);
  1299. if(ring_status& (REMOVE_RECV|AUTO_REMOVAL|LOBE_FAULT)){
  1300. netif_stop_queue(dev);
  1301. dev->flags &= ~IFF_RUNNING;/*not typical Linux*/
  1302. DPRINTK("Remove received, or Auto-removal error"
  1303. ", or Lobe fault\n");
  1304. DPRINTK("We'll try to reopen the closed adapter"
  1305. " after a %d second delay.\n",
  1306. TR_RETRY_INTERVAL/HZ);
  1307. /*I was confused: I saw the TR reopening but */
  1308. /*forgot:with an RJ45 in an RJ45/ICS adapter */
  1309. /*but adapter not in the ring, the TR will */
  1310. /* open, and then soon close and come here. */
  1311. ti->open_mode = AUTOMATIC;
  1312. ti->open_status = CLOSED; /*12/2000 BMS*/
  1313. ti->open_action = REOPEN;
  1314. ibmtr_reset_timer(&(ti->tr_timer), dev);
  1315. } else if (ring_status & LOG_OVERFLOW) {
  1316. if(netif_queue_stopped(dev))
  1317. ti->readlog_pending = 1;
  1318. else
  1319. ibmtr_readlog(dev);
  1320. }
  1321. break;
  1322. }
  1323. case XMIT_DATA_REQ:
  1324. tr_tx(dev);
  1325. break;
  1326. default:
  1327. DPRINTK("Unknown command %02X in arb\n",
  1328. (int) readb(ti->arb));
  1329. break;
  1330. } /* switch ARB command check */
  1331. writeb(~ARB_CMD_INT, ti->mmio+ ACA_OFFSET+ACA_RESET + ISRP_ODD);
  1332. writeb(ARB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1333. } /* if ARB response */
  1334. if (status & SSB_RESP_INT) { /* SSB response */
  1335. unsigned char retcode;
  1336. SET_PAGE(ti->ssb_page);
  1337. #if TR_VERBOSE
  1338. DPRINTK("SSB resp: cmd=%02X rsp=%02X\n",
  1339. readb(ti->ssb), readb(ti->ssb + 2));
  1340. #endif
  1341. switch (readb(ti->ssb)) { /* SSB command check */
  1342. case XMIT_DIR_FRAME:
  1343. case XMIT_UI_FRAME:
  1344. retcode = readb(ti->ssb + 2);
  1345. if (retcode && (retcode != 0x22))/* checks ret_code */
  1346. DPRINTK("xmit ret_code: %02X xmit error code: "
  1347. "%02X\n",
  1348. (int)retcode, (int)readb(ti->ssb + 6));
  1349. else
  1350. ti->tr_stats.tx_packets++;
  1351. break;
  1352. case XMIT_XID_CMD:
  1353. DPRINTK("xmit xid ret_code: %02X\n",
  1354. (int) readb(ti->ssb + 2));
  1355. default:
  1356. DPRINTK("Unknown command %02X in ssb\n",
  1357. (int) readb(ti->ssb));
  1358. } /* SSB command check */
  1359. writeb(~SSB_RESP_INT, ti->mmio+ ACA_OFFSET+ACA_RESET+ ISRP_ODD);
  1360. writeb(SSB_FREE, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1361. } /* if SSB response */
  1362. #ifdef ENABLE_PAGING
  1363. writeb(save_srpr, ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1364. #endif
  1365. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1366. spin_unlock(&(ti->lock));
  1367. return IRQ_HANDLED;
  1368. } /*tok_interrupt */
  1369. /*****************************************************************************/
  1370. #define INIT_STATUS_OFST 1
  1371. #define INIT_STATUS_2_OFST 2
  1372. #define ENCODED_ADDRESS_OFST 8
  1373. static void initial_tok_int(struct net_device *dev)
  1374. {
  1375. __u32 encoded_addr, hw_encoded_addr;
  1376. struct tok_info *ti;
  1377. unsigned char init_status; /*BMS 12/2000*/
  1378. ti = (struct tok_info *) dev->priv;
  1379. ti->do_tok_int = NOT_FIRST;
  1380. /* we assign the shared-ram address for ISA devices */
  1381. writeb(ti->sram_base, ti->mmio + ACA_OFFSET + ACA_RW + RRR_EVEN);
  1382. #ifndef PCMCIA
  1383. ti->sram_virt = ioremap(((__u32)ti->sram_base << 12), ti->avail_shared_ram);
  1384. #endif
  1385. ti->init_srb = map_address(ti,
  1386. ntohs(readw(ti->mmio + ACA_OFFSET + WRBR_EVEN)),
  1387. &ti->init_srb_page);
  1388. if (ti->page_mask && ti->avail_shared_ram == 127) {
  1389. void __iomem *last_512;
  1390. __u8 last_512_page=0;
  1391. int i;
  1392. last_512 = map_address(ti, 0xfe00, &last_512_page);
  1393. /* initialize high section of ram (if necessary) */
  1394. SET_PAGE(last_512_page);
  1395. for (i = 0; i < 512; i++)
  1396. writeb(0, last_512 + i);
  1397. }
  1398. SET_PAGE(ti->init_srb_page);
  1399. #if TR_VERBOSE
  1400. {
  1401. int i;
  1402. DPRINTK("ti->init_srb_page=0x%x\n", ti->init_srb_page);
  1403. DPRINTK("init_srb(%p):", ti->init_srb );
  1404. for (i = 0; i < 20; i++)
  1405. printk("%02X ", (int) readb(ti->init_srb + i));
  1406. printk("\n");
  1407. }
  1408. #endif
  1409. hw_encoded_addr = readw(ti->init_srb + ENCODED_ADDRESS_OFST);
  1410. encoded_addr = ntohs(hw_encoded_addr);
  1411. init_status= /*BMS 12/2000 check for shallow mode possibility (Turbo)*/
  1412. readb(ti->init_srb+offsetof(struct srb_init_response,init_status));
  1413. /*printk("Initial interrupt: init_status= 0x%02x\n",init_status);*/
  1414. ti->ring_speed = init_status & 0x01 ? 16 : 4;
  1415. DPRINTK("Initial interrupt : %d Mbps, shared RAM base %08x.\n",
  1416. ti->ring_speed, (unsigned int)dev->mem_start);
  1417. ti->auto_speedsave=readb(ti->init_srb+INIT_STATUS_2_OFST)&4?TRUE:FALSE;
  1418. if (ti->open_mode == MANUAL) wake_up(&ti->wait_for_reset);
  1419. else tok_open_adapter((unsigned long)dev);
  1420. } /*initial_tok_int() */
  1421. /*****************************************************************************/
  1422. #define CMD_CORRELATE_OFST 1
  1423. #define DHB_ADDRESS_OFST 6
  1424. #define FRAME_LENGTH_OFST 6
  1425. #define HEADER_LENGTH_OFST 8
  1426. #define RSAP_VALUE_OFST 9
  1427. static void tr_tx(struct net_device *dev)
  1428. {
  1429. struct tok_info *ti = (struct tok_info *) dev->priv;
  1430. struct trh_hdr *trhdr = (struct trh_hdr *) ti->current_skb->data;
  1431. unsigned int hdr_len;
  1432. __u32 dhb=0,dhb_base;
  1433. void __iomem *dhbuf = NULL;
  1434. unsigned char xmit_command;
  1435. int i,dhb_len=0x4000,src_len,src_offset;
  1436. struct trllc *llc;
  1437. struct srb_xmit xsrb;
  1438. __u8 dhb_page = 0;
  1439. __u8 llc_ssap;
  1440. SET_PAGE(ti->asb_page);
  1441. if (readb(ti->asb+RETCODE_OFST) != 0xFF) DPRINTK("ASB not free !!!\n");
  1442. /* in providing the transmit interrupts, is telling us it is ready for
  1443. data and providing a shared memory address for us to stuff with data.
  1444. Here we compute the effective address where we will place data.
  1445. */
  1446. SET_PAGE(ti->arb_page);
  1447. dhb=dhb_base=ntohs(readw(ti->arb + DHB_ADDRESS_OFST));
  1448. if (ti->page_mask) {
  1449. dhb_page = (dhb_base >> 8) & ti->page_mask;
  1450. dhb=dhb_base & ~(ti->page_mask << 8);
  1451. }
  1452. dhbuf = ti->sram_virt + dhb;
  1453. /* Figure out the size of the 802.5 header */
  1454. if (!(trhdr->saddr[0] & 0x80)) /* RIF present? */
  1455. hdr_len = sizeof(struct trh_hdr) - TR_MAXRIFLEN;
  1456. else
  1457. hdr_len = ((ntohs(trhdr->rcf) & TR_RCF_LEN_MASK) >> 8)
  1458. + sizeof(struct trh_hdr) - TR_MAXRIFLEN;
  1459. llc = (struct trllc *) (ti->current_skb->data + hdr_len);
  1460. llc_ssap = llc->ssap;
  1461. SET_PAGE(ti->srb_page);
  1462. memcpy_fromio(&xsrb, ti->srb, sizeof(xsrb));
  1463. SET_PAGE(ti->asb_page);
  1464. xmit_command = xsrb.command;
  1465. writeb(xmit_command, ti->asb + COMMAND_OFST);
  1466. writew(xsrb.station_id, ti->asb + STATION_ID_OFST);
  1467. writeb(llc_ssap, ti->asb + RSAP_VALUE_OFST);
  1468. writeb(xsrb.cmd_corr, ti->asb + CMD_CORRELATE_OFST);
  1469. writeb(0, ti->asb + RETCODE_OFST);
  1470. if ((xmit_command == XMIT_XID_CMD) || (xmit_command == XMIT_TEST_CMD)) {
  1471. writew(htons(0x11), ti->asb + FRAME_LENGTH_OFST);
  1472. writeb(0x0e, ti->asb + HEADER_LENGTH_OFST);
  1473. SET_PAGE(dhb_page);
  1474. writeb(AC, dhbuf);
  1475. writeb(LLC_FRAME, dhbuf + 1);
  1476. for (i = 0; i < TR_ALEN; i++)
  1477. writeb((int) 0x0FF, dhbuf + i + 2);
  1478. for (i = 0; i < TR_ALEN; i++)
  1479. writeb(0, dhbuf + i + TR_ALEN + 2);
  1480. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1481. return;
  1482. }
  1483. /*
  1484. * the token ring packet is copied from sk_buff to the adapter
  1485. * buffer identified in the command data received with the interrupt.
  1486. */
  1487. writeb(hdr_len, ti->asb + HEADER_LENGTH_OFST);
  1488. writew(htons(ti->current_skb->len), ti->asb + FRAME_LENGTH_OFST);
  1489. src_len=ti->current_skb->len;
  1490. src_offset=0;
  1491. dhb=dhb_base;
  1492. while(1) {
  1493. if (ti->page_mask) {
  1494. dhb_page=(dhb >> 8) & ti->page_mask;
  1495. dhb=dhb & ~(ti->page_mask << 8);
  1496. dhb_len=0x4000-dhb; /* remaining size of this page */
  1497. }
  1498. dhbuf = ti->sram_virt + dhb;
  1499. SET_PAGE(dhb_page);
  1500. if (src_len > dhb_len) {
  1501. memcpy_toio(dhbuf,&ti->current_skb->data[src_offset],
  1502. dhb_len);
  1503. src_len -= dhb_len;
  1504. src_offset += dhb_len;
  1505. dhb_base+=dhb_len;
  1506. dhb=dhb_base;
  1507. continue;
  1508. }
  1509. memcpy_toio(dhbuf, &ti->current_skb->data[src_offset], src_len);
  1510. break;
  1511. }
  1512. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1513. ti->tr_stats.tx_bytes += ti->current_skb->len;
  1514. dev_kfree_skb_irq(ti->current_skb);
  1515. ti->current_skb = NULL;
  1516. netif_wake_queue(dev);
  1517. if (ti->readlog_pending)
  1518. ibmtr_readlog(dev);
  1519. } /*tr_tx */
  1520. /*****************************************************************************/
  1521. #define RECEIVE_BUFFER_OFST 6
  1522. #define LAN_HDR_LENGTH_OFST 8
  1523. #define DLC_HDR_LENGTH_OFST 9
  1524. #define DSAP_OFST 0
  1525. #define SSAP_OFST 1
  1526. #define LLC_OFST 2
  1527. #define PROTID_OFST 3
  1528. #define ETHERTYPE_OFST 6
  1529. static void tr_rx(struct net_device *dev)
  1530. {
  1531. struct tok_info *ti = (struct tok_info *) dev->priv;
  1532. __u32 rbuffer;
  1533. void __iomem *rbuf, *rbufdata, *llc;
  1534. __u8 rbuffer_page = 0;
  1535. unsigned char *data;
  1536. unsigned int rbuffer_len, lan_hdr_len, hdr_len, ip_len, length;
  1537. unsigned char dlc_hdr_len;
  1538. struct sk_buff *skb;
  1539. unsigned int skb_size = 0;
  1540. int IPv4_p = 0;
  1541. unsigned int chksum = 0;
  1542. struct iphdr *iph;
  1543. struct arb_rec_req rarb;
  1544. SET_PAGE(ti->arb_page);
  1545. memcpy_fromio(&rarb, ti->arb, sizeof(rarb));
  1546. rbuffer = ntohs(rarb.rec_buf_addr) ;
  1547. rbuf = map_address(ti, rbuffer, &rbuffer_page);
  1548. SET_PAGE(ti->asb_page);
  1549. if (readb(ti->asb + RETCODE_OFST) !=0xFF) DPRINTK("ASB not free !!!\n");
  1550. writeb(REC_DATA, ti->asb + COMMAND_OFST);
  1551. writew(rarb.station_id, ti->asb + STATION_ID_OFST);
  1552. writew(rarb.rec_buf_addr, ti->asb + RECEIVE_BUFFER_OFST);
  1553. lan_hdr_len = rarb.lan_hdr_len;
  1554. if (lan_hdr_len > sizeof(struct trh_hdr)) {
  1555. DPRINTK("Linux cannot handle greater than 18 bytes RIF\n");
  1556. return;
  1557. } /*BMS I added this above just to be very safe */
  1558. dlc_hdr_len = readb(ti->arb + DLC_HDR_LENGTH_OFST);
  1559. hdr_len = lan_hdr_len + sizeof(struct trllc) + sizeof(struct iphdr);
  1560. SET_PAGE(rbuffer_page);
  1561. llc = rbuf + offsetof(struct rec_buf, data) + lan_hdr_len;
  1562. #if TR_VERBOSE
  1563. DPRINTK("offsetof data: %02X lan_hdr_len: %02X\n",
  1564. (__u32) offsetof(struct rec_buf, data), (unsigned int) lan_hdr_len);
  1565. DPRINTK("llc: %08X rec_buf_addr: %04X dev->mem_start: %lX\n",
  1566. llc, ntohs(rarb.rec_buf_addr), dev->mem_start);
  1567. DPRINTK("dsap: %02X, ssap: %02X, llc: %02X, protid: %02X%02X%02X, "
  1568. "ethertype: %04X\n",
  1569. (int) readb(llc + DSAP_OFST), (int) readb(llc + SSAP_OFST),
  1570. (int) readb(llc + LLC_OFST), (int) readb(llc + PROTID_OFST),
  1571. (int) readb(llc+PROTID_OFST+1),(int)readb(llc+PROTID_OFST + 2),
  1572. (int) ntohs(readw(llc + ETHERTYPE_OFST)));
  1573. #endif
  1574. if (readb(llc + offsetof(struct trllc, llc)) != UI_CMD) {
  1575. SET_PAGE(ti->asb_page);
  1576. writeb(DATA_LOST, ti->asb + RETCODE_OFST);
  1577. ti->tr_stats.rx_dropped++;
  1578. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1579. return;
  1580. }
  1581. length = ntohs(rarb.frame_len);
  1582. if (readb(llc + DSAP_OFST) == EXTENDED_SAP &&
  1583. readb(llc + SSAP_OFST) == EXTENDED_SAP &&
  1584. length >= hdr_len) IPv4_p = 1;
  1585. #if TR_VERBOSE
  1586. #define SADDR_OFST 8
  1587. #define DADDR_OFST 2
  1588. if (!IPv4_p) {
  1589. void __iomem *trhhdr = rbuf + offsetof(struct rec_buf, data);
  1590. DPRINTK("Probably non-IP frame received.\n");
  1591. DPRINTK("ssap: %02X dsap: %02X "
  1592. "saddr: %02X:%02X:%02X:%02X:%02X:%02X "
  1593. "daddr: %02X:%02X:%02X:%02X:%02X:%02X\n",
  1594. readb(llc + SSAP_OFST), readb(llc + DSAP_OFST),
  1595. readb(trhhdr+SADDR_OFST), readb(trhhdr+ SADDR_OFST+1),
  1596. readb(trhhdr+SADDR_OFST+2), readb(trhhdr+SADDR_OFST+3),
  1597. readb(trhhdr+SADDR_OFST+4), readb(trhhdr+SADDR_OFST+5),
  1598. readb(trhhdr+DADDR_OFST), readb(trhhdr+DADDR_OFST + 1),
  1599. readb(trhhdr+DADDR_OFST+2), readb(trhhdr+DADDR_OFST+3),
  1600. readb(trhhdr+DADDR_OFST+4), readb(trhhdr+DADDR_OFST+5));
  1601. }
  1602. #endif
  1603. /*BMS handle the case she comes in with few hops but leaves with many */
  1604. skb_size=length-lan_hdr_len+sizeof(struct trh_hdr)+sizeof(struct trllc);
  1605. if (!(skb = dev_alloc_skb(skb_size))) {
  1606. DPRINTK("out of memory. frame dropped.\n");
  1607. ti->tr_stats.rx_dropped++;
  1608. SET_PAGE(ti->asb_page);
  1609. writeb(DATA_LOST, ti->asb + offsetof(struct asb_rec, ret_code));
  1610. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1611. return;
  1612. }
  1613. /*BMS again, if she comes in with few but leaves with many */
  1614. skb_reserve(skb, sizeof(struct trh_hdr) - lan_hdr_len);
  1615. skb_put(skb, length);
  1616. skb->dev = dev;
  1617. data = skb->data;
  1618. rbuffer_len = ntohs(readw(rbuf + offsetof(struct rec_buf, buf_len)));
  1619. rbufdata = rbuf + offsetof(struct rec_buf, data);
  1620. if (IPv4_p) {
  1621. /* Copy the headers without checksumming */
  1622. memcpy_fromio(data, rbufdata, hdr_len);
  1623. /* Watch for padded packets and bogons */
  1624. iph= (struct iphdr *)(data+ lan_hdr_len + sizeof(struct trllc));
  1625. ip_len = ntohs(iph->tot_len) - sizeof(struct iphdr);
  1626. length -= hdr_len;
  1627. if ((ip_len <= length) && (ip_len > 7))
  1628. length = ip_len;
  1629. data += hdr_len;
  1630. rbuffer_len -= hdr_len;
  1631. rbufdata += hdr_len;
  1632. }
  1633. /* Copy the payload... */
  1634. #define BUFFER_POINTER_OFST 2
  1635. #define BUFFER_LENGTH_OFST 6
  1636. for (;;) {
  1637. if (ibmtr_debug_trace&TRC_INITV && length < rbuffer_len)
  1638. DPRINTK("CURIOUS, length=%d < rbuffer_len=%d\n",
  1639. length,rbuffer_len);
  1640. if (IPv4_p)
  1641. chksum=csum_partial_copy_nocheck((void*)rbufdata,
  1642. data,length<rbuffer_len?length:rbuffer_len,chksum);
  1643. else
  1644. memcpy_fromio(data, rbufdata, rbuffer_len);
  1645. rbuffer = ntohs(readw(rbuf+BUFFER_POINTER_OFST)) ;
  1646. if (!rbuffer)
  1647. break;
  1648. rbuffer -= 2;
  1649. length -= rbuffer_len;
  1650. data += rbuffer_len;
  1651. rbuf = map_address(ti, rbuffer, &rbuffer_page);
  1652. SET_PAGE(rbuffer_page);
  1653. rbuffer_len = ntohs(readw(rbuf + BUFFER_LENGTH_OFST));
  1654. rbufdata = rbuf + offsetof(struct rec_buf, data);
  1655. }
  1656. SET_PAGE(ti->asb_page);
  1657. writeb(0, ti->asb + offsetof(struct asb_rec, ret_code));
  1658. writeb(RESP_IN_ASB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1659. ti->tr_stats.rx_bytes += skb->len;
  1660. ti->tr_stats.rx_packets++;
  1661. skb->protocol = tr_type_trans(skb, dev);
  1662. if (IPv4_p) {
  1663. skb->csum = chksum;
  1664. skb->ip_summed = 1;
  1665. }
  1666. netif_rx(skb);
  1667. dev->last_rx = jiffies;
  1668. } /*tr_rx */
  1669. /*****************************************************************************/
  1670. void ibmtr_reset_timer(struct timer_list *tmr, struct net_device *dev)
  1671. {
  1672. tmr->expires = jiffies + TR_RETRY_INTERVAL;
  1673. tmr->data = (unsigned long) dev;
  1674. tmr->function = tok_rerun;
  1675. init_timer(tmr);
  1676. add_timer(tmr);
  1677. }
  1678. /*****************************************************************************/
  1679. void tok_rerun(unsigned long dev_addr){
  1680. struct net_device *dev = (struct net_device *)dev_addr;
  1681. struct tok_info *ti = (struct tok_info *) dev->priv;
  1682. if ( ti->open_action == RESTART){
  1683. ti->do_tok_int = FIRST_INT;
  1684. outb(0, dev->base_addr + ADAPTRESETREL);
  1685. #ifdef ENABLE_PAGING
  1686. if (ti->page_mask)
  1687. writeb(SRPR_ENABLE_PAGING,
  1688. ti->mmio + ACA_OFFSET + ACA_RW + SRPR_EVEN);
  1689. #endif
  1690. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1691. } else
  1692. tok_open_adapter(dev_addr);
  1693. }
  1694. /*****************************************************************************/
  1695. void ibmtr_readlog(struct net_device *dev)
  1696. {
  1697. struct tok_info *ti;
  1698. ti = (struct tok_info *) dev->priv;
  1699. ti->readlog_pending = 0;
  1700. SET_PAGE(ti->srb_page);
  1701. writeb(DIR_READ_LOG, ti->srb);
  1702. writeb(INT_ENABLE, ti->mmio + ACA_OFFSET + ACA_SET + ISRP_EVEN);
  1703. writeb(CMD_IN_SRB, ti->mmio + ACA_OFFSET + ACA_SET + ISRA_ODD);
  1704. netif_stop_queue(dev);
  1705. }
  1706. /*****************************************************************************/
  1707. /* tok_get_stats(): Basically a scaffold routine which will return
  1708. the address of the tr_statistics structure associated with
  1709. this device -- the tr.... structure is an ethnet look-alike
  1710. so at least for this iteration may suffice. */
  1711. static struct net_device_stats *tok_get_stats(struct net_device *dev)
  1712. {
  1713. struct tok_info *toki;
  1714. toki = (struct tok_info *) dev->priv;
  1715. return (struct net_device_stats *) &toki->tr_stats;
  1716. }
  1717. /*****************************************************************************/
  1718. int ibmtr_change_mtu(struct net_device *dev, int mtu)
  1719. {
  1720. struct tok_info *ti = (struct tok_info *) dev->priv;
  1721. if (ti->ring_speed == 16 && mtu > ti->maxmtu16)
  1722. return -EINVAL;
  1723. if (ti->ring_speed == 4 && mtu > ti->maxmtu4)
  1724. return -EINVAL;
  1725. dev->mtu = mtu;
  1726. return 0;
  1727. }
  1728. /*****************************************************************************/
  1729. #ifdef MODULE
  1730. /* 3COM 3C619C supports 8 interrupts, 32 I/O ports */
  1731. static struct net_device *dev_ibmtr[IBMTR_MAX_ADAPTERS];
  1732. static int io[IBMTR_MAX_ADAPTERS] = { 0xa20, 0xa24 };
  1733. static int irq[IBMTR_MAX_ADAPTERS];
  1734. static int mem[IBMTR_MAX_ADAPTERS];
  1735. MODULE_LICENSE("GPL");
  1736. module_param_array(io, int, NULL, 0);
  1737. module_param_array(irq, int, NULL, 0);
  1738. module_param_array(mem, int, NULL, 0);
  1739. static int __init ibmtr_init(void)
  1740. {
  1741. int i;
  1742. int count=0;
  1743. find_turbo_adapters(io);
  1744. for (i = 0; io[i] && (i < IBMTR_MAX_ADAPTERS); i++) {
  1745. struct net_device *dev;
  1746. irq[i] = 0;
  1747. mem[i] = 0;
  1748. dev = alloc_trdev(sizeof(struct tok_info));
  1749. if (dev == NULL) {
  1750. if (i == 0)
  1751. return -ENOMEM;
  1752. break;
  1753. }
  1754. dev->base_addr = io[i];
  1755. dev->irq = irq[i];
  1756. dev->mem_start = mem[i];
  1757. if (ibmtr_probe_card(dev)) {
  1758. free_netdev(dev);
  1759. continue;
  1760. }
  1761. dev_ibmtr[i] = dev;
  1762. count++;
  1763. }
  1764. if (count) return 0;
  1765. printk("ibmtr: register_netdev() returned non-zero.\n");
  1766. return -EIO;
  1767. }
  1768. module_init(ibmtr_init);
  1769. static void __exit ibmtr_cleanup(void)
  1770. {
  1771. int i;
  1772. for (i = 0; i < IBMTR_MAX_ADAPTERS; i++){
  1773. if (!dev_ibmtr[i])
  1774. continue;
  1775. unregister_netdev(dev_ibmtr[i]);
  1776. ibmtr_cleanup_card(dev_ibmtr[i]);
  1777. free_netdev(dev_ibmtr[i]);
  1778. }
  1779. }
  1780. module_exit(ibmtr_cleanup);
  1781. #endif