]> git.proxmox.com Git - mirror_ubuntu-bionic-kernel.git/blob - drivers/net/pcmcia/fmvj18x_cs.c
0d7de617e535f41a08619255ae884cd3ca76bae8
[mirror_ubuntu-bionic-kernel.git] / drivers / net / pcmcia / fmvj18x_cs.c
1 /*======================================================================
2 fmvj18x_cs.c 2.8 2002/03/23
3
4 A fmvj18x (and its compatibles) PCMCIA client driver
5
6 Contributed by Shingo Fujimoto, shingo@flab.fujitsu.co.jp
7
8 TDK LAK-CD021 and CONTEC C-NET(PC)C support added by
9 Nobuhiro Katayama, kata-n@po.iijnet.or.jp
10
11 The PCMCIA client code is based on code written by David Hinds.
12 Network code is based on the "FMV-18x driver" by Yutaka TAMIYA
13 but is actually largely Donald Becker's AT1700 driver, which
14 carries the following attribution:
15
16 Written 1993-94 by Donald Becker.
17
18 Copyright 1993 United States Government as represented by the
19 Director, National Security Agency.
20
21 This software may be used and distributed according to the terms
22 of the GNU General Public License, incorporated herein by reference.
23
24 The author may be reached as becker@scyld.com, or C/O
25 Scyld Computing Corporation
26 410 Severn Ave., Suite 210
27 Annapolis MD 21403
28
29 ======================================================================*/
30
31 #define DRV_NAME "fmvj18x_cs"
32 #define DRV_VERSION "2.9"
33
34 #include <linux/module.h>
35 #include <linux/kernel.h>
36 #include <linux/init.h>
37 #include <linux/ptrace.h>
38 #include <linux/slab.h>
39 #include <linux/string.h>
40 #include <linux/timer.h>
41 #include <linux/interrupt.h>
42 #include <linux/in.h>
43 #include <linux/delay.h>
44 #include <linux/ethtool.h>
45 #include <linux/netdevice.h>
46 #include <linux/etherdevice.h>
47 #include <linux/skbuff.h>
48 #include <linux/if_arp.h>
49 #include <linux/ioport.h>
50 #include <linux/crc32.h>
51
52 #include <pcmcia/cs_types.h>
53 #include <pcmcia/cs.h>
54 #include <pcmcia/cistpl.h>
55 #include <pcmcia/ciscode.h>
56 #include <pcmcia/ds.h>
57
58 #include <asm/uaccess.h>
59 #include <asm/io.h>
60 #include <asm/system.h>
61
62 /*====================================================================*/
63
64 /* Module parameters */
65
66 MODULE_DESCRIPTION("fmvj18x and compatible PCMCIA ethernet driver");
67 MODULE_LICENSE("GPL");
68
69 #define INT_MODULE_PARM(n, v) static int n = v; module_param(n, int, 0)
70
71 /* SRAM configuration */
72 /* 0:4KB*2 TX buffer else:8KB*2 TX buffer */
73 INT_MODULE_PARM(sram_config, 0);
74
75 #ifdef PCMCIA_DEBUG
76 INT_MODULE_PARM(pc_debug, PCMCIA_DEBUG);
77 #define DEBUG(n, args...) if (pc_debug>(n)) printk(KERN_DEBUG args)
78 static char *version = DRV_NAME ".c " DRV_VERSION " 2002/03/23";
79 #else
80 #define DEBUG(n, args...)
81 #endif
82
83 /*====================================================================*/
84 /*
85 PCMCIA event handlers
86 */
87 static int fmvj18x_config(struct pcmcia_device *link);
88 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id);
89 static int fmvj18x_setup_mfc(struct pcmcia_device *link);
90 static void fmvj18x_release(struct pcmcia_device *link);
91 static void fmvj18x_detach(struct pcmcia_device *p_dev);
92
93 /*
94 LAN controller(MBH86960A) specific routines
95 */
96 static int fjn_config(struct net_device *dev, struct ifmap *map);
97 static int fjn_open(struct net_device *dev);
98 static int fjn_close(struct net_device *dev);
99 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev);
100 static irqreturn_t fjn_interrupt(int irq, void *dev_id);
101 static void fjn_rx(struct net_device *dev);
102 static void fjn_reset(struct net_device *dev);
103 static struct net_device_stats *fjn_get_stats(struct net_device *dev);
104 static void set_rx_mode(struct net_device *dev);
105 static void fjn_tx_timeout(struct net_device *dev);
106 static const struct ethtool_ops netdev_ethtool_ops;
107
108 /*
109 card type
110 */
111 typedef enum { MBH10302, MBH10304, TDK, CONTEC, LA501, UNGERMANN,
112 XXX10304
113 } cardtype_t;
114
115 /*
116 driver specific data structure
117 */
118 typedef struct local_info_t {
119 struct pcmcia_device *p_dev;
120 dev_node_t node;
121 struct net_device_stats stats;
122 long open_time;
123 uint tx_started:1;
124 uint tx_queue;
125 u_short tx_queue_len;
126 cardtype_t cardtype;
127 u_short sent;
128 } local_info_t;
129
130 #define MC_FILTERBREAK 64
131
132 /*====================================================================*/
133 /*
134 ioport offset from the base address
135 */
136 #define TX_STATUS 0 /* transmit status register */
137 #define RX_STATUS 1 /* receive status register */
138 #define TX_INTR 2 /* transmit interrupt mask register */
139 #define RX_INTR 3 /* receive interrupt mask register */
140 #define TX_MODE 4 /* transmit mode register */
141 #define RX_MODE 5 /* receive mode register */
142 #define CONFIG_0 6 /* configuration register 0 */
143 #define CONFIG_1 7 /* configuration register 1 */
144
145 #define NODE_ID 8 /* node ID register (bank 0) */
146 #define MAR_ADR 8 /* multicast address registers (bank 1) */
147
148 #define DATAPORT 8 /* buffer mem port registers (bank 2) */
149 #define TX_START 10 /* transmit start register */
150 #define COL_CTRL 11 /* 16 collision control register */
151 #define BMPR12 12 /* reserved */
152 #define BMPR13 13 /* reserved */
153 #define RX_SKIP 14 /* skip received packet register */
154
155 #define LAN_CTRL 16 /* LAN card control register */
156
157 #define MAC_ID 0x1a /* hardware address */
158 #define UNGERMANN_MAC_ID 0x18 /* UNGERMANN-BASS hardware address */
159
160 /*
161 control bits
162 */
163 #define ENA_TMT_OK 0x80
164 #define ENA_TMT_REC 0x20
165 #define ENA_COL 0x04
166 #define ENA_16_COL 0x02
167 #define ENA_TBUS_ERR 0x01
168
169 #define ENA_PKT_RDY 0x80
170 #define ENA_BUS_ERR 0x40
171 #define ENA_LEN_ERR 0x08
172 #define ENA_ALG_ERR 0x04
173 #define ENA_CRC_ERR 0x02
174 #define ENA_OVR_FLO 0x01
175
176 /* flags */
177 #define F_TMT_RDY 0x80 /* can accept new packet */
178 #define F_NET_BSY 0x40 /* carrier is detected */
179 #define F_TMT_OK 0x20 /* send packet successfully */
180 #define F_SRT_PKT 0x10 /* short packet error */
181 #define F_COL_ERR 0x04 /* collision error */
182 #define F_16_COL 0x02 /* 16 collision error */
183 #define F_TBUS_ERR 0x01 /* bus read error */
184
185 #define F_PKT_RDY 0x80 /* packet(s) in buffer */
186 #define F_BUS_ERR 0x40 /* bus read error */
187 #define F_LEN_ERR 0x08 /* short packet */
188 #define F_ALG_ERR 0x04 /* frame error */
189 #define F_CRC_ERR 0x02 /* CRC error */
190 #define F_OVR_FLO 0x01 /* overflow error */
191
192 #define F_BUF_EMP 0x40 /* receive buffer is empty */
193
194 #define F_SKP_PKT 0x05 /* drop packet in buffer */
195
196 /* default bitmaps */
197 #define D_TX_INTR ( ENA_TMT_OK )
198 #define D_RX_INTR ( ENA_PKT_RDY | ENA_LEN_ERR \
199 | ENA_ALG_ERR | ENA_CRC_ERR | ENA_OVR_FLO )
200 #define TX_STAT_M ( F_TMT_RDY )
201 #define RX_STAT_M ( F_PKT_RDY | F_LEN_ERR \
202 | F_ALG_ERR | F_CRC_ERR | F_OVR_FLO )
203
204 /* commands */
205 #define D_TX_MODE 0x06 /* no tests, detect carrier */
206 #define ID_MATCHED 0x02 /* (RX_MODE) */
207 #define RECV_ALL 0x03 /* (RX_MODE) */
208 #define CONFIG0_DFL 0x5a /* 16bit bus, 4K x 2 Tx queues */
209 #define CONFIG0_DFL_1 0x5e /* 16bit bus, 8K x 2 Tx queues */
210 #define CONFIG0_RST 0xda /* Data Link Controller off (CONFIG_0) */
211 #define CONFIG0_RST_1 0xde /* Data Link Controller off (CONFIG_0) */
212 #define BANK_0 0xa0 /* bank 0 (CONFIG_1) */
213 #define BANK_1 0xa4 /* bank 1 (CONFIG_1) */
214 #define BANK_2 0xa8 /* bank 2 (CONFIG_1) */
215 #define CHIP_OFF 0x80 /* contrl chip power off (CONFIG_1) */
216 #define DO_TX 0x80 /* do transmit packet */
217 #define SEND_PKT 0x81 /* send a packet */
218 #define AUTO_MODE 0x07 /* Auto skip packet on 16 col detected */
219 #define MANU_MODE 0x03 /* Stop and skip packet on 16 col */
220 #define TDK_AUTO_MODE 0x47 /* Auto skip packet on 16 col detected */
221 #define TDK_MANU_MODE 0x43 /* Stop and skip packet on 16 col */
222 #define INTR_OFF 0x0d /* LAN controller ignores interrupts */
223 #define INTR_ON 0x1d /* LAN controller will catch interrupts */
224
225 #define TX_TIMEOUT ((400*HZ)/1000)
226
227 #define BANK_0U 0x20 /* bank 0 (CONFIG_1) */
228 #define BANK_1U 0x24 /* bank 1 (CONFIG_1) */
229 #define BANK_2U 0x28 /* bank 2 (CONFIG_1) */
230
231 static int fmvj18x_probe(struct pcmcia_device *link)
232 {
233 local_info_t *lp;
234 struct net_device *dev;
235
236 DEBUG(0, "fmvj18x_attach()\n");
237
238 /* Make up a FMVJ18x specific data structure */
239 dev = alloc_etherdev(sizeof(local_info_t));
240 if (!dev)
241 return -ENOMEM;
242 lp = netdev_priv(dev);
243 link->priv = dev;
244 lp->p_dev = link;
245
246 /* The io structure describes IO port mapping */
247 link->io.NumPorts1 = 32;
248 link->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
249 link->io.IOAddrLines = 5;
250
251 /* Interrupt setup */
252 link->irq.Attributes = IRQ_TYPE_EXCLUSIVE | IRQ_HANDLE_PRESENT;
253 link->irq.IRQInfo1 = IRQ_LEVEL_ID;
254 link->irq.Handler = &fjn_interrupt;
255 link->irq.Instance = dev;
256
257 /* General socket configuration */
258 link->conf.Attributes = CONF_ENABLE_IRQ;
259 link->conf.IntType = INT_MEMORY_AND_IO;
260
261 /* The FMVJ18x specific entries in the device structure. */
262 SET_MODULE_OWNER(dev);
263 dev->hard_start_xmit = &fjn_start_xmit;
264 dev->set_config = &fjn_config;
265 dev->get_stats = &fjn_get_stats;
266 dev->set_multicast_list = &set_rx_mode;
267 dev->open = &fjn_open;
268 dev->stop = &fjn_close;
269 #ifdef HAVE_TX_TIMEOUT
270 dev->tx_timeout = fjn_tx_timeout;
271 dev->watchdog_timeo = TX_TIMEOUT;
272 #endif
273 SET_ETHTOOL_OPS(dev, &netdev_ethtool_ops);
274
275 return fmvj18x_config(link);
276 } /* fmvj18x_attach */
277
278 /*====================================================================*/
279
280 static void fmvj18x_detach(struct pcmcia_device *link)
281 {
282 struct net_device *dev = link->priv;
283
284 DEBUG(0, "fmvj18x_detach(0x%p)\n", link);
285
286 if (link->dev_node)
287 unregister_netdev(dev);
288
289 fmvj18x_release(link);
290
291 free_netdev(dev);
292 } /* fmvj18x_detach */
293
294 /*====================================================================*/
295
296 #define CS_CHECK(fn, ret) \
297 do { last_fn = (fn); if ((last_ret = (ret)) != 0) goto cs_failed; } while (0)
298
299 static int mfc_try_io_port(struct pcmcia_device *link)
300 {
301 int i, ret;
302 static const kio_addr_t serial_base[5] = { 0x3f8, 0x2f8, 0x3e8, 0x2e8, 0x0 };
303
304 for (i = 0; i < 5; i++) {
305 link->io.BasePort2 = serial_base[i];
306 link->io.Attributes2 = IO_DATA_PATH_WIDTH_8;
307 if (link->io.BasePort2 == 0) {
308 link->io.NumPorts2 = 0;
309 printk(KERN_NOTICE "fmvj18x_cs: out of resource for serial\n");
310 }
311 ret = pcmcia_request_io(link, &link->io);
312 if (ret == CS_SUCCESS) return ret;
313 }
314 return ret;
315 }
316
317 static int ungermann_try_io_port(struct pcmcia_device *link)
318 {
319 int ret;
320 kio_addr_t ioaddr;
321 /*
322 Ungermann-Bass Access/CARD accepts 0x300,0x320,0x340,0x360
323 0x380,0x3c0 only for ioport.
324 */
325 for (ioaddr = 0x300; ioaddr < 0x3e0; ioaddr += 0x20) {
326 link->io.BasePort1 = ioaddr;
327 ret = pcmcia_request_io(link, &link->io);
328 if (ret == CS_SUCCESS) {
329 /* calculate ConfigIndex value */
330 link->conf.ConfigIndex =
331 ((link->io.BasePort1 & 0x0f0) >> 3) | 0x22;
332 return ret;
333 }
334 }
335 return ret; /* RequestIO failed */
336 }
337
338 static int fmvj18x_config(struct pcmcia_device *link)
339 {
340 struct net_device *dev = link->priv;
341 local_info_t *lp = netdev_priv(dev);
342 tuple_t tuple;
343 cisparse_t parse;
344 u_short buf[32];
345 int i, last_fn = 0, last_ret = 0, ret;
346 kio_addr_t ioaddr;
347 cardtype_t cardtype;
348 char *card_name = "unknown";
349 u_char *node_id;
350
351 DEBUG(0, "fmvj18x_config(0x%p)\n", link);
352
353 tuple.TupleData = (u_char *)buf;
354 tuple.TupleDataMax = 64;
355 tuple.TupleOffset = 0;
356 tuple.DesiredTuple = CISTPL_FUNCE;
357 tuple.TupleOffset = 0;
358 if (pcmcia_get_first_tuple(link, &tuple) == CS_SUCCESS) {
359 /* Yes, I have CISTPL_FUNCE. Let's check CISTPL_MANFID */
360 tuple.DesiredTuple = CISTPL_CFTABLE_ENTRY;
361 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
362 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
363 CS_CHECK(ParseTuple, pcmcia_parse_tuple(link, &tuple, &parse));
364 link->conf.ConfigIndex = parse.cftable_entry.index;
365 switch (link->manf_id) {
366 case MANFID_TDK:
367 cardtype = TDK;
368 if (link->card_id == PRODID_TDK_GN3410
369 || link->card_id == PRODID_TDK_NP9610
370 || link->card_id == PRODID_TDK_MN3200) {
371 /* MultiFunction Card */
372 link->conf.ConfigBase = 0x800;
373 link->conf.ConfigIndex = 0x47;
374 link->io.NumPorts2 = 8;
375 }
376 break;
377 case MANFID_CONTEC:
378 cardtype = CONTEC;
379 break;
380 case MANFID_FUJITSU:
381 if (link->card_id == PRODID_FUJITSU_MBH10302)
382 /* RATOC REX-5588/9822/4886's PRODID are 0004(=MBH10302),
383 but these are MBH10304 based card. */
384 cardtype = MBH10304;
385 else if (link->card_id == PRODID_FUJITSU_MBH10304)
386 cardtype = MBH10304;
387 else
388 cardtype = LA501;
389 break;
390 default:
391 cardtype = MBH10304;
392 }
393 } else {
394 /* old type card */
395 switch (link->manf_id) {
396 case MANFID_FUJITSU:
397 if (link->card_id == PRODID_FUJITSU_MBH10304) {
398 cardtype = XXX10304; /* MBH10304 with buggy CIS */
399 link->conf.ConfigIndex = 0x20;
400 } else {
401 cardtype = MBH10302; /* NextCom NC5310, etc. */
402 link->conf.ConfigIndex = 1;
403 }
404 break;
405 case MANFID_UNGERMANN:
406 cardtype = UNGERMANN;
407 break;
408 default:
409 cardtype = MBH10302;
410 link->conf.ConfigIndex = 1;
411 }
412 }
413
414 if (link->io.NumPorts2 != 0) {
415 link->irq.Attributes =
416 IRQ_TYPE_DYNAMIC_SHARING|IRQ_FIRST_SHARED|IRQ_HANDLE_PRESENT;
417 ret = mfc_try_io_port(link);
418 if (ret != CS_SUCCESS) goto cs_failed;
419 } else if (cardtype == UNGERMANN) {
420 ret = ungermann_try_io_port(link);
421 if (ret != CS_SUCCESS) goto cs_failed;
422 } else {
423 CS_CHECK(RequestIO, pcmcia_request_io(link, &link->io));
424 }
425 CS_CHECK(RequestIRQ, pcmcia_request_irq(link, &link->irq));
426 CS_CHECK(RequestConfiguration, pcmcia_request_configuration(link, &link->conf));
427 dev->irq = link->irq.AssignedIRQ;
428 dev->base_addr = link->io.BasePort1;
429
430 if (link->io.BasePort2 != 0)
431 fmvj18x_setup_mfc(link);
432
433 ioaddr = dev->base_addr;
434
435 /* Reset controller */
436 if (sram_config == 0)
437 outb(CONFIG0_RST, ioaddr + CONFIG_0);
438 else
439 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
440
441 /* Power On chip and select bank 0 */
442 if (cardtype == MBH10302)
443 outb(BANK_0, ioaddr + CONFIG_1);
444 else
445 outb(BANK_0U, ioaddr + CONFIG_1);
446
447 /* Set hardware address */
448 switch (cardtype) {
449 case MBH10304:
450 case TDK:
451 case LA501:
452 case CONTEC:
453 tuple.DesiredTuple = CISTPL_FUNCE;
454 tuple.TupleOffset = 0;
455 CS_CHECK(GetFirstTuple, pcmcia_get_first_tuple(link, &tuple));
456 tuple.TupleOffset = 0;
457 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
458 if (cardtype == MBH10304) {
459 /* MBH10304's CIS_FUNCE is corrupted */
460 node_id = &(tuple.TupleData[5]);
461 card_name = "FMV-J182";
462 } else {
463 while (tuple.TupleData[0] != CISTPL_FUNCE_LAN_NODE_ID ) {
464 CS_CHECK(GetNextTuple, pcmcia_get_next_tuple(link, &tuple));
465 CS_CHECK(GetTupleData, pcmcia_get_tuple_data(link, &tuple));
466 }
467 node_id = &(tuple.TupleData[2]);
468 if( cardtype == TDK ) {
469 card_name = "TDK LAK-CD021";
470 } else if( cardtype == LA501 ) {
471 card_name = "LA501";
472 } else {
473 card_name = "C-NET(PC)C";
474 }
475 }
476 /* Read MACID from CIS */
477 for (i = 0; i < 6; i++)
478 dev->dev_addr[i] = node_id[i];
479 break;
480 case UNGERMANN:
481 /* Read MACID from register */
482 for (i = 0; i < 6; i++)
483 dev->dev_addr[i] = inb(ioaddr + UNGERMANN_MAC_ID + i);
484 card_name = "Access/CARD";
485 break;
486 case XXX10304:
487 /* Read MACID from Buggy CIS */
488 if (fmvj18x_get_hwinfo(link, tuple.TupleData) == -1) {
489 printk(KERN_NOTICE "fmvj18x_cs: unable to read hardware net address.\n");
490 goto failed;
491 }
492 for (i = 0 ; i < 6; i++) {
493 dev->dev_addr[i] = tuple.TupleData[i];
494 }
495 card_name = "FMV-J182";
496 break;
497 case MBH10302:
498 default:
499 /* Read MACID from register */
500 for (i = 0; i < 6; i++)
501 dev->dev_addr[i] = inb(ioaddr + MAC_ID + i);
502 card_name = "FMV-J181";
503 break;
504 }
505
506 lp->cardtype = cardtype;
507 link->dev_node = &lp->node;
508 SET_NETDEV_DEV(dev, &handle_to_dev(link));
509
510 if (register_netdev(dev) != 0) {
511 printk(KERN_NOTICE "fmvj18x_cs: register_netdev() failed\n");
512 link->dev_node = NULL;
513 goto failed;
514 }
515
516 strcpy(lp->node.dev_name, dev->name);
517
518 /* print current configuration */
519 printk(KERN_INFO "%s: %s, sram %s, port %#3lx, irq %d, hw_addr ",
520 dev->name, card_name, sram_config == 0 ? "4K TX*2" : "8K TX*2",
521 dev->base_addr, dev->irq);
522 for (i = 0; i < 6; i++)
523 printk("%02X%s", dev->dev_addr[i], ((i<5) ? ":" : "\n"));
524
525 return 0;
526
527 cs_failed:
528 /* All Card Services errors end up here */
529 cs_error(link, last_fn, last_ret);
530 failed:
531 fmvj18x_release(link);
532 return -ENODEV;
533 } /* fmvj18x_config */
534 /*====================================================================*/
535
536 static int fmvj18x_get_hwinfo(struct pcmcia_device *link, u_char *node_id)
537 {
538 win_req_t req;
539 memreq_t mem;
540 u_char __iomem *base;
541 int i, j;
542
543 /* Allocate a small memory window */
544 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
545 req.Base = 0; req.Size = 0;
546 req.AccessSpeed = 0;
547 i = pcmcia_request_window(&link, &req, &link->win);
548 if (i != CS_SUCCESS) {
549 cs_error(link, RequestWindow, i);
550 return -1;
551 }
552
553 base = ioremap(req.Base, req.Size);
554 mem.Page = 0;
555 mem.CardOffset = 0;
556 pcmcia_map_mem_page(link->win, &mem);
557
558 /*
559 * MBH10304 CISTPL_FUNCE_LAN_NODE_ID format
560 * 22 0d xx xx xx 04 06 yy yy yy yy yy yy ff
561 * 'xx' is garbage.
562 * 'yy' is MAC address.
563 */
564 for (i = 0; i < 0x200; i++) {
565 if (readb(base+i*2) == 0x22) {
566 if (readb(base+(i-1)*2) == 0xff
567 && readb(base+(i+5)*2) == 0x04
568 && readb(base+(i+6)*2) == 0x06
569 && readb(base+(i+13)*2) == 0xff)
570 break;
571 }
572 }
573
574 if (i != 0x200) {
575 for (j = 0 ; j < 6; j++,i++) {
576 node_id[j] = readb(base+(i+7)*2);
577 }
578 }
579
580 iounmap(base);
581 j = pcmcia_release_window(link->win);
582 if (j != CS_SUCCESS)
583 cs_error(link, ReleaseWindow, j);
584 return (i != 0x200) ? 0 : -1;
585
586 } /* fmvj18x_get_hwinfo */
587 /*====================================================================*/
588
589 static int fmvj18x_setup_mfc(struct pcmcia_device *link)
590 {
591 win_req_t req;
592 memreq_t mem;
593 u_char __iomem *base;
594 int i, j;
595 struct net_device *dev = link->priv;
596 kio_addr_t ioaddr;
597
598 /* Allocate a small memory window */
599 req.Attributes = WIN_DATA_WIDTH_8|WIN_MEMORY_TYPE_AM|WIN_ENABLE;
600 req.Base = 0; req.Size = 0;
601 req.AccessSpeed = 0;
602 i = pcmcia_request_window(&link, &req, &link->win);
603 if (i != CS_SUCCESS) {
604 cs_error(link, RequestWindow, i);
605 return -1;
606 }
607
608 base = ioremap(req.Base, req.Size);
609 mem.Page = 0;
610 mem.CardOffset = 0;
611 pcmcia_map_mem_page(link->win, &mem);
612
613 ioaddr = dev->base_addr;
614 writeb(0x47, base+0x800); /* Config Option Register of LAN */
615 writeb(0x0, base+0x802); /* Config and Status Register */
616
617 writeb(ioaddr & 0xff, base+0x80a); /* I/O Base(Low) of LAN */
618 writeb((ioaddr >> 8) & 0xff, base+0x80c); /* I/O Base(High) of LAN */
619
620 writeb(0x45, base+0x820); /* Config Option Register of Modem */
621 writeb(0x8, base+0x822); /* Config and Status Register */
622
623 iounmap(base);
624 j = pcmcia_release_window(link->win);
625 if (j != CS_SUCCESS)
626 cs_error(link, ReleaseWindow, j);
627 return 0;
628
629 }
630 /*====================================================================*/
631
632 static void fmvj18x_release(struct pcmcia_device *link)
633 {
634 DEBUG(0, "fmvj18x_release(0x%p)\n", link);
635 pcmcia_disable_device(link);
636 }
637
638 static int fmvj18x_suspend(struct pcmcia_device *link)
639 {
640 struct net_device *dev = link->priv;
641
642 if (link->open)
643 netif_device_detach(dev);
644
645 return 0;
646 }
647
648 static int fmvj18x_resume(struct pcmcia_device *link)
649 {
650 struct net_device *dev = link->priv;
651
652 if (link->open) {
653 fjn_reset(dev);
654 netif_device_attach(dev);
655 }
656
657 return 0;
658 }
659
660 /*====================================================================*/
661
662 static struct pcmcia_device_id fmvj18x_ids[] = {
663 PCMCIA_DEVICE_MANF_CARD(0x0004, 0x0004),
664 PCMCIA_DEVICE_PROD_ID12("EAGLE Technology", "NE200 ETHERNET LAN MBH10302 04", 0x528c88c4, 0x74f91e59),
665 PCMCIA_DEVICE_PROD_ID12("Eiger Labs,Inc", "EPX-10BT PC Card Ethernet 10BT", 0x53af556e, 0x877f9922),
666 PCMCIA_DEVICE_PROD_ID12("Eiger labs,Inc.", "EPX-10BT PC Card Ethernet 10BT", 0xf47e6c66, 0x877f9922),
667 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "LAN Card(FMV-J182)", 0x6ee5a3d8, 0x5baf31db),
668 PCMCIA_DEVICE_PROD_ID12("FUJITSU", "MBH10308", 0x6ee5a3d8, 0x3f04875e),
669 PCMCIA_DEVICE_PROD_ID12("FUJITSU TOWA", "LA501", 0xb8451188, 0x12939ba2),
670 PCMCIA_DEVICE_PROD_ID12("HITACHI", "HT-4840-11", 0xf4f43949, 0x773910f4),
671 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310B Ver1.0 ", 0x8cef4d3a, 0x075fc7b6),
672 PCMCIA_DEVICE_PROD_ID12("NextComK.K.", "NC5310 Ver1.0 ", 0x8cef4d3a, 0xbccf43e6),
673 PCMCIA_DEVICE_PROD_ID12("RATOC System Inc.", "10BASE_T CARD R280", 0x85c10e17, 0xd9413666),
674 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CD02x", 0x1eae9475, 0x8fa0ee70),
675 PCMCIA_DEVICE_PROD_ID12("TDK", "LAC-CF010", 0x1eae9475, 0x7683bc9a),
676 PCMCIA_DEVICE_PROD_ID1("CONTEC Co.,Ltd.", 0x58d8fee2),
677 PCMCIA_DEVICE_PROD_ID1("PCMCIA LAN MBH10304 ES", 0x2599f454),
678 PCMCIA_DEVICE_PROD_ID1("PCMCIA MBH10302", 0x8f4005da),
679 PCMCIA_DEVICE_PROD_ID1("UBKK,V2.0", 0x90888080),
680 PCMCIA_PFC_DEVICE_PROD_ID12(0, "TDK", "GlobalNetworker 3410/3412", 0x1eae9475, 0xd9a93bed),
681 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0d0a),
682 PCMCIA_PFC_DEVICE_MANF_CARD(0, 0x0105, 0x0e0a),
683 PCMCIA_DEVICE_NULL,
684 };
685 MODULE_DEVICE_TABLE(pcmcia, fmvj18x_ids);
686
687 static struct pcmcia_driver fmvj18x_cs_driver = {
688 .owner = THIS_MODULE,
689 .drv = {
690 .name = "fmvj18x_cs",
691 },
692 .probe = fmvj18x_probe,
693 .remove = fmvj18x_detach,
694 .id_table = fmvj18x_ids,
695 .suspend = fmvj18x_suspend,
696 .resume = fmvj18x_resume,
697 };
698
699 static int __init init_fmvj18x_cs(void)
700 {
701 return pcmcia_register_driver(&fmvj18x_cs_driver);
702 }
703
704 static void __exit exit_fmvj18x_cs(void)
705 {
706 pcmcia_unregister_driver(&fmvj18x_cs_driver);
707 }
708
709 module_init(init_fmvj18x_cs);
710 module_exit(exit_fmvj18x_cs);
711
712 /*====================================================================*/
713
714 static irqreturn_t fjn_interrupt(int irq, void *dev_id)
715 {
716 struct net_device *dev = dev_id;
717 local_info_t *lp = netdev_priv(dev);
718 kio_addr_t ioaddr;
719 unsigned short tx_stat, rx_stat;
720
721 if (lp == NULL) {
722 printk(KERN_NOTICE "fjn_interrupt(): irq %d for "
723 "unknown device.\n", irq);
724 return IRQ_NONE;
725 }
726 ioaddr = dev->base_addr;
727
728 /* avoid multiple interrupts */
729 outw(0x0000, ioaddr + TX_INTR);
730
731 /* wait for a while */
732 udelay(1);
733
734 /* get status */
735 tx_stat = inb(ioaddr + TX_STATUS);
736 rx_stat = inb(ioaddr + RX_STATUS);
737
738 /* clear status */
739 outb(tx_stat, ioaddr + TX_STATUS);
740 outb(rx_stat, ioaddr + RX_STATUS);
741
742 DEBUG(4, "%s: interrupt, rx_status %02x.\n", dev->name, rx_stat);
743 DEBUG(4, " tx_status %02x.\n", tx_stat);
744
745 if (rx_stat || (inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
746 /* there is packet(s) in rx buffer */
747 fjn_rx(dev);
748 }
749 if (tx_stat & F_TMT_RDY) {
750 lp->stats.tx_packets += lp->sent ;
751 lp->sent = 0 ;
752 if (lp->tx_queue) {
753 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
754 lp->sent = lp->tx_queue ;
755 lp->tx_queue = 0;
756 lp->tx_queue_len = 0;
757 dev->trans_start = jiffies;
758 } else {
759 lp->tx_started = 0;
760 }
761 netif_wake_queue(dev);
762 }
763 DEBUG(4, "%s: exiting interrupt,\n", dev->name);
764 DEBUG(4, " tx_status %02x, rx_status %02x.\n", tx_stat, rx_stat);
765
766 outb(D_TX_INTR, ioaddr + TX_INTR);
767 outb(D_RX_INTR, ioaddr + RX_INTR);
768 return IRQ_HANDLED;
769
770 } /* fjn_interrupt */
771
772 /*====================================================================*/
773
774 static void fjn_tx_timeout(struct net_device *dev)
775 {
776 struct local_info_t *lp = netdev_priv(dev);
777 kio_addr_t ioaddr = dev->base_addr;
778
779 printk(KERN_NOTICE "%s: transmit timed out with status %04x, %s?\n",
780 dev->name, htons(inw(ioaddr + TX_STATUS)),
781 inb(ioaddr + TX_STATUS) & F_TMT_RDY
782 ? "IRQ conflict" : "network cable problem");
783 printk(KERN_NOTICE "%s: timeout registers: %04x %04x %04x "
784 "%04x %04x %04x %04x %04x.\n",
785 dev->name, htons(inw(ioaddr + 0)),
786 htons(inw(ioaddr + 2)), htons(inw(ioaddr + 4)),
787 htons(inw(ioaddr + 6)), htons(inw(ioaddr + 8)),
788 htons(inw(ioaddr +10)), htons(inw(ioaddr +12)),
789 htons(inw(ioaddr +14)));
790 lp->stats.tx_errors++;
791 /* ToDo: We should try to restart the adaptor... */
792 local_irq_disable();
793 fjn_reset(dev);
794
795 lp->tx_started = 0;
796 lp->tx_queue = 0;
797 lp->tx_queue_len = 0;
798 lp->sent = 0;
799 lp->open_time = jiffies;
800 local_irq_enable();
801 netif_wake_queue(dev);
802 }
803
804 static int fjn_start_xmit(struct sk_buff *skb, struct net_device *dev)
805 {
806 struct local_info_t *lp = netdev_priv(dev);
807 kio_addr_t ioaddr = dev->base_addr;
808 short length = skb->len;
809
810 if (length < ETH_ZLEN)
811 {
812 if (skb_padto(skb, ETH_ZLEN))
813 return 0;
814 length = ETH_ZLEN;
815 }
816
817 netif_stop_queue(dev);
818
819 {
820 unsigned char *buf = skb->data;
821
822 if (length > ETH_FRAME_LEN) {
823 printk(KERN_NOTICE "%s: Attempting to send a large packet"
824 " (%d bytes).\n", dev->name, length);
825 return 1;
826 }
827
828 DEBUG(4, "%s: Transmitting a packet of length %lu.\n",
829 dev->name, (unsigned long)skb->len);
830 lp->stats.tx_bytes += skb->len;
831
832 /* Disable both interrupts. */
833 outw(0x0000, ioaddr + TX_INTR);
834
835 /* wait for a while */
836 udelay(1);
837
838 outw(length, ioaddr + DATAPORT);
839 outsw(ioaddr + DATAPORT, buf, (length + 1) >> 1);
840
841 lp->tx_queue++;
842 lp->tx_queue_len += ((length+3) & ~1);
843
844 if (lp->tx_started == 0) {
845 /* If the Tx is idle, always trigger a transmit. */
846 outb(DO_TX | lp->tx_queue, ioaddr + TX_START);
847 lp->sent = lp->tx_queue ;
848 lp->tx_queue = 0;
849 lp->tx_queue_len = 0;
850 dev->trans_start = jiffies;
851 lp->tx_started = 1;
852 netif_start_queue(dev);
853 } else {
854 if( sram_config == 0 ) {
855 if (lp->tx_queue_len < (4096 - (ETH_FRAME_LEN +2)) )
856 /* Yes, there is room for one more packet. */
857 netif_start_queue(dev);
858 } else {
859 if (lp->tx_queue_len < (8192 - (ETH_FRAME_LEN +2)) &&
860 lp->tx_queue < 127 )
861 /* Yes, there is room for one more packet. */
862 netif_start_queue(dev);
863 }
864 }
865
866 /* Re-enable interrupts */
867 outb(D_TX_INTR, ioaddr + TX_INTR);
868 outb(D_RX_INTR, ioaddr + RX_INTR);
869 }
870 dev_kfree_skb (skb);
871
872 return 0;
873 } /* fjn_start_xmit */
874
875 /*====================================================================*/
876
877 static void fjn_reset(struct net_device *dev)
878 {
879 struct local_info_t *lp = netdev_priv(dev);
880 kio_addr_t ioaddr = dev->base_addr;
881 int i;
882
883 DEBUG(4, "fjn_reset(%s) called.\n",dev->name);
884
885 /* Reset controller */
886 if( sram_config == 0 )
887 outb(CONFIG0_RST, ioaddr + CONFIG_0);
888 else
889 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
890
891 /* Power On chip and select bank 0 */
892 if (lp->cardtype == MBH10302)
893 outb(BANK_0, ioaddr + CONFIG_1);
894 else
895 outb(BANK_0U, ioaddr + CONFIG_1);
896
897 /* Set Tx modes */
898 outb(D_TX_MODE, ioaddr + TX_MODE);
899 /* set Rx modes */
900 outb(ID_MATCHED, ioaddr + RX_MODE);
901
902 /* Set hardware address */
903 for (i = 0; i < 6; i++)
904 outb(dev->dev_addr[i], ioaddr + NODE_ID + i);
905
906 /* (re)initialize the multicast table */
907 set_rx_mode(dev);
908
909 /* Switch to bank 2 (runtime mode) */
910 if (lp->cardtype == MBH10302)
911 outb(BANK_2, ioaddr + CONFIG_1);
912 else
913 outb(BANK_2U, ioaddr + CONFIG_1);
914
915 /* set 16col ctrl bits */
916 if( lp->cardtype == TDK || lp->cardtype == CONTEC)
917 outb(TDK_AUTO_MODE, ioaddr + COL_CTRL);
918 else
919 outb(AUTO_MODE, ioaddr + COL_CTRL);
920
921 /* clear Reserved Regs */
922 outb(0x00, ioaddr + BMPR12);
923 outb(0x00, ioaddr + BMPR13);
924
925 /* reset Skip packet reg. */
926 outb(0x01, ioaddr + RX_SKIP);
927
928 /* Enable Tx and Rx */
929 if( sram_config == 0 )
930 outb(CONFIG0_DFL, ioaddr + CONFIG_0);
931 else
932 outb(CONFIG0_DFL_1, ioaddr + CONFIG_0);
933
934 /* Init receive pointer ? */
935 inw(ioaddr + DATAPORT);
936 inw(ioaddr + DATAPORT);
937
938 /* Clear all status */
939 outb(0xff, ioaddr + TX_STATUS);
940 outb(0xff, ioaddr + RX_STATUS);
941
942 if (lp->cardtype == MBH10302)
943 outb(INTR_OFF, ioaddr + LAN_CTRL);
944
945 /* Turn on Rx interrupts */
946 outb(D_TX_INTR, ioaddr + TX_INTR);
947 outb(D_RX_INTR, ioaddr + RX_INTR);
948
949 /* Turn on interrupts from LAN card controller */
950 if (lp->cardtype == MBH10302)
951 outb(INTR_ON, ioaddr + LAN_CTRL);
952 } /* fjn_reset */
953
954 /*====================================================================*/
955
956 static void fjn_rx(struct net_device *dev)
957 {
958 struct local_info_t *lp = netdev_priv(dev);
959 kio_addr_t ioaddr = dev->base_addr;
960 int boguscount = 10; /* 5 -> 10: by agy 19940922 */
961
962 DEBUG(4, "%s: in rx_packet(), rx_status %02x.\n",
963 dev->name, inb(ioaddr + RX_STATUS));
964
965 while ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == 0) {
966 u_short status = inw(ioaddr + DATAPORT);
967
968 DEBUG(4, "%s: Rxing packet mode %02x status %04x.\n",
969 dev->name, inb(ioaddr + RX_MODE), status);
970 #ifndef final_version
971 if (status == 0) {
972 outb(F_SKP_PKT, ioaddr + RX_SKIP);
973 break;
974 }
975 #endif
976 if ((status & 0xF0) != 0x20) { /* There was an error. */
977 lp->stats.rx_errors++;
978 if (status & F_LEN_ERR) lp->stats.rx_length_errors++;
979 if (status & F_ALG_ERR) lp->stats.rx_frame_errors++;
980 if (status & F_CRC_ERR) lp->stats.rx_crc_errors++;
981 if (status & F_OVR_FLO) lp->stats.rx_over_errors++;
982 } else {
983 u_short pkt_len = inw(ioaddr + DATAPORT);
984 /* Malloc up new buffer. */
985 struct sk_buff *skb;
986
987 if (pkt_len > 1550) {
988 printk(KERN_NOTICE "%s: The FMV-18x claimed a very "
989 "large packet, size %d.\n", dev->name, pkt_len);
990 outb(F_SKP_PKT, ioaddr + RX_SKIP);
991 lp->stats.rx_errors++;
992 break;
993 }
994 skb = dev_alloc_skb(pkt_len+2);
995 if (skb == NULL) {
996 printk(KERN_NOTICE "%s: Memory squeeze, dropping "
997 "packet (len %d).\n", dev->name, pkt_len);
998 outb(F_SKP_PKT, ioaddr + RX_SKIP);
999 lp->stats.rx_dropped++;
1000 break;
1001 }
1002 skb->dev = dev;
1003
1004 skb_reserve(skb, 2);
1005 insw(ioaddr + DATAPORT, skb_put(skb, pkt_len),
1006 (pkt_len + 1) >> 1);
1007 skb->protocol = eth_type_trans(skb, dev);
1008
1009 #ifdef PCMCIA_DEBUG
1010 if (pc_debug > 5) {
1011 int i;
1012 printk(KERN_DEBUG "%s: Rxed packet of length %d: ",
1013 dev->name, pkt_len);
1014 for (i = 0; i < 14; i++)
1015 printk(" %02x", skb->data[i]);
1016 printk(".\n");
1017 }
1018 #endif
1019
1020 netif_rx(skb);
1021 dev->last_rx = jiffies;
1022 lp->stats.rx_packets++;
1023 lp->stats.rx_bytes += pkt_len;
1024 }
1025 if (--boguscount <= 0)
1026 break;
1027 }
1028
1029 /* If any worth-while packets have been received, dev_rint()
1030 has done a netif_wake_queue() for us and will work on them
1031 when we get to the bottom-half routine. */
1032 /*
1033 if (lp->cardtype != TDK) {
1034 int i;
1035 for (i = 0; i < 20; i++) {
1036 if ((inb(ioaddr + RX_MODE) & F_BUF_EMP) == F_BUF_EMP)
1037 break;
1038 (void)inw(ioaddr + DATAPORT); /+ dummy status read +/
1039 outb(F_SKP_PKT, ioaddr + RX_SKIP);
1040 }
1041
1042 if (i > 0)
1043 DEBUG(5, "%s: Exint Rx packet with mode %02x after "
1044 "%d ticks.\n", dev->name, inb(ioaddr + RX_MODE), i);
1045 }
1046 */
1047
1048 return;
1049 } /* fjn_rx */
1050
1051 /*====================================================================*/
1052
1053 static void netdev_get_drvinfo(struct net_device *dev,
1054 struct ethtool_drvinfo *info)
1055 {
1056 strcpy(info->driver, DRV_NAME);
1057 strcpy(info->version, DRV_VERSION);
1058 sprintf(info->bus_info, "PCMCIA 0x%lx", dev->base_addr);
1059 }
1060
1061 #ifdef PCMCIA_DEBUG
1062 static u32 netdev_get_msglevel(struct net_device *dev)
1063 {
1064 return pc_debug;
1065 }
1066
1067 static void netdev_set_msglevel(struct net_device *dev, u32 level)
1068 {
1069 pc_debug = level;
1070 }
1071 #endif /* PCMCIA_DEBUG */
1072
1073 static const struct ethtool_ops netdev_ethtool_ops = {
1074 .get_drvinfo = netdev_get_drvinfo,
1075 #ifdef PCMCIA_DEBUG
1076 .get_msglevel = netdev_get_msglevel,
1077 .set_msglevel = netdev_set_msglevel,
1078 #endif /* PCMCIA_DEBUG */
1079 };
1080
1081 static int fjn_config(struct net_device *dev, struct ifmap *map){
1082 return 0;
1083 }
1084
1085 static int fjn_open(struct net_device *dev)
1086 {
1087 struct local_info_t *lp = netdev_priv(dev);
1088 struct pcmcia_device *link = lp->p_dev;
1089
1090 DEBUG(4, "fjn_open('%s').\n", dev->name);
1091
1092 if (!pcmcia_dev_present(link))
1093 return -ENODEV;
1094
1095 link->open++;
1096
1097 fjn_reset(dev);
1098
1099 lp->tx_started = 0;
1100 lp->tx_queue = 0;
1101 lp->tx_queue_len = 0;
1102 lp->open_time = jiffies;
1103 netif_start_queue(dev);
1104
1105 return 0;
1106 } /* fjn_open */
1107
1108 /*====================================================================*/
1109
1110 static int fjn_close(struct net_device *dev)
1111 {
1112 struct local_info_t *lp = netdev_priv(dev);
1113 struct pcmcia_device *link = lp->p_dev;
1114 kio_addr_t ioaddr = dev->base_addr;
1115
1116 DEBUG(4, "fjn_close('%s').\n", dev->name);
1117
1118 lp->open_time = 0;
1119 netif_stop_queue(dev);
1120
1121 /* Set configuration register 0 to disable Tx and Rx. */
1122 if( sram_config == 0 )
1123 outb(CONFIG0_RST ,ioaddr + CONFIG_0);
1124 else
1125 outb(CONFIG0_RST_1 ,ioaddr + CONFIG_0);
1126
1127 /* Update the statistics -- ToDo. */
1128
1129 /* Power-down the chip. Green, green, green! */
1130 outb(CHIP_OFF ,ioaddr + CONFIG_1);
1131
1132 /* Set the ethernet adaptor disable IRQ */
1133 if (lp->cardtype == MBH10302)
1134 outb(INTR_OFF, ioaddr + LAN_CTRL);
1135
1136 link->open--;
1137
1138 return 0;
1139 } /* fjn_close */
1140
1141 /*====================================================================*/
1142
1143 static struct net_device_stats *fjn_get_stats(struct net_device *dev)
1144 {
1145 local_info_t *lp = netdev_priv(dev);
1146 return &lp->stats;
1147 } /* fjn_get_stats */
1148
1149 /*====================================================================*/
1150
1151 /*
1152 Set the multicast/promiscuous mode for this adaptor.
1153 */
1154
1155 static void set_rx_mode(struct net_device *dev)
1156 {
1157 kio_addr_t ioaddr = dev->base_addr;
1158 u_char mc_filter[8]; /* Multicast hash filter */
1159 u_long flags;
1160 int i;
1161
1162 int saved_bank;
1163 int saved_config_0 = inb(ioaddr + CONFIG_0);
1164
1165 local_irq_save(flags);
1166
1167 /* Disable Tx and Rx */
1168 if (sram_config == 0)
1169 outb(CONFIG0_RST, ioaddr + CONFIG_0);
1170 else
1171 outb(CONFIG0_RST_1, ioaddr + CONFIG_0);
1172
1173 if (dev->flags & IFF_PROMISC) {
1174 memset(mc_filter, 0xff, sizeof(mc_filter));
1175 outb(3, ioaddr + RX_MODE); /* Enable promiscuous mode */
1176 } else if (dev->mc_count > MC_FILTERBREAK
1177 || (dev->flags & IFF_ALLMULTI)) {
1178 /* Too many to filter perfectly -- accept all multicasts. */
1179 memset(mc_filter, 0xff, sizeof(mc_filter));
1180 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1181 } else if (dev->mc_count == 0) {
1182 memset(mc_filter, 0x00, sizeof(mc_filter));
1183 outb(1, ioaddr + RX_MODE); /* Ignore almost all multicasts. */
1184 } else {
1185 struct dev_mc_list *mclist;
1186 int i;
1187
1188 memset(mc_filter, 0, sizeof(mc_filter));
1189 for (i = 0, mclist = dev->mc_list; mclist && i < dev->mc_count;
1190 i++, mclist = mclist->next) {
1191 unsigned int bit =
1192 ether_crc_le(ETH_ALEN, mclist->dmi_addr) >> 26;
1193 mc_filter[bit >> 3] |= (1 << (bit & 7));
1194 }
1195 outb(2, ioaddr + RX_MODE); /* Use normal mode. */
1196 }
1197
1198 /* Switch to bank 1 and set the multicast table. */
1199 saved_bank = inb(ioaddr + CONFIG_1);
1200 outb(0xe4, ioaddr + CONFIG_1);
1201
1202 for (i = 0; i < 8; i++)
1203 outb(mc_filter[i], ioaddr + MAR_ADR + i);
1204 outb(saved_bank, ioaddr + CONFIG_1);
1205
1206 outb(saved_config_0, ioaddr + CONFIG_0);
1207
1208 local_irq_restore(flags);
1209 }