drivers/net/can/sja1000/peak_pcmcia.c

   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);