1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Copyright (C) 2010-2012 Stephane Grosjean <s.grosjean@peak-system.com> 4 * 5 * CAN driver for PEAK-System PCAN-PC Card 6 * Derived from the PCAN project file driver/src/pcan_pccard.c 7 * Copyright (C) 2006-2010 PEAK System-Technik GmbH 8 */ 9 #include <linux/kernel.h> 10 #include <linux/module.h> 11 #include <linux/interrupt.h> 12 #include <linux/netdevice.h> 13 #include <linux/delay.h> 14 #include <linux/timer.h> 15 #include <linux/io.h> 16 #include <pcmcia/cistpl.h> 17 #include <pcmcia/ds.h> 18 #include <linux/can.h> 19 #include <linux/can/dev.h> 20 #include "sja1000.h" 21 22 MODULE_AUTHOR("Stephane Grosjean <s.grosjean@peak-system.com>"); 23 MODULE_DESCRIPTION("CAN driver for PEAK-System PCAN-PC Cards"); 24 MODULE_LICENSE("GPL v2"); 25 MODULE_SUPPORTED_DEVICE("PEAK PCAN-PC Card"); 26 27 /* PEAK-System PCMCIA driver name */ 28 #define PCC_NAME "peak_pcmcia" 29 30 #define PCC_CHAN_MAX 2 31 32 #define PCC_CAN_CLOCK (16000000 / 2) 33 34 #define PCC_MANF_ID 0x0377 35 #define PCC_CARD_ID 0x0001 36 37 #define PCC_CHAN_SIZE 0x20 38 #define PCC_CHAN_OFF(c) ((c) * PCC_CHAN_SIZE) 39 #define PCC_COMN_OFF (PCC_CHAN_OFF(PCC_CHAN_MAX)) 40 #define PCC_COMN_SIZE 0x40 41 42 /* common area registers */ 43 #define PCC_CCR 0x00 44 #define PCC_CSR 0x02 45 #define PCC_CPR 0x04 46 #define PCC_SPI_DIR 0x06 47 #define PCC_SPI_DOR 0x08 48 #define PCC_SPI_ADR 0x0a 49 #define PCC_SPI_IR 0x0c 50 #define PCC_FW_MAJOR 0x10 51 #define PCC_FW_MINOR 0x12 52 53 /* CCR bits */ 54 #define PCC_CCR_CLK_16 0x00 55 #define PCC_CCR_CLK_10 0x01 56 #define PCC_CCR_CLK_21 0x02 57 #define PCC_CCR_CLK_8 0x03 58 #define PCC_CCR_CLK_MASK PCC_CCR_CLK_8 59 60 #define PCC_CCR_RST_CHAN(c) (0x01 << ((c) + 2)) 61 #define PCC_CCR_RST_ALL (PCC_CCR_RST_CHAN(0) | PCC_CCR_RST_CHAN(1)) 62 #define PCC_CCR_RST_MASK PCC_CCR_RST_ALL 63 64 /* led selection bits */ 65 #define PCC_LED(c) (1 << (c)) 66 #define PCC_LED_ALL (PCC_LED(0) | PCC_LED(1)) 67 68 /* led state value */ 69 #define PCC_LED_ON 0x00 70 #define PCC_LED_FAST 0x01 71 #define PCC_LED_SLOW 0x02 72 #define PCC_LED_OFF 0x03 73 74 #define PCC_CCR_LED_CHAN(s, c) ((s) << (((c) + 2) << 1)) 75 76 #define PCC_CCR_LED_ON_CHAN(c) PCC_CCR_LED_CHAN(PCC_LED_ON, c) 77 #define PCC_CCR_LED_FAST_CHAN(c) PCC_CCR_LED_CHAN(PCC_LED_FAST, c) 78 #define PCC_CCR_LED_SLOW_CHAN(c) PCC_CCR_LED_CHAN(PCC_LED_SLOW, c) 79 #define PCC_CCR_LED_OFF_CHAN(c) PCC_CCR_LED_CHAN(PCC_LED_OFF, c) 80 #define PCC_CCR_LED_MASK_CHAN(c) PCC_CCR_LED_OFF_CHAN(c) 81 #define PCC_CCR_LED_OFF_ALL (PCC_CCR_LED_OFF_CHAN(0) | \ 82 PCC_CCR_LED_OFF_CHAN(1)) 83 #define PCC_CCR_LED_MASK PCC_CCR_LED_OFF_ALL 84 85 #define PCC_CCR_INIT (PCC_CCR_CLK_16 | PCC_CCR_RST_ALL | PCC_CCR_LED_OFF_ALL) 86 87 /* CSR bits */ 88 #define PCC_CSR_SPI_BUSY 0x04 89 90 /* time waiting for SPI busy (prevent from infinite loop) */ 91 #define PCC_SPI_MAX_BUSY_WAIT_MS 3 92 93 /* max count of reading the SPI status register waiting for a change */ 94 /* (prevent from infinite loop) */ 95 #define PCC_WRITE_MAX_LOOP 1000 96 97 /* max nb of int handled by that isr in one shot (prevent from infinite loop) */ 98 #define PCC_ISR_MAX_LOOP 10 99 100 /* EEPROM chip instruction set */ 101 /* note: EEPROM Read/Write instructions include A8 bit */ 102 #define PCC_EEP_WRITE(a) (0x02 | (((a) & 0x100) >> 5)) 103 #define PCC_EEP_READ(a) (0x03 | (((a) & 0x100) >> 5)) 104 #define PCC_EEP_WRDI 0x04 /* EEPROM Write Disable */ 105 #define PCC_EEP_RDSR 0x05 /* EEPROM Read Status Register */ 106 #define PCC_EEP_WREN 0x06 /* EEPROM Write Enable */ 107 108 /* EEPROM Status Register bits */ 109 #define PCC_EEP_SR_WEN 0x02 /* EEPROM SR Write Enable bit */ 110 #define PCC_EEP_SR_WIP 0x01 /* EEPROM SR Write In Progress bit */ 111 112 /* 113 * The board configuration is probably following: 114 * RX1 is connected to ground. 115 * TX1 is not connected. 116 * CLKO is not connected. 117 * Setting the OCR register to 0xDA is a good idea. 118 * This means normal output mode, push-pull and the correct polarity. 119 */ 120 #define PCC_OCR (OCR_TX0_PUSHPULL | OCR_TX1_PUSHPULL) 121 122 /* 123 * In the CDR register, you should set CBP to 1. 124 * You will probably also want to set the clock divider value to 7 125 * (meaning direct oscillator output) because the second SJA1000 chip 126 * is driven by the first one CLKOUT output. 127 */ 128 #define PCC_CDR (CDR_CBP | CDR_CLKOUT_MASK) 129 130 struct pcan_channel { 131 struct net_device *netdev; 132 unsigned long prev_rx_bytes; 133 unsigned long prev_tx_bytes; 134 }; 135 136 /* PCAN-PC Card private structure */ 137 struct pcan_pccard { 138 struct pcmcia_device *pdev; 139 int chan_count; 140 struct pcan_channel channel[PCC_CHAN_MAX]; 141 u8 ccr; 142 u8 fw_major; 143 u8 fw_minor; 144 void __iomem *ioport_addr; 145 struct timer_list led_timer; 146 }; 147 148 static struct pcmcia_device_id pcan_table[] = { 149 PCMCIA_DEVICE_MANF_CARD(PCC_MANF_ID, PCC_CARD_ID), 150 PCMCIA_DEVICE_NULL, 151 }; 152 153 MODULE_DEVICE_TABLE(pcmcia, pcan_table); 154 155 static void pcan_set_leds(struct pcan_pccard *card, u8 mask, u8 state); 156 157 /* 158 * start timer which controls leds state 159 */ 160 static void pcan_start_led_timer(struct pcan_pccard *card) 161 { 162 if (!timer_pending(&card->led_timer)) 163 mod_timer(&card->led_timer, jiffies + HZ); 164 } 165 166 /* 167 * stop the timer which controls leds state 168 */ 169 static void pcan_stop_led_timer(struct pcan_pccard *card) 170 { 171 del_timer_sync(&card->led_timer); 172 } 173 174 /* 175 * read a sja1000 register 176 */ 177 static u8 pcan_read_canreg(const struct sja1000_priv *priv, int port) 178 { 179 return ioread8(priv->reg_base + port); 180 } 181 182 /* 183 * write a sja1000 register 184 */ 185 static void pcan_write_canreg(const struct sja1000_priv *priv, int port, u8 v) 186 { 187 struct pcan_pccard *card = priv->priv; 188 int c = (priv->reg_base - card->ioport_addr) / PCC_CHAN_SIZE; 189 190 /* sja1000 register changes control the leds state */ 191 if (port == SJA1000_MOD) 192 switch (v) { 193 case MOD_RM: 194 /* Reset Mode: set led on */ 195 pcan_set_leds(card, PCC_LED(c), PCC_LED_ON); 196 break; 197 case 0x00: 198 /* Normal Mode: led slow blinking and start led timer */ 199 pcan_set_leds(card, PCC_LED(c), PCC_LED_SLOW); 200 pcan_start_led_timer(card); 201 break; 202 default: 203 break; 204 } 205 206 iowrite8(v, priv->reg_base + port); 207 } 208 209 /* 210 * read a register from the common area 211 */ 212 static u8 pcan_read_reg(struct pcan_pccard *card, int port) 213 { 214 return ioread8(card->ioport_addr + PCC_COMN_OFF + port); 215 } 216 217 /* 218 * write a register into the common area 219 */ 220 static void pcan_write_reg(struct pcan_pccard *card, int port, u8 v) 221 { 222 /* cache ccr value */ 223 if (port == PCC_CCR) { 224 if (card->ccr == v) 225 return; 226 card->ccr = v; 227 } 228 229 iowrite8(v, card->ioport_addr + PCC_COMN_OFF + port); 230 } 231 232 /* 233 * check whether the card is present by checking its fw version numbers 234 * against values read at probing time. 235 */ 236 static inline int pcan_pccard_present(struct pcan_pccard *card) 237 { 238 return ((pcan_read_reg(card, PCC_FW_MAJOR) == card->fw_major) && 239 (pcan_read_reg(card, PCC_FW_MINOR) == card->fw_minor)); 240 } 241 242 /* 243 * wait for SPI engine while it is busy 244 */ 245 static int pcan_wait_spi_busy(struct pcan_pccard *card) 246 { 247 unsigned long timeout = jiffies + 248 msecs_to_jiffies(PCC_SPI_MAX_BUSY_WAIT_MS) + 1; 249 250 /* be sure to read status at least once after sleeping */ 251 while (pcan_read_reg(card, PCC_CSR) & PCC_CSR_SPI_BUSY) { 252 if (time_after(jiffies, timeout)) 253 return -EBUSY; 254 schedule(); 255 } 256 257 return 0; 258 } 259 260 /* 261 * write data in device eeprom 262 */ 263 static int pcan_write_eeprom(struct pcan_pccard *card, u16 addr, u8 v) 264 { 265 u8 status; 266 int err, i; 267 268 /* write instruction enabling write */ 269 pcan_write_reg(card, PCC_SPI_IR, PCC_EEP_WREN); 270 err = pcan_wait_spi_busy(card); 271 if (err) 272 goto we_spi_err; 273 274 /* wait until write enabled */ 275 for (i = 0; i < PCC_WRITE_MAX_LOOP; i++) { 276 /* write instruction reading the status register */ 277 pcan_write_reg(card, PCC_SPI_IR, PCC_EEP_RDSR); 278 err = pcan_wait_spi_busy(card); 279 if (err) 280 goto we_spi_err; 281 282 /* get status register value and check write enable bit */ 283 status = pcan_read_reg(card, PCC_SPI_DIR); 284 if (status & PCC_EEP_SR_WEN) 285 break; 286 } 287 288 if (i >= PCC_WRITE_MAX_LOOP) { 289 dev_err(&card->pdev->dev, 290 "stop waiting to be allowed to write in eeprom\n"); 291 return -EIO; 292 } 293 294 /* set address and data */ 295 pcan_write_reg(card, PCC_SPI_ADR, addr & 0xff); 296 pcan_write_reg(card, PCC_SPI_DOR, v); 297 298 /* 299 * write instruction with bit[3] set according to address value: 300 * if addr refers to upper half of the memory array: bit[3] = 1 301 */ 302 pcan_write_reg(card, PCC_SPI_IR, PCC_EEP_WRITE(addr)); 303 err = pcan_wait_spi_busy(card); 304 if (err) 305 goto we_spi_err; 306 307 /* wait while write in progress */ 308 for (i = 0; i < PCC_WRITE_MAX_LOOP; i++) { 309 /* write instruction reading the status register */ 310 pcan_write_reg(card, PCC_SPI_IR, PCC_EEP_RDSR); 311 err = pcan_wait_spi_busy(card); 312 if (err) 313 goto we_spi_err; 314 315 /* get status register value and check write in progress bit */ 316 status = pcan_read_reg(card, PCC_SPI_DIR); 317 if (!(status & PCC_EEP_SR_WIP)) 318 break; 319 } 320 321 if (i >= PCC_WRITE_MAX_LOOP) { 322 dev_err(&card->pdev->dev, 323 "stop waiting for write in eeprom to complete\n"); 324 return -EIO; 325 } 326 327 /* write instruction disabling write */ 328 pcan_write_reg(card, PCC_SPI_IR, PCC_EEP_WRDI); 329 err = pcan_wait_spi_busy(card); 330 if (err) 331 goto we_spi_err; 332 333 return 0; 334 335 we_spi_err: 336 dev_err(&card->pdev->dev, 337 "stop waiting (spi engine always busy) err %d\n", err); 338 339 return err; 340 } 341 342 static void pcan_set_leds(struct pcan_pccard *card, u8 led_mask, u8 state) 343 { 344 u8 ccr = card->ccr; 345 int i; 346 347 for (i = 0; i < card->chan_count; i++) 348 if (led_mask & PCC_LED(i)) { 349 /* clear corresponding led bits in ccr */ 350 ccr &= ~PCC_CCR_LED_MASK_CHAN(i); 351 /* then set new bits */ 352 ccr |= PCC_CCR_LED_CHAN(state, i); 353 } 354 355 /* real write only if something has changed in ccr */ 356 pcan_write_reg(card, PCC_CCR, ccr); 357 } 358 359 /* 360 * enable/disable CAN connectors power 361 */ 362 static inline void pcan_set_can_power(struct pcan_pccard *card, int onoff) 363 { 364 int err; 365 366 err = pcan_write_eeprom(card, 0, !!onoff); 367 if (err) 368 dev_err(&card->pdev->dev, 369 "failed setting power %s to can connectors (err %d)\n", 370 (onoff) ? "on" : "off", err); 371 } 372 373 /* 374 * set leds state according to channel activity 375 */ 376 static void pcan_led_timer(struct timer_list *t) 377 { 378 struct pcan_pccard *card = from_timer(card, t, led_timer); 379 struct net_device *netdev; 380 int i, up_count = 0; 381 u8 ccr; 382 383 ccr = card->ccr; 384 for (i = 0; i < card->chan_count; i++) { 385 /* default is: not configured */ 386 ccr &= ~PCC_CCR_LED_MASK_CHAN(i); 387 ccr |= PCC_CCR_LED_ON_CHAN(i); 388 389 netdev = card->channel[i].netdev; 390 if (!netdev || !(netdev->flags & IFF_UP)) 391 continue; 392 393 up_count++; 394 395 /* no activity (but configured) */ 396 ccr &= ~PCC_CCR_LED_MASK_CHAN(i); 397 ccr |= PCC_CCR_LED_SLOW_CHAN(i); 398 399 /* if bytes counters changed, set fast blinking led */ 400 if (netdev->stats.rx_bytes != card->channel[i].prev_rx_bytes) { 401 card->channel[i].prev_rx_bytes = netdev->stats.rx_bytes; 402 ccr &= ~PCC_CCR_LED_MASK_CHAN(i); 403 ccr |= PCC_CCR_LED_FAST_CHAN(i); 404 } 405 if (netdev->stats.tx_bytes != card->channel[i].prev_tx_bytes) { 406 card->channel[i].prev_tx_bytes = netdev->stats.tx_bytes; 407 ccr &= ~PCC_CCR_LED_MASK_CHAN(i); 408 ccr |= PCC_CCR_LED_FAST_CHAN(i); 409 } 410 } 411 412 /* write the new leds state */ 413 pcan_write_reg(card, PCC_CCR, ccr); 414 415 /* restart timer (except if no more configured channels) */ 416 if (up_count) 417 mod_timer(&card->led_timer, jiffies + HZ); 418 } 419 420 /* 421 * interrupt service routine 422 */ 423 static irqreturn_t pcan_isr(int irq, void *dev_id) 424 { 425 struct pcan_pccard *card = dev_id; 426 int irq_handled; 427 428 /* prevent from infinite loop */ 429 for (irq_handled = 0; irq_handled < PCC_ISR_MAX_LOOP; irq_handled++) { 430 /* handle shared interrupt and next loop */ 431 int nothing_to_handle = 1; 432 int i; 433 434 /* check interrupt for each channel */ 435 for (i = 0; i < card->chan_count; i++) { 436 struct net_device *netdev; 437 438 /* 439 * check whether the card is present before calling 440 * sja1000_interrupt() to speed up hotplug detection 441 */ 442 if (!pcan_pccard_present(card)) { 443 /* card unplugged during isr */ 444 return IRQ_NONE; 445 } 446 447 /* 448 * should check whether all or SJA1000_MAX_IRQ 449 * interrupts have been handled: loop again to be sure. 450 */ 451 netdev = card->channel[i].netdev; 452 if (netdev && 453 sja1000_interrupt(irq, netdev) == IRQ_HANDLED) 454 nothing_to_handle = 0; 455 } 456 457 if (nothing_to_handle) 458 break; 459 } 460 461 return (irq_handled) ? IRQ_HANDLED : IRQ_NONE; 462 } 463 464 /* 465 * free all resources used by the channels and switch off leds and can power 466 */ 467 static void pcan_free_channels(struct pcan_pccard *card) 468 { 469 int i; 470 u8 led_mask = 0; 471 472 for (i = 0; i < card->chan_count; i++) { 473 struct net_device *netdev; 474 char name[IFNAMSIZ]; 475 476 led_mask |= PCC_LED(i); 477 478 netdev = card->channel[i].netdev; 479 if (!netdev) 480 continue; 481 482 strlcpy(name, netdev->name, IFNAMSIZ); 483 484 unregister_sja1000dev(netdev); 485 486 free_sja1000dev(netdev); 487 488 dev_info(&card->pdev->dev, "%s removed\n", name); 489 } 490 491 /* do it only if device not removed */ 492 if (pcan_pccard_present(card)) { 493 pcan_set_leds(card, led_mask, PCC_LED_OFF); 494 pcan_set_can_power(card, 0); 495 } 496 } 497 498 /* 499 * check if a CAN controller is present at the specified location 500 */ 501 static inline int pcan_channel_present(struct sja1000_priv *priv) 502 { 503 /* make sure SJA1000 is in reset mode */ 504 pcan_write_canreg(priv, SJA1000_MOD, 1); 505 pcan_write_canreg(priv, SJA1000_CDR, CDR_PELICAN); 506 507 /* read reset-values */ 508 if (pcan_read_canreg(priv, SJA1000_CDR) == CDR_PELICAN) 509 return 1; 510 511 return 0; 512 } 513 514 static int pcan_add_channels(struct pcan_pccard *card) 515 { 516 struct pcmcia_device *pdev = card->pdev; 517 int i, err = 0; 518 u8 ccr = PCC_CCR_INIT; 519 520 /* init common registers (reset channels and leds off) */ 521 card->ccr = ~ccr; 522 pcan_write_reg(card, PCC_CCR, ccr); 523 524 /* wait 2ms before unresetting channels */ 525 usleep_range(2000, 3000); 526 527 ccr &= ~PCC_CCR_RST_ALL; 528 pcan_write_reg(card, PCC_CCR, ccr); 529 530 /* create one network device per channel detected */ 531 for (i = 0; i < ARRAY_SIZE(card->channel); i++) { 532 struct net_device *netdev; 533 struct sja1000_priv *priv; 534 535 netdev = alloc_sja1000dev(0); 536 if (!netdev) { 537 err = -ENOMEM; 538 break; 539 } 540 541 /* update linkages */ 542 priv = netdev_priv(netdev); 543 priv->priv = card; 544 SET_NETDEV_DEV(netdev, &pdev->dev); 545 netdev->dev_id = i; 546 547 priv->irq_flags = IRQF_SHARED; 548 netdev->irq = pdev->irq; 549 priv->reg_base = card->ioport_addr + PCC_CHAN_OFF(i); 550 551 /* check if channel is present */ 552 if (!pcan_channel_present(priv)) { 553 dev_err(&pdev->dev, "channel %d not present\n", i); 554 free_sja1000dev(netdev); 555 continue; 556 } 557 558 priv->read_reg = pcan_read_canreg; 559 priv->write_reg = pcan_write_canreg; 560 priv->can.clock.freq = PCC_CAN_CLOCK; 561 priv->ocr = PCC_OCR; 562 priv->cdr = PCC_CDR; 563 564 /* Neither a slave device distributes the clock */ 565 if (i > 0) 566 priv->cdr |= CDR_CLK_OFF; 567 568 priv->flags |= SJA1000_CUSTOM_IRQ_HANDLER; 569 570 /* register SJA1000 device */ 571 err = register_sja1000dev(netdev); 572 if (err) { 573 free_sja1000dev(netdev); 574 continue; 575 } 576 577 card->channel[i].netdev = netdev; 578 card->chan_count++; 579 580 /* set corresponding led on in the new ccr */ 581 ccr &= ~PCC_CCR_LED_OFF_CHAN(i); 582 583 dev_info(&pdev->dev, 584 "%s on channel %d at 0x%p irq %d\n", 585 netdev->name, i, priv->reg_base, pdev->irq); 586 } 587 588 /* write new ccr (change leds state) */ 589 pcan_write_reg(card, PCC_CCR, ccr); 590 591 return err; 592 } 593 594 static int pcan_conf_check(struct pcmcia_device *pdev, void *priv_data) 595 { 596 pdev->resource[0]->flags &= ~IO_DATA_PATH_WIDTH; 597 pdev->resource[0]->flags |= IO_DATA_PATH_WIDTH_8; /* only */ 598 pdev->io_lines = 10; 599 600 /* This reserves IO space but doesn't actually enable it */ 601 return pcmcia_request_io(pdev); 602 } 603 604 /* 605 * free all resources used by the device 606 */ 607 static void pcan_free(struct pcmcia_device *pdev) 608 { 609 struct pcan_pccard *card = pdev->priv; 610 611 if (!card) 612 return; 613 614 free_irq(pdev->irq, card); 615 pcan_stop_led_timer(card); 616 617 pcan_free_channels(card); 618 619 ioport_unmap(card->ioport_addr); 620 621 kfree(card); 622 pdev->priv = NULL; 623 } 624 625 /* 626 * setup PCMCIA socket and probe for PEAK-System PC-CARD 627 */ 628 static int pcan_probe(struct pcmcia_device *pdev) 629 { 630 struct pcan_pccard *card; 631 int err; 632 633 pdev->config_flags |= CONF_ENABLE_IRQ | CONF_AUTO_SET_IO; 634 635 err = pcmcia_loop_config(pdev, pcan_conf_check, NULL); 636 if (err) { 637 dev_err(&pdev->dev, "pcmcia_loop_config() error %d\n", err); 638 goto probe_err_1; 639 } 640 641 if (!pdev->irq) { 642 dev_err(&pdev->dev, "no irq assigned\n"); 643 err = -ENODEV; 644 goto probe_err_1; 645 } 646 647 err = pcmcia_enable_device(pdev); 648 if (err) { 649 dev_err(&pdev->dev, "pcmcia_enable_device failed err=%d\n", 650 err); 651 goto probe_err_1; 652 } 653 654 card = kzalloc(sizeof(struct pcan_pccard), GFP_KERNEL); 655 if (!card) { 656 err = -ENOMEM; 657 goto probe_err_2; 658 } 659 660 card->pdev = pdev; 661 pdev->priv = card; 662 663 /* sja1000 api uses iomem */ 664 card->ioport_addr = ioport_map(pdev->resource[0]->start, 665 resource_size(pdev->resource[0])); 666 if (!card->ioport_addr) { 667 dev_err(&pdev->dev, "couldn't map io port into io memory\n"); 668 err = -ENOMEM; 669 goto probe_err_3; 670 } 671 card->fw_major = pcan_read_reg(card, PCC_FW_MAJOR); 672 card->fw_minor = pcan_read_reg(card, PCC_FW_MINOR); 673 674 /* display board name and firware version */ 675 dev_info(&pdev->dev, "PEAK-System pcmcia card %s fw %d.%d\n", 676 pdev->prod_id[1] ? pdev->prod_id[1] : "PCAN-PC Card", 677 card->fw_major, card->fw_minor); 678 679 /* detect available channels */ 680 pcan_add_channels(card); 681 if (!card->chan_count) { 682 err = -ENOMEM; 683 goto probe_err_4; 684 } 685 686 /* init the timer which controls the leds */ 687 timer_setup(&card->led_timer, pcan_led_timer, 0); 688 689 /* request the given irq */ 690 err = request_irq(pdev->irq, &pcan_isr, IRQF_SHARED, PCC_NAME, card); 691 if (err) { 692 dev_err(&pdev->dev, "couldn't request irq%d\n", pdev->irq); 693 goto probe_err_5; 694 } 695 696 /* power on the connectors */ 697 pcan_set_can_power(card, 1); 698 699 return 0; 700 701 probe_err_5: 702 /* unregister can devices from network */ 703 pcan_free_channels(card); 704 705 probe_err_4: 706 ioport_unmap(card->ioport_addr); 707 708 probe_err_3: 709 kfree(card); 710 pdev->priv = NULL; 711 712 probe_err_2: 713 pcmcia_disable_device(pdev); 714 715 probe_err_1: 716 return err; 717 } 718 719 /* 720 * release claimed resources 721 */ 722 static void pcan_remove(struct pcmcia_device *pdev) 723 { 724 pcan_free(pdev); 725 pcmcia_disable_device(pdev); 726 } 727 728 static struct pcmcia_driver pcan_driver = { 729 .name = PCC_NAME, 730 .probe = pcan_probe, 731 .remove = pcan_remove, 732 .id_table = pcan_table, 733 }; 734 module_pcmcia_driver(pcan_driver); 735