1 /* cs89x0.c: A Crystal Semiconductor (Now Cirrus Logic) CS89[02]0 2 * driver for linux. 3 * Written 1996 by Russell Nelson, with reference to skeleton.c 4 * written 1993-1994 by Donald Becker. 5 * 6 * This software may be used and distributed according to the terms 7 * of the GNU General Public License, incorporated herein by reference. 8 * 9 * The author may be reached at nelson@crynwr.com, Crynwr 10 * Software, 521 Pleasant Valley Rd., Potsdam, NY 13676 11 * 12 * Other contributors: 13 * Mike Cruse : mcruse@cti-ltd.com 14 * Russ Nelson 15 * Melody Lee : ethernet@crystal.cirrus.com 16 * Alan Cox 17 * Andrew Morton 18 * Oskar Schirmer : oskar@scara.com 19 * Deepak Saxena : dsaxena@plexity.net 20 * Dmitry Pervushin : dpervushin@ru.mvista.com 21 * Deepak Saxena : dsaxena@plexity.net 22 * Domenico Andreoli : cavokz@gmail.com 23 */ 24 25 26 /* 27 * Set this to zero to disable DMA code 28 * 29 * Note that even if DMA is turned off we still support the 'dma' and 'use_dma' 30 * module options so we don't break any startup scripts. 31 */ 32 #ifndef CONFIG_ISA_DMA_API 33 #define ALLOW_DMA 0 34 #else 35 #define ALLOW_DMA 1 36 #endif 37 38 /* 39 * Set this to zero to remove all the debug statements via 40 * dead code elimination 41 */ 42 #define DEBUGGING 1 43 44 /* Sources: 45 * Crynwr packet driver epktisa. 46 * Crystal Semiconductor data sheets. 47 */ 48 49 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 50 51 #include <linux/module.h> 52 #include <linux/printk.h> 53 #include <linux/errno.h> 54 #include <linux/netdevice.h> 55 #include <linux/etherdevice.h> 56 #include <linux/of.h> 57 #include <linux/of_device.h> 58 #include <linux/platform_device.h> 59 #include <linux/kernel.h> 60 #include <linux/types.h> 61 #include <linux/fcntl.h> 62 #include <linux/interrupt.h> 63 #include <linux/ioport.h> 64 #include <linux/in.h> 65 #include <linux/jiffies.h> 66 #include <linux/skbuff.h> 67 #include <linux/spinlock.h> 68 #include <linux/string.h> 69 #include <linux/init.h> 70 #include <linux/bitops.h> 71 #include <linux/delay.h> 72 #include <linux/gfp.h> 73 #include <linux/io.h> 74 75 #include <asm/irq.h> 76 #include <linux/atomic.h> 77 #if ALLOW_DMA 78 #include <asm/dma.h> 79 #endif 80 81 #include "cs89x0.h" 82 83 #define cs89_dbg(val, level, fmt, ...) \ 84 do { \ 85 if (val <= net_debug) \ 86 pr_##level(fmt, ##__VA_ARGS__); \ 87 } while (0) 88 89 static char version[] __initdata = 90 "v2.4.3-pre1 Russell Nelson <nelson@crynwr.com>, Andrew Morton"; 91 92 #define DRV_NAME "cs89x0" 93 94 /* First, a few definitions that the brave might change. 95 * A zero-terminated list of I/O addresses to be probed. Some special flags.. 96 * Addr & 1 = Read back the address port, look for signature and reset 97 * the page window before probing 98 * Addr & 3 = Reset the page window and probe 99 * The CLPS eval board has the Cirrus chip at 0x80090300, in ARM IO space, 100 * but it is possible that a Cirrus board could be plugged into the ISA 101 * slots. 102 */ 103 /* The cs8900 has 4 IRQ pins, software selectable. cs8900_irq_map maps 104 * them to system IRQ numbers. This mapping is card specific and is set to 105 * the configuration of the Cirrus Eval board for this chip. 106 */ 107 #ifndef CONFIG_CS89x0_PLATFORM 108 static unsigned int netcard_portlist[] __used __initdata = { 109 0x300, 0x320, 0x340, 0x360, 0x200, 0x220, 0x240, 110 0x260, 0x280, 0x2a0, 0x2c0, 0x2e0, 0 111 }; 112 static unsigned int cs8900_irq_map[] = { 113 10, 11, 12, 5 114 }; 115 #endif 116 117 #if DEBUGGING 118 static unsigned int net_debug = DEBUGGING; 119 #else 120 #define net_debug 0 /* gcc will remove all the debug code for us */ 121 #endif 122 123 /* The number of low I/O ports used by the ethercard. */ 124 #define NETCARD_IO_EXTENT 16 125 126 /* we allow the user to override various values normally set in the EEPROM */ 127 #define FORCE_RJ45 0x0001 /* pick one of these three */ 128 #define FORCE_AUI 0x0002 129 #define FORCE_BNC 0x0004 130 131 #define FORCE_AUTO 0x0010 /* pick one of these three */ 132 #define FORCE_HALF 0x0020 133 #define FORCE_FULL 0x0030 134 135 /* Information that need to be kept for each board. */ 136 struct net_local { 137 int chip_type; /* one of: CS8900, CS8920, CS8920M */ 138 char chip_revision; /* revision letter of the chip ('A'...) */ 139 int send_cmd; /* the proper send command: TX_NOW, TX_AFTER_381, or TX_AFTER_ALL */ 140 int auto_neg_cnf; /* auto-negotiation word from EEPROM */ 141 int adapter_cnf; /* adapter configuration from EEPROM */ 142 int isa_config; /* ISA configuration from EEPROM */ 143 int irq_map; /* IRQ map from EEPROM */ 144 int rx_mode; /* what mode are we in? 0, RX_MULTCAST_ACCEPT, or RX_ALL_ACCEPT */ 145 int curr_rx_cfg; /* a copy of PP_RxCFG */ 146 int linectl; /* either 0 or LOW_RX_SQUELCH, depending on configuration. */ 147 int send_underrun; /* keep track of how many underruns in a row we get */ 148 int force; /* force various values; see FORCE* above. */ 149 spinlock_t lock; 150 void __iomem *virt_addr;/* CS89x0 virtual address. */ 151 #if ALLOW_DMA 152 int use_dma; /* Flag: we're using dma */ 153 int dma; /* DMA channel */ 154 int dmasize; /* 16 or 64 */ 155 unsigned char *dma_buff; /* points to the beginning of the buffer */ 156 unsigned char *end_dma_buff; /* points to the end of the buffer */ 157 unsigned char *rx_dma_ptr; /* points to the next packet */ 158 #endif 159 }; 160 161 /* Example routines you must write ;->. */ 162 #define tx_done(dev) 1 163 164 /* 165 * Permit 'cs89x0_dma=N' in the kernel boot environment 166 */ 167 #if !defined(MODULE) 168 #if ALLOW_DMA 169 static int g_cs89x0_dma; 170 171 static int __init dma_fn(char *str) 172 { 173 g_cs89x0_dma = simple_strtol(str, NULL, 0); 174 return 1; 175 } 176 177 __setup("cs89x0_dma=", dma_fn); 178 #endif /* ALLOW_DMA */ 179 180 static int g_cs89x0_media__force; 181 182 static int __init media_fn(char *str) 183 { 184 if (!strcmp(str, "rj45")) 185 g_cs89x0_media__force = FORCE_RJ45; 186 else if (!strcmp(str, "aui")) 187 g_cs89x0_media__force = FORCE_AUI; 188 else if (!strcmp(str, "bnc")) 189 g_cs89x0_media__force = FORCE_BNC; 190 191 return 1; 192 } 193 194 __setup("cs89x0_media=", media_fn); 195 #endif 196 197 static void readwords(struct net_local *lp, int portno, void *buf, int length) 198 { 199 u8 *buf8 = (u8 *)buf; 200 201 do { 202 u16 tmp16; 203 204 tmp16 = ioread16(lp->virt_addr + portno); 205 *buf8++ = (u8)tmp16; 206 *buf8++ = (u8)(tmp16 >> 8); 207 } while (--length); 208 } 209 210 static void writewords(struct net_local *lp, int portno, void *buf, int length) 211 { 212 u8 *buf8 = (u8 *)buf; 213 214 do { 215 u16 tmp16; 216 217 tmp16 = *buf8++; 218 tmp16 |= (*buf8++) << 8; 219 iowrite16(tmp16, lp->virt_addr + portno); 220 } while (--length); 221 } 222 223 static u16 224 readreg(struct net_device *dev, u16 regno) 225 { 226 struct net_local *lp = netdev_priv(dev); 227 228 iowrite16(regno, lp->virt_addr + ADD_PORT); 229 return ioread16(lp->virt_addr + DATA_PORT); 230 } 231 232 static void 233 writereg(struct net_device *dev, u16 regno, u16 value) 234 { 235 struct net_local *lp = netdev_priv(dev); 236 237 iowrite16(regno, lp->virt_addr + ADD_PORT); 238 iowrite16(value, lp->virt_addr + DATA_PORT); 239 } 240 241 static int __init 242 wait_eeprom_ready(struct net_device *dev) 243 { 244 unsigned long timeout = jiffies; 245 /* check to see if the EEPROM is ready, 246 * a timeout is used just in case EEPROM is ready when 247 * SI_BUSY in the PP_SelfST is clear 248 */ 249 while (readreg(dev, PP_SelfST) & SI_BUSY) 250 if (time_after_eq(jiffies, timeout + 40)) 251 return -1; 252 return 0; 253 } 254 255 static int __init 256 get_eeprom_data(struct net_device *dev, int off, int len, int *buffer) 257 { 258 int i; 259 260 cs89_dbg(3, info, "EEPROM data from %x for %x:", off, len); 261 for (i = 0; i < len; i++) { 262 if (wait_eeprom_ready(dev) < 0) 263 return -1; 264 /* Now send the EEPROM read command and EEPROM location to read */ 265 writereg(dev, PP_EECMD, (off + i) | EEPROM_READ_CMD); 266 if (wait_eeprom_ready(dev) < 0) 267 return -1; 268 buffer[i] = readreg(dev, PP_EEData); 269 cs89_dbg(3, cont, " %04x", buffer[i]); 270 } 271 cs89_dbg(3, cont, "\n"); 272 return 0; 273 } 274 275 static int __init 276 get_eeprom_cksum(int off, int len, int *buffer) 277 { 278 int i, cksum; 279 280 cksum = 0; 281 for (i = 0; i < len; i++) 282 cksum += buffer[i]; 283 cksum &= 0xffff; 284 if (cksum == 0) 285 return 0; 286 return -1; 287 } 288 289 static void 290 write_irq(struct net_device *dev, int chip_type, int irq) 291 { 292 int i; 293 294 if (chip_type == CS8900) { 295 #ifndef CONFIG_CS89x0_PLATFORM 296 /* Search the mapping table for the corresponding IRQ pin. */ 297 for (i = 0; i != ARRAY_SIZE(cs8900_irq_map); i++) 298 if (cs8900_irq_map[i] == irq) 299 break; 300 /* Not found */ 301 if (i == ARRAY_SIZE(cs8900_irq_map)) 302 i = 3; 303 #else 304 /* INTRQ0 pin is used for interrupt generation. */ 305 i = 0; 306 #endif 307 writereg(dev, PP_CS8900_ISAINT, i); 308 } else { 309 writereg(dev, PP_CS8920_ISAINT, irq); 310 } 311 } 312 313 static void 314 count_rx_errors(int status, struct net_device *dev) 315 { 316 dev->stats.rx_errors++; 317 if (status & RX_RUNT) 318 dev->stats.rx_length_errors++; 319 if (status & RX_EXTRA_DATA) 320 dev->stats.rx_length_errors++; 321 if ((status & RX_CRC_ERROR) && !(status & (RX_EXTRA_DATA | RX_RUNT))) 322 /* per str 172 */ 323 dev->stats.rx_crc_errors++; 324 if (status & RX_DRIBBLE) 325 dev->stats.rx_frame_errors++; 326 } 327 328 /********************************* 329 * This page contains DMA routines 330 *********************************/ 331 332 #if ALLOW_DMA 333 334 #define dma_page_eq(ptr1, ptr2) ((long)(ptr1) >> 17 == (long)(ptr2) >> 17) 335 336 static void 337 get_dma_channel(struct net_device *dev) 338 { 339 struct net_local *lp = netdev_priv(dev); 340 341 if (lp->dma) { 342 dev->dma = lp->dma; 343 lp->isa_config |= ISA_RxDMA; 344 } else { 345 if ((lp->isa_config & ANY_ISA_DMA) == 0) 346 return; 347 dev->dma = lp->isa_config & DMA_NO_MASK; 348 if (lp->chip_type == CS8900) 349 dev->dma += 5; 350 if (dev->dma < 5 || dev->dma > 7) { 351 lp->isa_config &= ~ANY_ISA_DMA; 352 return; 353 } 354 } 355 } 356 357 static void 358 write_dma(struct net_device *dev, int chip_type, int dma) 359 { 360 struct net_local *lp = netdev_priv(dev); 361 if ((lp->isa_config & ANY_ISA_DMA) == 0) 362 return; 363 if (chip_type == CS8900) 364 writereg(dev, PP_CS8900_ISADMA, dma - 5); 365 else 366 writereg(dev, PP_CS8920_ISADMA, dma); 367 } 368 369 static void 370 set_dma_cfg(struct net_device *dev) 371 { 372 struct net_local *lp = netdev_priv(dev); 373 374 if (lp->use_dma) { 375 if ((lp->isa_config & ANY_ISA_DMA) == 0) { 376 cs89_dbg(3, err, "set_dma_cfg(): no DMA\n"); 377 return; 378 } 379 if (lp->isa_config & ISA_RxDMA) { 380 lp->curr_rx_cfg |= RX_DMA_ONLY; 381 cs89_dbg(3, info, "set_dma_cfg(): RX_DMA_ONLY\n"); 382 } else { 383 lp->curr_rx_cfg |= AUTO_RX_DMA; /* not that we support it... */ 384 cs89_dbg(3, info, "set_dma_cfg(): AUTO_RX_DMA\n"); 385 } 386 } 387 } 388 389 static int 390 dma_bufcfg(struct net_device *dev) 391 { 392 struct net_local *lp = netdev_priv(dev); 393 if (lp->use_dma) 394 return (lp->isa_config & ANY_ISA_DMA) ? RX_DMA_ENBL : 0; 395 else 396 return 0; 397 } 398 399 static int 400 dma_busctl(struct net_device *dev) 401 { 402 int retval = 0; 403 struct net_local *lp = netdev_priv(dev); 404 if (lp->use_dma) { 405 if (lp->isa_config & ANY_ISA_DMA) 406 retval |= RESET_RX_DMA; /* Reset the DMA pointer */ 407 if (lp->isa_config & DMA_BURST) 408 retval |= DMA_BURST_MODE; /* Does ISA config specify DMA burst ? */ 409 if (lp->dmasize == 64) 410 retval |= RX_DMA_SIZE_64K; /* did they ask for 64K? */ 411 retval |= MEMORY_ON; /* we need memory enabled to use DMA. */ 412 } 413 return retval; 414 } 415 416 static void 417 dma_rx(struct net_device *dev) 418 { 419 struct net_local *lp = netdev_priv(dev); 420 struct sk_buff *skb; 421 int status, length; 422 unsigned char *bp = lp->rx_dma_ptr; 423 424 status = bp[0] + (bp[1] << 8); 425 length = bp[2] + (bp[3] << 8); 426 bp += 4; 427 428 cs89_dbg(5, debug, "%s: receiving DMA packet at %lx, status %x, length %x\n", 429 dev->name, (unsigned long)bp, status, length); 430 431 if ((status & RX_OK) == 0) { 432 count_rx_errors(status, dev); 433 goto skip_this_frame; 434 } 435 436 /* Malloc up new buffer. */ 437 skb = netdev_alloc_skb(dev, length + 2); 438 if (skb == NULL) { 439 dev->stats.rx_dropped++; 440 441 /* AKPM: advance bp to the next frame */ 442 skip_this_frame: 443 bp += (length + 3) & ~3; 444 if (bp >= lp->end_dma_buff) 445 bp -= lp->dmasize * 1024; 446 lp->rx_dma_ptr = bp; 447 return; 448 } 449 skb_reserve(skb, 2); /* longword align L3 header */ 450 451 if (bp + length > lp->end_dma_buff) { 452 int semi_cnt = lp->end_dma_buff - bp; 453 memcpy(skb_put(skb, semi_cnt), bp, semi_cnt); 454 memcpy(skb_put(skb, length - semi_cnt), lp->dma_buff, 455 length - semi_cnt); 456 } else { 457 memcpy(skb_put(skb, length), bp, length); 458 } 459 bp += (length + 3) & ~3; 460 if (bp >= lp->end_dma_buff) 461 bp -= lp->dmasize*1024; 462 lp->rx_dma_ptr = bp; 463 464 cs89_dbg(3, info, "%s: received %d byte DMA packet of type %x\n", 465 dev->name, length, 466 ((skb->data[ETH_ALEN + ETH_ALEN] << 8) | 467 skb->data[ETH_ALEN + ETH_ALEN + 1])); 468 469 skb->protocol = eth_type_trans(skb, dev); 470 netif_rx(skb); 471 dev->stats.rx_packets++; 472 dev->stats.rx_bytes += length; 473 } 474 475 static void release_dma_buff(struct net_local *lp) 476 { 477 if (lp->dma_buff) { 478 free_pages((unsigned long)(lp->dma_buff), 479 get_order(lp->dmasize * 1024)); 480 lp->dma_buff = NULL; 481 } 482 } 483 484 #endif /* ALLOW_DMA */ 485 486 static void 487 control_dc_dc(struct net_device *dev, int on_not_off) 488 { 489 struct net_local *lp = netdev_priv(dev); 490 unsigned int selfcontrol; 491 unsigned long timenow = jiffies; 492 /* control the DC to DC convertor in the SelfControl register. 493 * Note: This is hooked up to a general purpose pin, might not 494 * always be a DC to DC convertor. 495 */ 496 497 selfcontrol = HCB1_ENBL; /* Enable the HCB1 bit as an output */ 498 if (((lp->adapter_cnf & A_CNF_DC_DC_POLARITY) != 0) ^ on_not_off) 499 selfcontrol |= HCB1; 500 else 501 selfcontrol &= ~HCB1; 502 writereg(dev, PP_SelfCTL, selfcontrol); 503 504 /* Wait for the DC/DC converter to power up - 500ms */ 505 while (time_before(jiffies, timenow + HZ)) 506 ; 507 } 508 509 /* send a test packet - return true if carrier bits are ok */ 510 static int 511 send_test_pkt(struct net_device *dev) 512 { 513 struct net_local *lp = netdev_priv(dev); 514 char test_packet[] = { 515 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, 516 0, 46, /* A 46 in network order */ 517 0, 0, /* DSAP=0 & SSAP=0 fields */ 518 0xf3, 0 /* Control (Test Req + P bit set) */ 519 }; 520 unsigned long timenow = jiffies; 521 522 writereg(dev, PP_LineCTL, readreg(dev, PP_LineCTL) | SERIAL_TX_ON); 523 524 memcpy(test_packet, dev->dev_addr, ETH_ALEN); 525 memcpy(test_packet + ETH_ALEN, dev->dev_addr, ETH_ALEN); 526 527 iowrite16(TX_AFTER_ALL, lp->virt_addr + TX_CMD_PORT); 528 iowrite16(ETH_ZLEN, lp->virt_addr + TX_LEN_PORT); 529 530 /* Test to see if the chip has allocated memory for the packet */ 531 while (time_before(jiffies, timenow + 5)) 532 if (readreg(dev, PP_BusST) & READY_FOR_TX_NOW) 533 break; 534 if (time_after_eq(jiffies, timenow + 5)) 535 return 0; /* this shouldn't happen */ 536 537 /* Write the contents of the packet */ 538 writewords(lp, TX_FRAME_PORT, test_packet, (ETH_ZLEN + 1) >> 1); 539 540 cs89_dbg(1, debug, "Sending test packet "); 541 /* wait a couple of jiffies for packet to be received */ 542 for (timenow = jiffies; time_before(jiffies, timenow + 3);) 543 ; 544 if ((readreg(dev, PP_TxEvent) & TX_SEND_OK_BITS) == TX_OK) { 545 cs89_dbg(1, cont, "succeeded\n"); 546 return 1; 547 } 548 cs89_dbg(1, cont, "failed\n"); 549 return 0; 550 } 551 552 #define DETECTED_NONE 0 553 #define DETECTED_RJ45H 1 554 #define DETECTED_RJ45F 2 555 #define DETECTED_AUI 3 556 #define DETECTED_BNC 4 557 558 static int 559 detect_tp(struct net_device *dev) 560 { 561 struct net_local *lp = netdev_priv(dev); 562 unsigned long timenow = jiffies; 563 int fdx; 564 565 cs89_dbg(1, debug, "%s: Attempting TP\n", dev->name); 566 567 /* If connected to another full duplex capable 10-Base-T card 568 * the link pulses seem to be lost when the auto detect bit in 569 * the LineCTL is set. To overcome this the auto detect bit will 570 * be cleared whilst testing the 10-Base-T interface. This would 571 * not be necessary for the sparrow chip but is simpler to do it 572 * anyway. 573 */ 574 writereg(dev, PP_LineCTL, lp->linectl & ~AUI_ONLY); 575 control_dc_dc(dev, 0); 576 577 /* Delay for the hardware to work out if the TP cable is present 578 * - 150ms 579 */ 580 for (timenow = jiffies; time_before(jiffies, timenow + 15);) 581 ; 582 if ((readreg(dev, PP_LineST) & LINK_OK) == 0) 583 return DETECTED_NONE; 584 585 if (lp->chip_type == CS8900) { 586 switch (lp->force & 0xf0) { 587 #if 0 588 case FORCE_AUTO: 589 pr_info("%s: cs8900 doesn't autonegotiate\n", 590 dev->name); 591 return DETECTED_NONE; 592 #endif 593 /* CS8900 doesn't support AUTO, change to HALF*/ 594 case FORCE_AUTO: 595 lp->force &= ~FORCE_AUTO; 596 lp->force |= FORCE_HALF; 597 break; 598 case FORCE_HALF: 599 break; 600 case FORCE_FULL: 601 writereg(dev, PP_TestCTL, 602 readreg(dev, PP_TestCTL) | FDX_8900); 603 break; 604 } 605 fdx = readreg(dev, PP_TestCTL) & FDX_8900; 606 } else { 607 switch (lp->force & 0xf0) { 608 case FORCE_AUTO: 609 lp->auto_neg_cnf = AUTO_NEG_ENABLE; 610 break; 611 case FORCE_HALF: 612 lp->auto_neg_cnf = 0; 613 break; 614 case FORCE_FULL: 615 lp->auto_neg_cnf = RE_NEG_NOW | ALLOW_FDX; 616 break; 617 } 618 619 writereg(dev, PP_AutoNegCTL, lp->auto_neg_cnf & AUTO_NEG_MASK); 620 621 if ((lp->auto_neg_cnf & AUTO_NEG_BITS) == AUTO_NEG_ENABLE) { 622 pr_info("%s: negotiating duplex...\n", dev->name); 623 while (readreg(dev, PP_AutoNegST) & AUTO_NEG_BUSY) { 624 if (time_after(jiffies, timenow + 4000)) { 625 pr_err("**** Full / half duplex auto-negotiation timed out ****\n"); 626 break; 627 } 628 } 629 } 630 fdx = readreg(dev, PP_AutoNegST) & FDX_ACTIVE; 631 } 632 if (fdx) 633 return DETECTED_RJ45F; 634 else 635 return DETECTED_RJ45H; 636 } 637 638 static int 639 detect_bnc(struct net_device *dev) 640 { 641 struct net_local *lp = netdev_priv(dev); 642 643 cs89_dbg(1, debug, "%s: Attempting BNC\n", dev->name); 644 control_dc_dc(dev, 1); 645 646 writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY); 647 648 if (send_test_pkt(dev)) 649 return DETECTED_BNC; 650 else 651 return DETECTED_NONE; 652 } 653 654 static int 655 detect_aui(struct net_device *dev) 656 { 657 struct net_local *lp = netdev_priv(dev); 658 659 cs89_dbg(1, debug, "%s: Attempting AUI\n", dev->name); 660 control_dc_dc(dev, 0); 661 662 writereg(dev, PP_LineCTL, (lp->linectl & ~AUTO_AUI_10BASET) | AUI_ONLY); 663 664 if (send_test_pkt(dev)) 665 return DETECTED_AUI; 666 else 667 return DETECTED_NONE; 668 } 669 670 /* We have a good packet(s), get it/them out of the buffers. */ 671 static void 672 net_rx(struct net_device *dev) 673 { 674 struct net_local *lp = netdev_priv(dev); 675 struct sk_buff *skb; 676 int status, length; 677 678 status = ioread16(lp->virt_addr + RX_FRAME_PORT); 679 length = ioread16(lp->virt_addr + RX_FRAME_PORT); 680 681 if ((status & RX_OK) == 0) { 682 count_rx_errors(status, dev); 683 return; 684 } 685 686 /* Malloc up new buffer. */ 687 skb = netdev_alloc_skb(dev, length + 2); 688 if (skb == NULL) { 689 dev->stats.rx_dropped++; 690 return; 691 } 692 skb_reserve(skb, 2); /* longword align L3 header */ 693 694 readwords(lp, RX_FRAME_PORT, skb_put(skb, length), length >> 1); 695 if (length & 1) 696 skb->data[length-1] = ioread16(lp->virt_addr + RX_FRAME_PORT); 697 698 cs89_dbg(3, debug, "%s: received %d byte packet of type %x\n", 699 dev->name, length, 700 (skb->data[ETH_ALEN + ETH_ALEN] << 8) | 701 skb->data[ETH_ALEN + ETH_ALEN + 1]); 702 703 skb->protocol = eth_type_trans(skb, dev); 704 netif_rx(skb); 705 dev->stats.rx_packets++; 706 dev->stats.rx_bytes += length; 707 } 708 709 /* The typical workload of the driver: 710 * Handle the network interface interrupts. 711 */ 712 713 static irqreturn_t net_interrupt(int irq, void *dev_id) 714 { 715 struct net_device *dev = dev_id; 716 struct net_local *lp; 717 int status; 718 int handled = 0; 719 720 lp = netdev_priv(dev); 721 722 /* we MUST read all the events out of the ISQ, otherwise we'll never 723 * get interrupted again. As a consequence, we can't have any limit 724 * on the number of times we loop in the interrupt handler. The 725 * hardware guarantees that eventually we'll run out of events. Of 726 * course, if you're on a slow machine, and packets are arriving 727 * faster than you can read them off, you're screwed. Hasta la 728 * vista, baby! 729 */ 730 while ((status = ioread16(lp->virt_addr + ISQ_PORT))) { 731 cs89_dbg(4, debug, "%s: event=%04x\n", dev->name, status); 732 handled = 1; 733 switch (status & ISQ_EVENT_MASK) { 734 case ISQ_RECEIVER_EVENT: 735 /* Got a packet(s). */ 736 net_rx(dev); 737 break; 738 case ISQ_TRANSMITTER_EVENT: 739 dev->stats.tx_packets++; 740 netif_wake_queue(dev); /* Inform upper layers. */ 741 if ((status & (TX_OK | 742 TX_LOST_CRS | 743 TX_SQE_ERROR | 744 TX_LATE_COL | 745 TX_16_COL)) != TX_OK) { 746 if ((status & TX_OK) == 0) 747 dev->stats.tx_errors++; 748 if (status & TX_LOST_CRS) 749 dev->stats.tx_carrier_errors++; 750 if (status & TX_SQE_ERROR) 751 dev->stats.tx_heartbeat_errors++; 752 if (status & TX_LATE_COL) 753 dev->stats.tx_window_errors++; 754 if (status & TX_16_COL) 755 dev->stats.tx_aborted_errors++; 756 } 757 break; 758 case ISQ_BUFFER_EVENT: 759 if (status & READY_FOR_TX) { 760 /* we tried to transmit a packet earlier, 761 * but inexplicably ran out of buffers. 762 * That shouldn't happen since we only ever 763 * load one packet. Shrug. Do the right 764 * thing anyway. 765 */ 766 netif_wake_queue(dev); /* Inform upper layers. */ 767 } 768 if (status & TX_UNDERRUN) { 769 cs89_dbg(0, err, "%s: transmit underrun\n", 770 dev->name); 771 lp->send_underrun++; 772 if (lp->send_underrun == 3) 773 lp->send_cmd = TX_AFTER_381; 774 else if (lp->send_underrun == 6) 775 lp->send_cmd = TX_AFTER_ALL; 776 /* transmit cycle is done, although 777 * frame wasn't transmitted - this 778 * avoids having to wait for the upper 779 * layers to timeout on us, in the 780 * event of a tx underrun 781 */ 782 netif_wake_queue(dev); /* Inform upper layers. */ 783 } 784 #if ALLOW_DMA 785 if (lp->use_dma && (status & RX_DMA)) { 786 int count = readreg(dev, PP_DmaFrameCnt); 787 while (count) { 788 cs89_dbg(5, debug, 789 "%s: receiving %d DMA frames\n", 790 dev->name, count); 791 if (count > 1) 792 cs89_dbg(2, debug, 793 "%s: receiving %d DMA frames\n", 794 dev->name, count); 795 dma_rx(dev); 796 if (--count == 0) 797 count = readreg(dev, PP_DmaFrameCnt); 798 if (count > 0) 799 cs89_dbg(2, debug, 800 "%s: continuing with %d DMA frames\n", 801 dev->name, count); 802 } 803 } 804 #endif 805 break; 806 case ISQ_RX_MISS_EVENT: 807 dev->stats.rx_missed_errors += (status >> 6); 808 break; 809 case ISQ_TX_COL_EVENT: 810 dev->stats.collisions += (status >> 6); 811 break; 812 } 813 } 814 return IRQ_RETVAL(handled); 815 } 816 817 /* Open/initialize the board. This is called (in the current kernel) 818 sometime after booting when the 'ifconfig' program is run. 819 820 This routine should set everything up anew at each open, even 821 registers that "should" only need to be set once at boot, so that 822 there is non-reboot way to recover if something goes wrong. 823 */ 824 825 /* AKPM: do we need to do any locking here? */ 826 827 static int 828 net_open(struct net_device *dev) 829 { 830 struct net_local *lp = netdev_priv(dev); 831 int result = 0; 832 int i; 833 int ret; 834 835 if (dev->irq < 2) { 836 /* Allow interrupts to be generated by the chip */ 837 /* Cirrus' release had this: */ 838 #if 0 839 writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL) | ENABLE_IRQ); 840 #endif 841 /* And 2.3.47 had this: */ 842 writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON); 843 844 for (i = 2; i < CS8920_NO_INTS; i++) { 845 if ((1 << i) & lp->irq_map) { 846 if (request_irq(i, net_interrupt, 0, dev->name, 847 dev) == 0) { 848 dev->irq = i; 849 write_irq(dev, lp->chip_type, i); 850 /* writereg(dev, PP_BufCFG, GENERATE_SW_INTERRUPT); */ 851 break; 852 } 853 } 854 } 855 856 if (i >= CS8920_NO_INTS) { 857 writereg(dev, PP_BusCTL, 0); /* disable interrupts. */ 858 pr_err("can't get an interrupt\n"); 859 ret = -EAGAIN; 860 goto bad_out; 861 } 862 } else { 863 #if !defined(CONFIG_CS89x0_PLATFORM) 864 if (((1 << dev->irq) & lp->irq_map) == 0) { 865 pr_err("%s: IRQ %d is not in our map of allowable IRQs, which is %x\n", 866 dev->name, dev->irq, lp->irq_map); 867 ret = -EAGAIN; 868 goto bad_out; 869 } 870 #endif 871 /* FIXME: Cirrus' release had this: */ 872 writereg(dev, PP_BusCTL, readreg(dev, PP_BusCTL)|ENABLE_IRQ); 873 /* And 2.3.47 had this: */ 874 #if 0 875 writereg(dev, PP_BusCTL, ENABLE_IRQ | MEMORY_ON); 876 #endif 877 write_irq(dev, lp->chip_type, dev->irq); 878 ret = request_irq(dev->irq, net_interrupt, 0, dev->name, dev); 879 if (ret) { 880 pr_err("request_irq(%d) failed\n", dev->irq); 881 goto bad_out; 882 } 883 } 884 885 #if ALLOW_DMA 886 if (lp->use_dma && (lp->isa_config & ANY_ISA_DMA)) { 887 unsigned long flags; 888 lp->dma_buff = (unsigned char *)__get_dma_pages(GFP_KERNEL, 889 get_order(lp->dmasize * 1024)); 890 if (!lp->dma_buff) { 891 pr_err("%s: cannot get %dK memory for DMA\n", 892 dev->name, lp->dmasize); 893 goto release_irq; 894 } 895 cs89_dbg(1, debug, "%s: dma %lx %lx\n", 896 dev->name, 897 (unsigned long)lp->dma_buff, 898 (unsigned long)isa_virt_to_bus(lp->dma_buff)); 899 if ((unsigned long)lp->dma_buff >= MAX_DMA_ADDRESS || 900 !dma_page_eq(lp->dma_buff, 901 lp->dma_buff + lp->dmasize * 1024 - 1)) { 902 pr_err("%s: not usable as DMA buffer\n", dev->name); 903 goto release_irq; 904 } 905 memset(lp->dma_buff, 0, lp->dmasize * 1024); /* Why? */ 906 if (request_dma(dev->dma, dev->name)) { 907 pr_err("%s: cannot get dma channel %d\n", 908 dev->name, dev->dma); 909 goto release_irq; 910 } 911 write_dma(dev, lp->chip_type, dev->dma); 912 lp->rx_dma_ptr = lp->dma_buff; 913 lp->end_dma_buff = lp->dma_buff + lp->dmasize * 1024; 914 spin_lock_irqsave(&lp->lock, flags); 915 disable_dma(dev->dma); 916 clear_dma_ff(dev->dma); 917 set_dma_mode(dev->dma, DMA_RX_MODE); /* auto_init as well */ 918 set_dma_addr(dev->dma, isa_virt_to_bus(lp->dma_buff)); 919 set_dma_count(dev->dma, lp->dmasize * 1024); 920 enable_dma(dev->dma); 921 spin_unlock_irqrestore(&lp->lock, flags); 922 } 923 #endif /* ALLOW_DMA */ 924 925 /* set the Ethernet address */ 926 for (i = 0; i < ETH_ALEN / 2; i++) 927 writereg(dev, PP_IA + i * 2, 928 (dev->dev_addr[i * 2] | 929 (dev->dev_addr[i * 2 + 1] << 8))); 930 931 /* while we're testing the interface, leave interrupts disabled */ 932 writereg(dev, PP_BusCTL, MEMORY_ON); 933 934 /* Set the LineCTL quintuplet based on adapter configuration read from EEPROM */ 935 if ((lp->adapter_cnf & A_CNF_EXTND_10B_2) && 936 (lp->adapter_cnf & A_CNF_LOW_RX_SQUELCH)) 937 lp->linectl = LOW_RX_SQUELCH; 938 else 939 lp->linectl = 0; 940 941 /* check to make sure that they have the "right" hardware available */ 942 switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) { 943 case A_CNF_MEDIA_10B_T: 944 result = lp->adapter_cnf & A_CNF_10B_T; 945 break; 946 case A_CNF_MEDIA_AUI: 947 result = lp->adapter_cnf & A_CNF_AUI; 948 break; 949 case A_CNF_MEDIA_10B_2: 950 result = lp->adapter_cnf & A_CNF_10B_2; 951 break; 952 default: 953 result = lp->adapter_cnf & (A_CNF_10B_T | 954 A_CNF_AUI | 955 A_CNF_10B_2); 956 } 957 if (!result) { 958 pr_err("%s: EEPROM is configured for unavailable media\n", 959 dev->name); 960 release_dma: 961 #if ALLOW_DMA 962 free_dma(dev->dma); 963 release_irq: 964 release_dma_buff(lp); 965 #endif 966 writereg(dev, PP_LineCTL, 967 readreg(dev, PP_LineCTL) & ~(SERIAL_TX_ON | SERIAL_RX_ON)); 968 free_irq(dev->irq, dev); 969 ret = -EAGAIN; 970 goto bad_out; 971 } 972 973 /* set the hardware to the configured choice */ 974 switch (lp->adapter_cnf & A_CNF_MEDIA_TYPE) { 975 case A_CNF_MEDIA_10B_T: 976 result = detect_tp(dev); 977 if (result == DETECTED_NONE) { 978 pr_warn("%s: 10Base-T (RJ-45) has no cable\n", 979 dev->name); 980 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ 981 result = DETECTED_RJ45H; /* Yes! I don't care if I see a link pulse */ 982 } 983 break; 984 case A_CNF_MEDIA_AUI: 985 result = detect_aui(dev); 986 if (result == DETECTED_NONE) { 987 pr_warn("%s: 10Base-5 (AUI) has no cable\n", dev->name); 988 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ 989 result = DETECTED_AUI; /* Yes! I don't care if I see a carrrier */ 990 } 991 break; 992 case A_CNF_MEDIA_10B_2: 993 result = detect_bnc(dev); 994 if (result == DETECTED_NONE) { 995 pr_warn("%s: 10Base-2 (BNC) has no cable\n", dev->name); 996 if (lp->auto_neg_cnf & IMM_BIT) /* check "ignore missing media" bit */ 997 result = DETECTED_BNC; /* Yes! I don't care if I can xmit a packet */ 998 } 999 break; 1000 case A_CNF_MEDIA_AUTO: 1001 writereg(dev, PP_LineCTL, lp->linectl | AUTO_AUI_10BASET); 1002 if (lp->adapter_cnf & A_CNF_10B_T) { 1003 result = detect_tp(dev); 1004 if (result != DETECTED_NONE) 1005 break; 1006 } 1007 if (lp->adapter_cnf & A_CNF_AUI) { 1008 result = detect_aui(dev); 1009 if (result != DETECTED_NONE) 1010 break; 1011 } 1012 if (lp->adapter_cnf & A_CNF_10B_2) { 1013 result = detect_bnc(dev); 1014 if (result != DETECTED_NONE) 1015 break; 1016 } 1017 pr_err("%s: no media detected\n", dev->name); 1018 goto release_dma; 1019 } 1020 switch (result) { 1021 case DETECTED_NONE: 1022 pr_err("%s: no network cable attached to configured media\n", 1023 dev->name); 1024 goto release_dma; 1025 case DETECTED_RJ45H: 1026 pr_info("%s: using half-duplex 10Base-T (RJ-45)\n", dev->name); 1027 break; 1028 case DETECTED_RJ45F: 1029 pr_info("%s: using full-duplex 10Base-T (RJ-45)\n", dev->name); 1030 break; 1031 case DETECTED_AUI: 1032 pr_info("%s: using 10Base-5 (AUI)\n", dev->name); 1033 break; 1034 case DETECTED_BNC: 1035 pr_info("%s: using 10Base-2 (BNC)\n", dev->name); 1036 break; 1037 } 1038 1039 /* Turn on both receive and transmit operations */ 1040 writereg(dev, PP_LineCTL, 1041 readreg(dev, PP_LineCTL) | SERIAL_RX_ON | SERIAL_TX_ON); 1042 1043 /* Receive only error free packets addressed to this card */ 1044 lp->rx_mode = 0; 1045 writereg(dev, PP_RxCTL, DEF_RX_ACCEPT); 1046 1047 lp->curr_rx_cfg = RX_OK_ENBL | RX_CRC_ERROR_ENBL; 1048 1049 if (lp->isa_config & STREAM_TRANSFER) 1050 lp->curr_rx_cfg |= RX_STREAM_ENBL; 1051 #if ALLOW_DMA 1052 set_dma_cfg(dev); 1053 #endif 1054 writereg(dev, PP_RxCFG, lp->curr_rx_cfg); 1055 1056 writereg(dev, PP_TxCFG, (TX_LOST_CRS_ENBL | 1057 TX_SQE_ERROR_ENBL | 1058 TX_OK_ENBL | 1059 TX_LATE_COL_ENBL | 1060 TX_JBR_ENBL | 1061 TX_ANY_COL_ENBL | 1062 TX_16_COL_ENBL)); 1063 1064 writereg(dev, PP_BufCFG, (READY_FOR_TX_ENBL | 1065 RX_MISS_COUNT_OVRFLOW_ENBL | 1066 #if ALLOW_DMA 1067 dma_bufcfg(dev) | 1068 #endif 1069 TX_COL_COUNT_OVRFLOW_ENBL | 1070 TX_UNDERRUN_ENBL)); 1071 1072 /* now that we've got our act together, enable everything */ 1073 writereg(dev, PP_BusCTL, (ENABLE_IRQ 1074 | (dev->mem_start ? MEMORY_ON : 0) /* turn memory on */ 1075 #if ALLOW_DMA 1076 | dma_busctl(dev) 1077 #endif 1078 )); 1079 netif_start_queue(dev); 1080 cs89_dbg(1, debug, "net_open() succeeded\n"); 1081 return 0; 1082 bad_out: 1083 return ret; 1084 } 1085 1086 /* The inverse routine to net_open(). */ 1087 static int 1088 net_close(struct net_device *dev) 1089 { 1090 #if ALLOW_DMA 1091 struct net_local *lp = netdev_priv(dev); 1092 #endif 1093 1094 netif_stop_queue(dev); 1095 1096 writereg(dev, PP_RxCFG, 0); 1097 writereg(dev, PP_TxCFG, 0); 1098 writereg(dev, PP_BufCFG, 0); 1099 writereg(dev, PP_BusCTL, 0); 1100 1101 free_irq(dev->irq, dev); 1102 1103 #if ALLOW_DMA 1104 if (lp->use_dma && lp->dma) { 1105 free_dma(dev->dma); 1106 release_dma_buff(lp); 1107 } 1108 #endif 1109 1110 /* Update the statistics here. */ 1111 return 0; 1112 } 1113 1114 /* Get the current statistics. 1115 * This may be called with the card open or closed. 1116 */ 1117 static struct net_device_stats * 1118 net_get_stats(struct net_device *dev) 1119 { 1120 struct net_local *lp = netdev_priv(dev); 1121 unsigned long flags; 1122 1123 spin_lock_irqsave(&lp->lock, flags); 1124 /* Update the statistics from the device registers. */ 1125 dev->stats.rx_missed_errors += (readreg(dev, PP_RxMiss) >> 6); 1126 dev->stats.collisions += (readreg(dev, PP_TxCol) >> 6); 1127 spin_unlock_irqrestore(&lp->lock, flags); 1128 1129 return &dev->stats; 1130 } 1131 1132 static void net_timeout(struct net_device *dev) 1133 { 1134 /* If we get here, some higher level has decided we are broken. 1135 There should really be a "kick me" function call instead. */ 1136 cs89_dbg(0, err, "%s: transmit timed out, %s?\n", 1137 dev->name, 1138 tx_done(dev) ? "IRQ conflict" : "network cable problem"); 1139 /* Try to restart the adaptor. */ 1140 netif_wake_queue(dev); 1141 } 1142 1143 static netdev_tx_t net_send_packet(struct sk_buff *skb, struct net_device *dev) 1144 { 1145 struct net_local *lp = netdev_priv(dev); 1146 unsigned long flags; 1147 1148 cs89_dbg(3, debug, "%s: sent %d byte packet of type %x\n", 1149 dev->name, skb->len, 1150 ((skb->data[ETH_ALEN + ETH_ALEN] << 8) | 1151 skb->data[ETH_ALEN + ETH_ALEN + 1])); 1152 1153 /* keep the upload from being interrupted, since we 1154 * ask the chip to start transmitting before the 1155 * whole packet has been completely uploaded. 1156 */ 1157 1158 spin_lock_irqsave(&lp->lock, flags); 1159 netif_stop_queue(dev); 1160 1161 /* initiate a transmit sequence */ 1162 iowrite16(lp->send_cmd, lp->virt_addr + TX_CMD_PORT); 1163 iowrite16(skb->len, lp->virt_addr + TX_LEN_PORT); 1164 1165 /* Test to see if the chip has allocated memory for the packet */ 1166 if ((readreg(dev, PP_BusST) & READY_FOR_TX_NOW) == 0) { 1167 /* Gasp! It hasn't. But that shouldn't happen since 1168 * we're waiting for TxOk, so return 1 and requeue this packet. 1169 */ 1170 1171 spin_unlock_irqrestore(&lp->lock, flags); 1172 cs89_dbg(0, err, "Tx buffer not free!\n"); 1173 return NETDEV_TX_BUSY; 1174 } 1175 /* Write the contents of the packet */ 1176 writewords(lp, TX_FRAME_PORT, skb->data, (skb->len + 1) >> 1); 1177 spin_unlock_irqrestore(&lp->lock, flags); 1178 dev->stats.tx_bytes += skb->len; 1179 dev_consume_skb_any(skb); 1180 1181 /* We DO NOT call netif_wake_queue() here. 1182 * We also DO NOT call netif_start_queue(). 1183 * 1184 * Either of these would cause another bottom half run through 1185 * net_send_packet() before this packet has fully gone out. 1186 * That causes us to hit the "Gasp!" above and the send is rescheduled. 1187 * it runs like a dog. We just return and wait for the Tx completion 1188 * interrupt handler to restart the netdevice layer 1189 */ 1190 1191 return NETDEV_TX_OK; 1192 } 1193 1194 static void set_multicast_list(struct net_device *dev) 1195 { 1196 struct net_local *lp = netdev_priv(dev); 1197 unsigned long flags; 1198 u16 cfg; 1199 1200 spin_lock_irqsave(&lp->lock, flags); 1201 if (dev->flags & IFF_PROMISC) 1202 lp->rx_mode = RX_ALL_ACCEPT; 1203 else if ((dev->flags & IFF_ALLMULTI) || !netdev_mc_empty(dev)) 1204 /* The multicast-accept list is initialized to accept-all, 1205 * and we rely on higher-level filtering for now. 1206 */ 1207 lp->rx_mode = RX_MULTCAST_ACCEPT; 1208 else 1209 lp->rx_mode = 0; 1210 1211 writereg(dev, PP_RxCTL, DEF_RX_ACCEPT | lp->rx_mode); 1212 1213 /* in promiscuous mode, we accept errored packets, 1214 * so we have to enable interrupts on them also 1215 */ 1216 cfg = lp->curr_rx_cfg; 1217 if (lp->rx_mode == RX_ALL_ACCEPT) 1218 cfg |= RX_CRC_ERROR_ENBL | RX_RUNT_ENBL | RX_EXTRA_DATA_ENBL; 1219 writereg(dev, PP_RxCFG, cfg); 1220 spin_unlock_irqrestore(&lp->lock, flags); 1221 } 1222 1223 static int set_mac_address(struct net_device *dev, void *p) 1224 { 1225 int i; 1226 struct sockaddr *addr = p; 1227 1228 if (netif_running(dev)) 1229 return -EBUSY; 1230 1231 memcpy(dev->dev_addr, addr->sa_data, dev->addr_len); 1232 1233 cs89_dbg(0, debug, "%s: Setting MAC address to %pM\n", 1234 dev->name, dev->dev_addr); 1235 1236 /* set the Ethernet address */ 1237 for (i = 0; i < ETH_ALEN / 2; i++) 1238 writereg(dev, PP_IA + i * 2, 1239 (dev->dev_addr[i * 2] | 1240 (dev->dev_addr[i * 2 + 1] << 8))); 1241 1242 return 0; 1243 } 1244 1245 #ifdef CONFIG_NET_POLL_CONTROLLER 1246 /* 1247 * Polling receive - used by netconsole and other diagnostic tools 1248 * to allow network i/o with interrupts disabled. 1249 */ 1250 static void net_poll_controller(struct net_device *dev) 1251 { 1252 disable_irq(dev->irq); 1253 net_interrupt(dev->irq, dev); 1254 enable_irq(dev->irq); 1255 } 1256 #endif 1257 1258 static const struct net_device_ops net_ops = { 1259 .ndo_open = net_open, 1260 .ndo_stop = net_close, 1261 .ndo_tx_timeout = net_timeout, 1262 .ndo_start_xmit = net_send_packet, 1263 .ndo_get_stats = net_get_stats, 1264 .ndo_set_rx_mode = set_multicast_list, 1265 .ndo_set_mac_address = set_mac_address, 1266 #ifdef CONFIG_NET_POLL_CONTROLLER 1267 .ndo_poll_controller = net_poll_controller, 1268 #endif 1269 .ndo_validate_addr = eth_validate_addr, 1270 }; 1271 1272 static void __init reset_chip(struct net_device *dev) 1273 { 1274 #if !defined(CONFIG_MACH_MX31ADS) 1275 struct net_local *lp = netdev_priv(dev); 1276 unsigned long reset_start_time; 1277 1278 writereg(dev, PP_SelfCTL, readreg(dev, PP_SelfCTL) | POWER_ON_RESET); 1279 1280 /* wait 30 ms */ 1281 msleep(30); 1282 1283 if (lp->chip_type != CS8900) { 1284 /* Hardware problem requires PNP registers to be reconfigured after a reset */ 1285 iowrite16(PP_CS8920_ISAINT, lp->virt_addr + ADD_PORT); 1286 iowrite8(dev->irq, lp->virt_addr + DATA_PORT); 1287 iowrite8(0, lp->virt_addr + DATA_PORT + 1); 1288 1289 iowrite16(PP_CS8920_ISAMemB, lp->virt_addr + ADD_PORT); 1290 iowrite8((dev->mem_start >> 16) & 0xff, 1291 lp->virt_addr + DATA_PORT); 1292 iowrite8((dev->mem_start >> 8) & 0xff, 1293 lp->virt_addr + DATA_PORT + 1); 1294 } 1295 1296 /* Wait until the chip is reset */ 1297 reset_start_time = jiffies; 1298 while ((readreg(dev, PP_SelfST) & INIT_DONE) == 0 && 1299 time_before(jiffies, reset_start_time + 2)) 1300 ; 1301 #endif /* !CONFIG_MACH_MX31ADS */ 1302 } 1303 1304 /* This is the real probe routine. 1305 * Linux has a history of friendly device probes on the ISA bus. 1306 * A good device probes avoids doing writes, and 1307 * verifies that the correct device exists and functions. 1308 * Return 0 on success. 1309 */ 1310 static int __init 1311 cs89x0_probe1(struct net_device *dev, void __iomem *ioaddr, int modular) 1312 { 1313 struct net_local *lp = netdev_priv(dev); 1314 int i; 1315 int tmp; 1316 unsigned rev_type = 0; 1317 int eeprom_buff[CHKSUM_LEN]; 1318 int retval; 1319 1320 /* Initialize the device structure. */ 1321 if (!modular) { 1322 memset(lp, 0, sizeof(*lp)); 1323 spin_lock_init(&lp->lock); 1324 #ifndef MODULE 1325 #if ALLOW_DMA 1326 if (g_cs89x0_dma) { 1327 lp->use_dma = 1; 1328 lp->dma = g_cs89x0_dma; 1329 lp->dmasize = 16; /* Could make this an option... */ 1330 } 1331 #endif 1332 lp->force = g_cs89x0_media__force; 1333 #endif 1334 } 1335 1336 pr_debug("PP_addr at %p[%x]: 0x%x\n", 1337 ioaddr, ADD_PORT, ioread16(ioaddr + ADD_PORT)); 1338 iowrite16(PP_ChipID, ioaddr + ADD_PORT); 1339 1340 tmp = ioread16(ioaddr + DATA_PORT); 1341 if (tmp != CHIP_EISA_ID_SIG) { 1342 pr_debug("%s: incorrect signature at %p[%x]: 0x%x!=" 1343 CHIP_EISA_ID_SIG_STR "\n", 1344 dev->name, ioaddr, DATA_PORT, tmp); 1345 retval = -ENODEV; 1346 goto out1; 1347 } 1348 1349 lp->virt_addr = ioaddr; 1350 1351 /* get the chip type */ 1352 rev_type = readreg(dev, PRODUCT_ID_ADD); 1353 lp->chip_type = rev_type & ~REVISON_BITS; 1354 lp->chip_revision = ((rev_type & REVISON_BITS) >> 8) + 'A'; 1355 1356 /* Check the chip type and revision in order to set the correct 1357 * send command. CS8920 revision C and CS8900 revision F can use 1358 * the faster send. 1359 */ 1360 lp->send_cmd = TX_AFTER_381; 1361 if (lp->chip_type == CS8900 && lp->chip_revision >= 'F') 1362 lp->send_cmd = TX_NOW; 1363 if (lp->chip_type != CS8900 && lp->chip_revision >= 'C') 1364 lp->send_cmd = TX_NOW; 1365 1366 pr_info_once("%s\n", version); 1367 1368 pr_info("%s: cs89%c0%s rev %c found at %p ", 1369 dev->name, 1370 lp->chip_type == CS8900 ? '0' : '2', 1371 lp->chip_type == CS8920M ? "M" : "", 1372 lp->chip_revision, 1373 lp->virt_addr); 1374 1375 reset_chip(dev); 1376 1377 /* Here we read the current configuration of the chip. 1378 * If there is no Extended EEPROM then the idea is to not disturb 1379 * the chip configuration, it should have been correctly setup by 1380 * automatic EEPROM read on reset. So, if the chip says it read 1381 * the EEPROM the driver will always do *something* instead of 1382 * complain that adapter_cnf is 0. 1383 */ 1384 1385 if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) == 1386 (EEPROM_OK | EEPROM_PRESENT)) { 1387 /* Load the MAC. */ 1388 for (i = 0; i < ETH_ALEN / 2; i++) { 1389 unsigned int Addr; 1390 Addr = readreg(dev, PP_IA + i * 2); 1391 dev->dev_addr[i * 2] = Addr & 0xFF; 1392 dev->dev_addr[i * 2 + 1] = Addr >> 8; 1393 } 1394 1395 /* Load the Adapter Configuration. 1396 * Note: Barring any more specific information from some 1397 * other source (ie EEPROM+Schematics), we would not know 1398 * how to operate a 10Base2 interface on the AUI port. 1399 * However, since we do read the status of HCB1 and use 1400 * settings that always result in calls to control_dc_dc(dev,0) 1401 * a BNC interface should work if the enable pin 1402 * (dc/dc converter) is on HCB1. 1403 * It will be called AUI however. 1404 */ 1405 1406 lp->adapter_cnf = 0; 1407 i = readreg(dev, PP_LineCTL); 1408 /* Preserve the setting of the HCB1 pin. */ 1409 if ((i & (HCB1 | HCB1_ENBL)) == (HCB1 | HCB1_ENBL)) 1410 lp->adapter_cnf |= A_CNF_DC_DC_POLARITY; 1411 /* Save the sqelch bit */ 1412 if ((i & LOW_RX_SQUELCH) == LOW_RX_SQUELCH) 1413 lp->adapter_cnf |= A_CNF_EXTND_10B_2 | A_CNF_LOW_RX_SQUELCH; 1414 /* Check if the card is in 10Base-t only mode */ 1415 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == 0) 1416 lp->adapter_cnf |= A_CNF_10B_T | A_CNF_MEDIA_10B_T; 1417 /* Check if the card is in AUI only mode */ 1418 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUI_ONLY) 1419 lp->adapter_cnf |= A_CNF_AUI | A_CNF_MEDIA_AUI; 1420 /* Check if the card is in Auto mode. */ 1421 if ((i & (AUI_ONLY | AUTO_AUI_10BASET)) == AUTO_AUI_10BASET) 1422 lp->adapter_cnf |= A_CNF_AUI | A_CNF_10B_T | 1423 A_CNF_MEDIA_AUI | A_CNF_MEDIA_10B_T | A_CNF_MEDIA_AUTO; 1424 1425 cs89_dbg(1, info, "%s: PP_LineCTL=0x%x, adapter_cnf=0x%x\n", 1426 dev->name, i, lp->adapter_cnf); 1427 1428 /* IRQ. Other chips already probe, see below. */ 1429 if (lp->chip_type == CS8900) 1430 lp->isa_config = readreg(dev, PP_CS8900_ISAINT) & INT_NO_MASK; 1431 1432 pr_cont("[Cirrus EEPROM] "); 1433 } 1434 1435 pr_cont("\n"); 1436 1437 /* First check to see if an EEPROM is attached. */ 1438 1439 if ((readreg(dev, PP_SelfST) & EEPROM_PRESENT) == 0) 1440 pr_warn("No EEPROM, relying on command line....\n"); 1441 else if (get_eeprom_data(dev, START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) { 1442 pr_warn("EEPROM read failed, relying on command line\n"); 1443 } else if (get_eeprom_cksum(START_EEPROM_DATA, CHKSUM_LEN, eeprom_buff) < 0) { 1444 /* Check if the chip was able to read its own configuration starting 1445 at 0 in the EEPROM*/ 1446 if ((readreg(dev, PP_SelfST) & (EEPROM_OK | EEPROM_PRESENT)) != 1447 (EEPROM_OK | EEPROM_PRESENT)) 1448 pr_warn("Extended EEPROM checksum bad and no Cirrus EEPROM, relying on command line\n"); 1449 1450 } else { 1451 /* This reads an extended EEPROM that is not documented 1452 * in the CS8900 datasheet. 1453 */ 1454 1455 /* get transmission control word but keep the autonegotiation bits */ 1456 if (!lp->auto_neg_cnf) 1457 lp->auto_neg_cnf = eeprom_buff[AUTO_NEG_CNF_OFFSET / 2]; 1458 /* Store adapter configuration */ 1459 if (!lp->adapter_cnf) 1460 lp->adapter_cnf = eeprom_buff[ADAPTER_CNF_OFFSET / 2]; 1461 /* Store ISA configuration */ 1462 lp->isa_config = eeprom_buff[ISA_CNF_OFFSET / 2]; 1463 dev->mem_start = eeprom_buff[PACKET_PAGE_OFFSET / 2] << 8; 1464 1465 /* eeprom_buff has 32-bit ints, so we can't just memcpy it */ 1466 /* store the initial memory base address */ 1467 for (i = 0; i < ETH_ALEN / 2; i++) { 1468 dev->dev_addr[i * 2] = eeprom_buff[i]; 1469 dev->dev_addr[i * 2 + 1] = eeprom_buff[i] >> 8; 1470 } 1471 cs89_dbg(1, debug, "%s: new adapter_cnf: 0x%x\n", 1472 dev->name, lp->adapter_cnf); 1473 } 1474 1475 /* allow them to force multiple transceivers. If they force multiple, autosense */ 1476 { 1477 int count = 0; 1478 if (lp->force & FORCE_RJ45) { 1479 lp->adapter_cnf |= A_CNF_10B_T; 1480 count++; 1481 } 1482 if (lp->force & FORCE_AUI) { 1483 lp->adapter_cnf |= A_CNF_AUI; 1484 count++; 1485 } 1486 if (lp->force & FORCE_BNC) { 1487 lp->adapter_cnf |= A_CNF_10B_2; 1488 count++; 1489 } 1490 if (count > 1) 1491 lp->adapter_cnf |= A_CNF_MEDIA_AUTO; 1492 else if (lp->force & FORCE_RJ45) 1493 lp->adapter_cnf |= A_CNF_MEDIA_10B_T; 1494 else if (lp->force & FORCE_AUI) 1495 lp->adapter_cnf |= A_CNF_MEDIA_AUI; 1496 else if (lp->force & FORCE_BNC) 1497 lp->adapter_cnf |= A_CNF_MEDIA_10B_2; 1498 } 1499 1500 cs89_dbg(1, debug, "%s: after force 0x%x, adapter_cnf=0x%x\n", 1501 dev->name, lp->force, lp->adapter_cnf); 1502 1503 /* FIXME: We don't let you set dc-dc polarity or low RX squelch from the command line: add it here */ 1504 1505 /* FIXME: We don't let you set the IMM bit from the command line: add it to lp->auto_neg_cnf here */ 1506 1507 /* FIXME: we don't set the Ethernet address on the command line. Use 1508 * ifconfig IFACE hw ether AABBCCDDEEFF 1509 */ 1510 1511 pr_info("media %s%s%s", 1512 (lp->adapter_cnf & A_CNF_10B_T) ? "RJ-45," : "", 1513 (lp->adapter_cnf & A_CNF_AUI) ? "AUI," : "", 1514 (lp->adapter_cnf & A_CNF_10B_2) ? "BNC," : ""); 1515 1516 lp->irq_map = 0xffff; 1517 1518 /* If this is a CS8900 then no pnp soft */ 1519 if (lp->chip_type != CS8900 && 1520 /* Check if the ISA IRQ has been set */ 1521 (i = readreg(dev, PP_CS8920_ISAINT) & 0xff, 1522 (i != 0 && i < CS8920_NO_INTS))) { 1523 if (!dev->irq) 1524 dev->irq = i; 1525 } else { 1526 i = lp->isa_config & INT_NO_MASK; 1527 #ifndef CONFIG_CS89x0_PLATFORM 1528 if (lp->chip_type == CS8900) { 1529 /* Translate the IRQ using the IRQ mapping table. */ 1530 if (i >= ARRAY_SIZE(cs8900_irq_map)) 1531 pr_err("invalid ISA interrupt number %d\n", i); 1532 else 1533 i = cs8900_irq_map[i]; 1534 1535 lp->irq_map = CS8900_IRQ_MAP; /* fixed IRQ map for CS8900 */ 1536 } else { 1537 int irq_map_buff[IRQ_MAP_LEN/2]; 1538 1539 if (get_eeprom_data(dev, IRQ_MAP_EEPROM_DATA, 1540 IRQ_MAP_LEN / 2, 1541 irq_map_buff) >= 0) { 1542 if ((irq_map_buff[0] & 0xff) == PNP_IRQ_FRMT) 1543 lp->irq_map = ((irq_map_buff[0] >> 8) | 1544 (irq_map_buff[1] << 8)); 1545 } 1546 } 1547 #endif 1548 if (!dev->irq) 1549 dev->irq = i; 1550 } 1551 1552 pr_cont(" IRQ %d", dev->irq); 1553 1554 #if ALLOW_DMA 1555 if (lp->use_dma) { 1556 get_dma_channel(dev); 1557 pr_cont(", DMA %d", dev->dma); 1558 } else 1559 #endif 1560 pr_cont(", programmed I/O"); 1561 1562 /* print the ethernet address. */ 1563 pr_cont(", MAC %pM\n", dev->dev_addr); 1564 1565 dev->netdev_ops = &net_ops; 1566 dev->watchdog_timeo = HZ; 1567 1568 cs89_dbg(0, info, "cs89x0_probe1() successful\n"); 1569 1570 retval = register_netdev(dev); 1571 if (retval) 1572 goto out2; 1573 return 0; 1574 out2: 1575 iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT); 1576 out1: 1577 return retval; 1578 } 1579 1580 #ifndef CONFIG_CS89x0_PLATFORM 1581 /* 1582 * This function converts the I/O port address used by the cs89x0_probe() and 1583 * init_module() functions to the I/O memory address used by the 1584 * cs89x0_probe1() function. 1585 */ 1586 static int __init 1587 cs89x0_ioport_probe(struct net_device *dev, unsigned long ioport, int modular) 1588 { 1589 struct net_local *lp = netdev_priv(dev); 1590 int ret; 1591 void __iomem *io_mem; 1592 1593 if (!lp) 1594 return -ENOMEM; 1595 1596 dev->base_addr = ioport; 1597 1598 if (!request_region(ioport, NETCARD_IO_EXTENT, DRV_NAME)) { 1599 ret = -EBUSY; 1600 goto out; 1601 } 1602 1603 io_mem = ioport_map(ioport & ~3, NETCARD_IO_EXTENT); 1604 if (!io_mem) { 1605 ret = -ENOMEM; 1606 goto release; 1607 } 1608 1609 /* if they give us an odd I/O address, then do ONE write to 1610 * the address port, to get it back to address zero, where we 1611 * expect to find the EISA signature word. An IO with a base of 0x3 1612 * will skip the test for the ADD_PORT. 1613 */ 1614 if (ioport & 1) { 1615 cs89_dbg(1, info, "%s: odd ioaddr 0x%lx\n", dev->name, ioport); 1616 if ((ioport & 2) != 2) { 1617 if ((ioread16(io_mem + ADD_PORT) & ADD_MASK) != 1618 ADD_SIG) { 1619 pr_err("%s: bad signature 0x%x\n", 1620 dev->name, ioread16(io_mem + ADD_PORT)); 1621 ret = -ENODEV; 1622 goto unmap; 1623 } 1624 } 1625 } 1626 1627 ret = cs89x0_probe1(dev, io_mem, modular); 1628 if (!ret) 1629 goto out; 1630 unmap: 1631 ioport_unmap(io_mem); 1632 release: 1633 release_region(ioport, NETCARD_IO_EXTENT); 1634 out: 1635 return ret; 1636 } 1637 1638 #ifndef MODULE 1639 /* Check for a network adaptor of this type, and return '0' iff one exists. 1640 * If dev->base_addr == 0, probe all likely locations. 1641 * If dev->base_addr == 1, always return failure. 1642 * If dev->base_addr == 2, allocate space for the device and return success 1643 * (detachable devices only). 1644 * Return 0 on success. 1645 */ 1646 1647 struct net_device * __init cs89x0_probe(int unit) 1648 { 1649 struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); 1650 unsigned *port; 1651 int err = 0; 1652 int irq; 1653 int io; 1654 1655 if (!dev) 1656 return ERR_PTR(-ENODEV); 1657 1658 sprintf(dev->name, "eth%d", unit); 1659 netdev_boot_setup_check(dev); 1660 io = dev->base_addr; 1661 irq = dev->irq; 1662 1663 cs89_dbg(0, info, "cs89x0_probe(0x%x)\n", io); 1664 1665 if (io > 0x1ff) { /* Check a single specified location. */ 1666 err = cs89x0_ioport_probe(dev, io, 0); 1667 } else if (io != 0) { /* Don't probe at all. */ 1668 err = -ENXIO; 1669 } else { 1670 for (port = netcard_portlist; *port; port++) { 1671 if (cs89x0_ioport_probe(dev, *port, 0) == 0) 1672 break; 1673 dev->irq = irq; 1674 } 1675 if (!*port) 1676 err = -ENODEV; 1677 } 1678 if (err) 1679 goto out; 1680 return dev; 1681 out: 1682 free_netdev(dev); 1683 pr_warn("no cs8900 or cs8920 detected. Be sure to disable PnP with SETUP\n"); 1684 return ERR_PTR(err); 1685 } 1686 #endif 1687 #endif 1688 1689 #if defined(MODULE) && !defined(CONFIG_CS89x0_PLATFORM) 1690 1691 static struct net_device *dev_cs89x0; 1692 1693 /* Support the 'debug' module parm even if we're compiled for non-debug to 1694 * avoid breaking someone's startup scripts 1695 */ 1696 1697 static int io; 1698 static int irq; 1699 static int debug; 1700 static char media[8]; 1701 static int duplex = -1; 1702 1703 static int use_dma; /* These generate unused var warnings if ALLOW_DMA = 0 */ 1704 static int dma; 1705 static int dmasize = 16; /* or 64 */ 1706 1707 module_param_hw(io, int, ioport, 0); 1708 module_param_hw(irq, int, irq, 0); 1709 module_param(debug, int, 0); 1710 module_param_string(media, media, sizeof(media), 0); 1711 module_param(duplex, int, 0); 1712 module_param_hw(dma , int, dma, 0); 1713 module_param(dmasize , int, 0); 1714 module_param(use_dma , int, 0); 1715 MODULE_PARM_DESC(io, "cs89x0 I/O base address"); 1716 MODULE_PARM_DESC(irq, "cs89x0 IRQ number"); 1717 #if DEBUGGING 1718 MODULE_PARM_DESC(debug, "cs89x0 debug level (0-6)"); 1719 #else 1720 MODULE_PARM_DESC(debug, "(ignored)"); 1721 #endif 1722 MODULE_PARM_DESC(media, "Set cs89x0 adapter(s) media type(s) (rj45,bnc,aui)"); 1723 /* No other value than -1 for duplex seems to be currently interpreted */ 1724 MODULE_PARM_DESC(duplex, "(ignored)"); 1725 #if ALLOW_DMA 1726 MODULE_PARM_DESC(dma , "cs89x0 ISA DMA channel; ignored if use_dma=0"); 1727 MODULE_PARM_DESC(dmasize , "cs89x0 DMA size in kB (16,64); ignored if use_dma=0"); 1728 MODULE_PARM_DESC(use_dma , "cs89x0 using DMA (0-1)"); 1729 #else 1730 MODULE_PARM_DESC(dma , "(ignored)"); 1731 MODULE_PARM_DESC(dmasize , "(ignored)"); 1732 MODULE_PARM_DESC(use_dma , "(ignored)"); 1733 #endif 1734 1735 MODULE_AUTHOR("Mike Cruse, Russwll Nelson <nelson@crynwr.com>, Andrew Morton"); 1736 MODULE_LICENSE("GPL"); 1737 1738 /* 1739 * media=t - specify media type 1740 * or media=2 1741 * or media=aui 1742 * or medai=auto 1743 * duplex=0 - specify forced half/full/autonegotiate duplex 1744 * debug=# - debug level 1745 * 1746 * Default Chip Configuration: 1747 * DMA Burst = enabled 1748 * IOCHRDY Enabled = enabled 1749 * UseSA = enabled 1750 * CS8900 defaults to half-duplex if not specified on command-line 1751 * CS8920 defaults to autoneg if not specified on command-line 1752 * Use reset defaults for other config parameters 1753 * 1754 * Assumptions: 1755 * media type specified is supported (circuitry is present) 1756 * if memory address is > 1MB, then required mem decode hw is present 1757 * if 10B-2, then agent other than driver will enable DC/DC converter 1758 * (hw or software util) 1759 */ 1760 1761 int __init init_module(void) 1762 { 1763 struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); 1764 struct net_local *lp; 1765 int ret = 0; 1766 1767 #if DEBUGGING 1768 net_debug = debug; 1769 #else 1770 debug = 0; 1771 #endif 1772 if (!dev) 1773 return -ENOMEM; 1774 1775 dev->irq = irq; 1776 dev->base_addr = io; 1777 lp = netdev_priv(dev); 1778 1779 #if ALLOW_DMA 1780 if (use_dma) { 1781 lp->use_dma = use_dma; 1782 lp->dma = dma; 1783 lp->dmasize = dmasize; 1784 } 1785 #endif 1786 1787 spin_lock_init(&lp->lock); 1788 1789 /* boy, they'd better get these right */ 1790 if (!strcmp(media, "rj45")) 1791 lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T; 1792 else if (!strcmp(media, "aui")) 1793 lp->adapter_cnf = A_CNF_MEDIA_AUI | A_CNF_AUI; 1794 else if (!strcmp(media, "bnc")) 1795 lp->adapter_cnf = A_CNF_MEDIA_10B_2 | A_CNF_10B_2; 1796 else 1797 lp->adapter_cnf = A_CNF_MEDIA_10B_T | A_CNF_10B_T; 1798 1799 if (duplex == -1) 1800 lp->auto_neg_cnf = AUTO_NEG_ENABLE; 1801 1802 if (io == 0) { 1803 pr_err("Module autoprobing not allowed\n"); 1804 pr_err("Append io=0xNNN\n"); 1805 ret = -EPERM; 1806 goto out; 1807 } else if (io <= 0x1ff) { 1808 ret = -ENXIO; 1809 goto out; 1810 } 1811 1812 #if ALLOW_DMA 1813 if (use_dma && dmasize != 16 && dmasize != 64) { 1814 pr_err("dma size must be either 16K or 64K, not %dK\n", 1815 dmasize); 1816 ret = -EPERM; 1817 goto out; 1818 } 1819 #endif 1820 ret = cs89x0_ioport_probe(dev, io, 1); 1821 if (ret) 1822 goto out; 1823 1824 dev_cs89x0 = dev; 1825 return 0; 1826 out: 1827 free_netdev(dev); 1828 return ret; 1829 } 1830 1831 void __exit 1832 cleanup_module(void) 1833 { 1834 struct net_local *lp = netdev_priv(dev_cs89x0); 1835 1836 unregister_netdev(dev_cs89x0); 1837 iowrite16(PP_ChipID, lp->virt_addr + ADD_PORT); 1838 ioport_unmap(lp->virt_addr); 1839 release_region(dev_cs89x0->base_addr, NETCARD_IO_EXTENT); 1840 free_netdev(dev_cs89x0); 1841 } 1842 #endif /* MODULE && !CONFIG_CS89x0_PLATFORM */ 1843 1844 #ifdef CONFIG_CS89x0_PLATFORM 1845 static int __init cs89x0_platform_probe(struct platform_device *pdev) 1846 { 1847 struct net_device *dev = alloc_etherdev(sizeof(struct net_local)); 1848 struct net_local *lp; 1849 struct resource *mem_res; 1850 void __iomem *virt_addr; 1851 int err; 1852 1853 if (!dev) 1854 return -ENOMEM; 1855 1856 lp = netdev_priv(dev); 1857 1858 dev->irq = platform_get_irq(pdev, 0); 1859 if (dev->irq <= 0) { 1860 dev_warn(&dev->dev, "interrupt resource missing\n"); 1861 err = -ENXIO; 1862 goto free; 1863 } 1864 1865 mem_res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 1866 virt_addr = devm_ioremap_resource(&pdev->dev, mem_res); 1867 if (IS_ERR(virt_addr)) { 1868 err = PTR_ERR(virt_addr); 1869 goto free; 1870 } 1871 1872 err = cs89x0_probe1(dev, virt_addr, 0); 1873 if (err) { 1874 dev_warn(&dev->dev, "no cs8900 or cs8920 detected\n"); 1875 goto free; 1876 } 1877 1878 platform_set_drvdata(pdev, dev); 1879 return 0; 1880 1881 free: 1882 free_netdev(dev); 1883 return err; 1884 } 1885 1886 static int cs89x0_platform_remove(struct platform_device *pdev) 1887 { 1888 struct net_device *dev = platform_get_drvdata(pdev); 1889 1890 /* This platform_get_resource() call will not return NULL, because 1891 * the same call in cs89x0_platform_probe() has returned a non NULL 1892 * value. 1893 */ 1894 unregister_netdev(dev); 1895 free_netdev(dev); 1896 return 0; 1897 } 1898 1899 static const struct of_device_id __maybe_unused cs89x0_match[] = { 1900 { .compatible = "cirrus,cs8900", }, 1901 { .compatible = "cirrus,cs8920", }, 1902 { }, 1903 }; 1904 MODULE_DEVICE_TABLE(of, cs89x0_match); 1905 1906 static struct platform_driver cs89x0_driver = { 1907 .driver = { 1908 .name = DRV_NAME, 1909 .of_match_table = of_match_ptr(cs89x0_match), 1910 }, 1911 .remove = cs89x0_platform_remove, 1912 }; 1913 1914 module_platform_driver_probe(cs89x0_driver, cs89x0_platform_probe); 1915 1916 #endif /* CONFIG_CS89x0_PLATFORM */ 1917