drivers/net/can/sja1000/peak_pci.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Copyright (C) 2007, 2011 Wolfgang Grandegger <wg@grandegger.com>
   4  * Copyright (C) 2012 Stephane Grosjean <s.grosjean@peak-system.com>
   5  *
   6  * Derived from the PCAN project file driver/src/pcan_pci.c:
   7  *
   8  * Copyright (C) 2001-2006  PEAK System-Technik GmbH
   9  */
  10
  11 #include <linux/kernel.h>
  12 #include <linux/module.h>
  13 #include <linux/interrupt.h>
  14 #include <linux/netdevice.h>
  15 #include <linux/delay.h>
  16 #include <linux/pci.h>
  17 #include <linux/io.h>
  18 #include <linux/i2c.h>
  19 #include <linux/i2c-algo-bit.h>
  20 #include <linux/can.h>
  21 #include <linux/can/dev.h>
  22
  23 #include "sja1000.h"
  24
  25 MODULE_AUTHOR("Stephane Grosjean <s.grosjean@peak-system.com>");
  26 MODULE_DESCRIPTION("Socket-CAN driver for PEAK PCAN PCI family cards");
  27 MODULE_SUPPORTED_DEVICE("PEAK PCAN PCI/PCIe/PCIeC miniPCI CAN cards");
  28 MODULE_SUPPORTED_DEVICE("PEAK PCAN miniPCIe/cPCI PC/104+ PCI/104e CAN Cards");
  29 MODULE_LICENSE("GPL v2");
  30
  31 #define DRV_NAME  "peak_pci"
  32
  33 struct peak_pciec_card;
  34 struct peak_pci_chan {
  35         void __iomem *cfg_base;         /* Common for all channels */
  36         struct net_device *prev_dev;    /* Chain of network devices */
  37         u16 icr_mask;                   /* Interrupt mask for fast ack */
  38         struct peak_pciec_card *pciec_card;     /* only for PCIeC LEDs */
  39 };
  40
  41 #define PEAK_PCI_CAN_CLOCK      (16000000 / 2)
  42
  43 #define PEAK_PCI_CDR            (CDR_CBP | CDR_CLKOUT_MASK)
  44 #define PEAK_PCI_OCR            OCR_TX0_PUSHPULL
  45
  46 /*
  47  * Important PITA registers
  48  */
  49 #define PITA_ICR                0x00    /* Interrupt control register */
  50 #define PITA_GPIOICR            0x18    /* GPIO interface control register */
  51 #define PITA_MISC               0x1C    /* Miscellaneous register */
  52
  53 #define PEAK_PCI_CFG_SIZE       0x1000  /* Size of the config PCI bar */
  54 #define PEAK_PCI_CHAN_SIZE      0x0400  /* Size used by the channel */
  55
  56 #define PEAK_PCI_VENDOR_ID      0x001C  /* The PCI device and vendor IDs */
  57 #define PEAK_PCI_DEVICE_ID      0x0001  /* for PCI/PCIe slot cards */
  58 #define PEAK_PCIEC_DEVICE_ID    0x0002  /* for ExpressCard slot cards */
  59 #define PEAK_PCIE_DEVICE_ID     0x0003  /* for nextgen PCIe slot cards */
  60 #define PEAK_CPCI_DEVICE_ID     0x0004  /* for nextgen cPCI slot cards */
  61 #define PEAK_MPCI_DEVICE_ID     0x0005  /* for nextgen miniPCI slot cards */
  62 #define PEAK_PC_104P_DEVICE_ID  0x0006  /* PCAN-PC/104+ cards */
  63 #define PEAK_PCI_104E_DEVICE_ID 0x0007  /* PCAN-PCI/104 Express cards */
  64 #define PEAK_MPCIE_DEVICE_ID    0x0008  /* The miniPCIe slot cards */
  65 #define PEAK_PCIE_OEM_ID        0x0009  /* PCAN-PCI Express OEM */
  66 #define PEAK_PCIEC34_DEVICE_ID  0x000A  /* PCAN-PCI Express 34 (one channel) */
  67
  68 #define PEAK_PCI_CHAN_MAX       4
  69
  70 static const u16 peak_pci_icr_masks[PEAK_PCI_CHAN_MAX] = {
  71         0x02, 0x01, 0x40, 0x80
  72 };
  73
  74 static const struct pci_device_id peak_pci_tbl[] = {
  75         {PEAK_PCI_VENDOR_ID, PEAK_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  76         {PEAK_PCI_VENDOR_ID, PEAK_PCIE_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  77         {PEAK_PCI_VENDOR_ID, PEAK_MPCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  78         {PEAK_PCI_VENDOR_ID, PEAK_MPCIE_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  79         {PEAK_PCI_VENDOR_ID, PEAK_PC_104P_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  80         {PEAK_PCI_VENDOR_ID, PEAK_PCI_104E_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  81         {PEAK_PCI_VENDOR_ID, PEAK_CPCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  82         {PEAK_PCI_VENDOR_ID, PEAK_PCIE_OEM_ID, PCI_ANY_ID, PCI_ANY_ID,},
  83 #ifdef CONFIG_CAN_PEAK_PCIEC
  84         {PEAK_PCI_VENDOR_ID, PEAK_PCIEC_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  85         {PEAK_PCI_VENDOR_ID, PEAK_PCIEC34_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID,},
  86 #endif
  87         {0,}
  88 };
  89
  90 MODULE_DEVICE_TABLE(pci, peak_pci_tbl);
  91
  92 #ifdef CONFIG_CAN_PEAK_PCIEC
  93 /*
  94  * PCAN-ExpressCard needs I2C bit-banging configuration option.
  95  */
  96
  97 /* GPIOICR byte access offsets */
  98 #define PITA_GPOUT              0x18    /* GPx output value */
  99 #define PITA_GPIN               0x19    /* GPx input value */
 100 #define PITA_GPOEN              0x1A    /* configure GPx as ouput pin */
 101
 102 /* I2C GP bits */
 103 #define PITA_GPIN_SCL           0x01    /* Serial Clock Line */
 104 #define PITA_GPIN_SDA           0x04    /* Serial DAta line */
 105
 106 #define PCA9553_1_SLAVEADDR     (0xC4 >> 1)
 107
 108 /* PCA9553 LS0 fields values */
 109 enum {
 110         PCA9553_LOW,
 111         PCA9553_HIGHZ,
 112         PCA9553_PWM0,
 113         PCA9553_PWM1
 114 };
 115
 116 /* LEDs control */
 117 #define PCA9553_ON              PCA9553_LOW
 118 #define PCA9553_OFF             PCA9553_HIGHZ
 119 #define PCA9553_SLOW            PCA9553_PWM0
 120 #define PCA9553_FAST            PCA9553_PWM1
 121
 122 #define PCA9553_LED(c)          (1 << (c))
 123 #define PCA9553_LED_STATE(s, c) ((s) << ((c) << 1))
 124
 125 #define PCA9553_LED_ON(c)       PCA9553_LED_STATE(PCA9553_ON, c)
 126 #define PCA9553_LED_OFF(c)      PCA9553_LED_STATE(PCA9553_OFF, c)
 127 #define PCA9553_LED_SLOW(c)     PCA9553_LED_STATE(PCA9553_SLOW, c)
 128 #define PCA9553_LED_FAST(c)     PCA9553_LED_STATE(PCA9553_FAST, c)
 129 #define PCA9553_LED_MASK(c)     PCA9553_LED_STATE(0x03, c)
 130
 131 #define PCA9553_LED_OFF_ALL     (PCA9553_LED_OFF(0) | PCA9553_LED_OFF(1))
 132
 133 #define PCA9553_LS0_INIT        0x40 /* initial value (!= from 0x00) */
 134
 135 struct peak_pciec_chan {
 136         struct net_device *netdev;
 137         unsigned long prev_rx_bytes;
 138         unsigned long prev_tx_bytes;
 139 };
 140
 141 struct peak_pciec_card {
 142         void __iomem *cfg_base;         /* Common for all channels */
 143         void __iomem *reg_base;         /* first channel base address */
 144         u8 led_cache;                   /* leds state cache */
 145
 146         /* PCIExpressCard i2c data */
 147         struct i2c_algo_bit_data i2c_bit;
 148         struct i2c_adapter led_chip;
 149         struct delayed_work led_work;   /* led delayed work */
 150         int chan_count;
 151         struct peak_pciec_chan channel[PEAK_PCI_CHAN_MAX];
 152 };
 153
 154 /* "normal" pci register write callback is overloaded for leds control */
 155 static void peak_pci_write_reg(const struct sja1000_priv *priv,
 156                                int port, u8 val);
 157
 158 static inline void pita_set_scl_highz(struct peak_pciec_card *card)
 159 {
 160         u8 gp_outen = readb(card->cfg_base + PITA_GPOEN) & ~PITA_GPIN_SCL;
 161         writeb(gp_outen, card->cfg_base + PITA_GPOEN);
 162 }
 163
 164 static inline void pita_set_sda_highz(struct peak_pciec_card *card)
 165 {
 166         u8 gp_outen = readb(card->cfg_base + PITA_GPOEN) & ~PITA_GPIN_SDA;
 167         writeb(gp_outen, card->cfg_base + PITA_GPOEN);
 168 }
 169
 170 static void peak_pciec_init_pita_gpio(struct peak_pciec_card *card)
 171 {
 172         /* raise SCL & SDA GPIOs to high-Z */
 173         pita_set_scl_highz(card);
 174         pita_set_sda_highz(card);
 175 }
 176
 177 static void pita_setsda(void *data, int state)
 178 {
 179         struct peak_pciec_card *card = (struct peak_pciec_card *)data;
 180         u8 gp_out, gp_outen;
 181
 182         /* set output sda always to 0 */
 183         gp_out = readb(card->cfg_base + PITA_GPOUT) & ~PITA_GPIN_SDA;
 184         writeb(gp_out, card->cfg_base + PITA_GPOUT);
 185
 186         /* control output sda with GPOEN */
 187         gp_outen = readb(card->cfg_base + PITA_GPOEN);
 188         if (state)
 189                 gp_outen &= ~PITA_GPIN_SDA;
 190         else
 191                 gp_outen |= PITA_GPIN_SDA;
 192
 193         writeb(gp_outen, card->cfg_base + PITA_GPOEN);
 194 }
 195
 196 static void pita_setscl(void *data, int state)
 197 {
 198         struct peak_pciec_card *card = (struct peak_pciec_card *)data;
 199         u8 gp_out, gp_outen;
 200
 201         /* set output scl always to 0 */
 202         gp_out = readb(card->cfg_base + PITA_GPOUT) & ~PITA_GPIN_SCL;
 203         writeb(gp_out, card->cfg_base + PITA_GPOUT);
 204
 205         /* control output scl with GPOEN */
 206         gp_outen = readb(card->cfg_base + PITA_GPOEN);
 207         if (state)
 208                 gp_outen &= ~PITA_GPIN_SCL;
 209         else
 210                 gp_outen |= PITA_GPIN_SCL;
 211
 212         writeb(gp_outen, card->cfg_base + PITA_GPOEN);
 213 }
 214
 215 static int pita_getsda(void *data)
 216 {
 217         struct peak_pciec_card *card = (struct peak_pciec_card *)data;
 218
 219         /* set tristate */
 220         pita_set_sda_highz(card);
 221
 222         return (readb(card->cfg_base + PITA_GPIN) & PITA_GPIN_SDA) ? 1 : 0;
 223 }
 224
 225 static int pita_getscl(void *data)
 226 {
 227         struct peak_pciec_card *card = (struct peak_pciec_card *)data;
 228
 229         /* set tristate */
 230         pita_set_scl_highz(card);
 231
 232         return (readb(card->cfg_base + PITA_GPIN) & PITA_GPIN_SCL) ? 1 : 0;
 233 }
 234
 235 /*
 236  * write commands to the LED chip though the I2C-bus of the PCAN-PCIeC
 237  */
 238 static int peak_pciec_write_pca9553(struct peak_pciec_card *card,
 239                                     u8 offset, u8 data)
 240 {
 241         u8 buffer[2] = {
 242                 offset,
 243                 data
 244         };
 245         struct i2c_msg msg = {
 246                 .addr = PCA9553_1_SLAVEADDR,
 247                 .len = 2,
 248                 .buf = buffer,
 249         };
 250         int ret;
 251
 252         /* cache led mask */
 253         if ((offset == 5) && (data == card->led_cache))
 254                 return 0;
 255
 256         ret = i2c_transfer(&card->led_chip, &msg, 1);
 257         if (ret < 0)
 258                 return ret;
 259
 260         if (offset == 5)
 261                 card->led_cache = data;
 262
 263         return 0;
 264 }
 265
 266 /*
 267  * delayed work callback used to control the LEDs
 268  */
 269 static void peak_pciec_led_work(struct work_struct *work)
 270 {
 271         struct peak_pciec_card *card =
 272                 container_of(work, struct peak_pciec_card, led_work.work);
 273         struct net_device *netdev;
 274         u8 new_led = card->led_cache;
 275         int i, up_count = 0;
 276
 277         /* first check what is to do */
 278         for (i = 0; i < card->chan_count; i++) {
 279                 /* default is: not configured */
 280                 new_led &= ~PCA9553_LED_MASK(i);
 281                 new_led |= PCA9553_LED_ON(i);
 282
 283                 netdev = card->channel[i].netdev;
 284                 if (!netdev || !(netdev->flags & IFF_UP))
 285                         continue;
 286
 287                 up_count++;
 288
 289                 /* no activity (but configured) */
 290                 new_led &= ~PCA9553_LED_MASK(i);
 291                 new_led |= PCA9553_LED_SLOW(i);
 292
 293                 /* if bytes counters changed, set fast blinking led */
 294                 if (netdev->stats.rx_bytes != card->channel[i].prev_rx_bytes) {
 295                         card->channel[i].prev_rx_bytes = netdev->stats.rx_bytes;
 296                         new_led &= ~PCA9553_LED_MASK(i);
 297                         new_led |= PCA9553_LED_FAST(i);
 298                 }
 299                 if (netdev->stats.tx_bytes != card->channel[i].prev_tx_bytes) {
 300                         card->channel[i].prev_tx_bytes = netdev->stats.tx_bytes;
 301                         new_led &= ~PCA9553_LED_MASK(i);
 302                         new_led |= PCA9553_LED_FAST(i);
 303                 }
 304         }
 305
 306         /* check if LS0 settings changed, only update i2c if so */
 307         peak_pciec_write_pca9553(card, 5, new_led);
 308
 309         /* restart timer (except if no more configured channels) */
 310         if (up_count)
 311                 schedule_delayed_work(&card->led_work, HZ);
 312 }
 313
 314 /*
 315  * set LEDs blinking state
 316  */
 317 static void peak_pciec_set_leds(struct peak_pciec_card *card, u8 led_mask, u8 s)
 318 {
 319         u8 new_led = card->led_cache;
 320         int i;
 321
 322         /* first check what is to do */
 323         for (i = 0; i < card->chan_count; i++)
 324                 if (led_mask & PCA9553_LED(i)) {
 325                         new_led &= ~PCA9553_LED_MASK(i);
 326                         new_led |= PCA9553_LED_STATE(s, i);
 327                 }
 328
 329         /* check if LS0 settings changed, only update i2c if so */
 330         peak_pciec_write_pca9553(card, 5, new_led);
 331 }
 332
 333 /*
 334  * start one second delayed work to control LEDs
 335  */
 336 static void peak_pciec_start_led_work(struct peak_pciec_card *card)
 337 {
 338         schedule_delayed_work(&card->led_work, HZ);
 339 }
 340
 341 /*
 342  * stop LEDs delayed work
 343  */
 344 static void peak_pciec_stop_led_work(struct peak_pciec_card *card)
 345 {
 346         cancel_delayed_work_sync(&card->led_work);
 347 }
 348
 349 /*
 350  * initialize the PCA9553 4-bit I2C-bus LED chip
 351  */
 352 static int peak_pciec_init_leds(struct peak_pciec_card *card)
 353 {
 354         int err;
 355
 356         /* prescaler for frequency 0: "SLOW" = 1 Hz = "44" */
 357         err = peak_pciec_write_pca9553(card, 1, 44 / 1);
 358         if (err)
 359                 return err;
 360
 361         /* duty cycle 0: 50% */
 362         err = peak_pciec_write_pca9553(card, 2, 0x80);
 363         if (err)
 364                 return err;
 365
 366         /* prescaler for frequency 1: "FAST" = 5 Hz */
 367         err = peak_pciec_write_pca9553(card, 3, 44 / 5);
 368         if (err)
 369                 return err;
 370
 371         /* duty cycle 1: 50% */
 372         err = peak_pciec_write_pca9553(card, 4, 0x80);
 373         if (err)
 374                 return err;
 375
 376         /* switch LEDs to initial state */
 377         return peak_pciec_write_pca9553(card, 5, PCA9553_LS0_INIT);
 378 }
 379
 380 /*
 381  * restore LEDs state to off peak_pciec_leds_exit
 382  */
 383 static void peak_pciec_leds_exit(struct peak_pciec_card *card)
 384 {
 385         /* switch LEDs to off */
 386         peak_pciec_write_pca9553(card, 5, PCA9553_LED_OFF_ALL);
 387 }
 388
 389 /*
 390  * normal write sja1000 register method overloaded to catch when controller
 391  * is started or stopped, to control leds
 392  */
 393 static void peak_pciec_write_reg(const struct sja1000_priv *priv,
 394                                  int port, u8 val)
 395 {
 396         struct peak_pci_chan *chan = priv->priv;
 397         struct peak_pciec_card *card = chan->pciec_card;
 398         int c = (priv->reg_base - card->reg_base) / PEAK_PCI_CHAN_SIZE;
 399
 400         /* sja1000 register changes control the leds state */
 401         if (port == SJA1000_MOD)
 402                 switch (val) {
 403                 case MOD_RM:
 404                         /* Reset Mode: set led on */
 405                         peak_pciec_set_leds(card, PCA9553_LED(c), PCA9553_ON);
 406                         break;
 407                 case 0x00:
 408                         /* Normal Mode: led slow blinking and start led timer */
 409                         peak_pciec_set_leds(card, PCA9553_LED(c), PCA9553_SLOW);
 410                         peak_pciec_start_led_work(card);
 411                         break;
 412                 default:
 413                         break;
 414                 }
 415
 416         /* call base function */
 417         peak_pci_write_reg(priv, port, val);
 418 }
 419
 420 static struct i2c_algo_bit_data peak_pciec_i2c_bit_ops = {
 421         .setsda = pita_setsda,
 422         .setscl = pita_setscl,
 423         .getsda = pita_getsda,
 424         .getscl = pita_getscl,
 425         .udelay = 10,
 426         .timeout = HZ,
 427 };
 428
 429 static int peak_pciec_probe(struct pci_dev *pdev, struct net_device *dev)
 430 {
 431         struct sja1000_priv *priv = netdev_priv(dev);
 432         struct peak_pci_chan *chan = priv->priv;
 433         struct peak_pciec_card *card;
 434         int err;
 435
 436         /* copy i2c object address from 1st channel */
 437         if (chan->prev_dev) {
 438                 struct sja1000_priv *prev_priv = netdev_priv(chan->prev_dev);
 439                 struct peak_pci_chan *prev_chan = prev_priv->priv;
 440
 441                 card = prev_chan->pciec_card;
 442                 if (!card)
 443                         return -ENODEV;
 444
 445         /* channel is the first one: do the init part */
 446         } else {
 447                 /* create the bit banging I2C adapter structure */
 448                 card = kzalloc(sizeof(struct peak_pciec_card), GFP_KERNEL);
 449                 if (!card)
 450                         return -ENOMEM;
 451
 452                 card->cfg_base = chan->cfg_base;
 453                 card->reg_base = priv->reg_base;
 454
 455                 card->led_chip.owner = THIS_MODULE;
 456                 card->led_chip.dev.parent = &pdev->dev;
 457                 card->led_chip.algo_data = &card->i2c_bit;
 458                 strncpy(card->led_chip.name, "peak_i2c",
 459                         sizeof(card->led_chip.name));
 460
 461                 card->i2c_bit = peak_pciec_i2c_bit_ops;
 462                 card->i2c_bit.udelay = 10;
 463                 card->i2c_bit.timeout = HZ;
 464                 card->i2c_bit.data = card;
 465
 466                 peak_pciec_init_pita_gpio(card);
 467
 468                 err = i2c_bit_add_bus(&card->led_chip);
 469                 if (err) {
 470                         dev_err(&pdev->dev, "i2c init failed\n");
 471                         goto pciec_init_err_1;
 472                 }
 473
 474                 err = peak_pciec_init_leds(card);
 475                 if (err) {
 476                         dev_err(&pdev->dev, "leds hardware init failed\n");
 477                         goto pciec_init_err_2;
 478                 }
 479
 480                 INIT_DELAYED_WORK(&card->led_work, peak_pciec_led_work);
 481                 /* PCAN-ExpressCard needs its own callback for leds */
 482                 priv->write_reg = peak_pciec_write_reg;
 483         }
 484
 485         chan->pciec_card = card;
 486         card->channel[card->chan_count++].netdev = dev;
 487
 488         return 0;
 489
 490 pciec_init_err_2:
 491         i2c_del_adapter(&card->led_chip);
 492
 493 pciec_init_err_1:
 494         peak_pciec_init_pita_gpio(card);
 495         kfree(card);
 496
 497         return err;
 498 }
 499
 500 static void peak_pciec_remove(struct peak_pciec_card *card)
 501 {
 502         peak_pciec_stop_led_work(card);
 503         peak_pciec_leds_exit(card);
 504         i2c_del_adapter(&card->led_chip);
 505         peak_pciec_init_pita_gpio(card);
 506         kfree(card);
 507 }
 508
 509 #else /* CONFIG_CAN_PEAK_PCIEC */
 510
 511 /*
 512  * Placebo functions when PCAN-ExpressCard support is not selected
 513  */
 514 static inline int peak_pciec_probe(struct pci_dev *pdev, struct net_device *dev)
 515 {
 516         return -ENODEV;
 517 }
 518
 519 static inline void peak_pciec_remove(struct peak_pciec_card *card)
 520 {
 521 }
 522 #endif /* CONFIG_CAN_PEAK_PCIEC */
 523
 524 static u8 peak_pci_read_reg(const struct sja1000_priv *priv, int port)
 525 {
 526         return readb(priv->reg_base + (port << 2));
 527 }
 528
 529 static void peak_pci_write_reg(const struct sja1000_priv *priv,
 530                                int port, u8 val)
 531 {
 532         writeb(val, priv->reg_base + (port << 2));
 533 }
 534
 535 static void peak_pci_post_irq(const struct sja1000_priv *priv)
 536 {
 537         struct peak_pci_chan *chan = priv->priv;
 538         u16 icr;
 539
 540         /* Select and clear in PITA stored interrupt */
 541         icr = readw(chan->cfg_base + PITA_ICR);
 542         if (icr & chan->icr_mask)
 543                 writew(chan->icr_mask, chan->cfg_base + PITA_ICR);
 544 }
 545
 546 static int peak_pci_probe(struct pci_dev *pdev, const struct pci_device_id *ent)
 547 {
 548         struct sja1000_priv *priv;
 549         struct peak_pci_chan *chan;
 550         struct net_device *dev, *prev_dev;
 551         void __iomem *cfg_base, *reg_base;
 552         u16 sub_sys_id, icr;
 553         int i, err, channels;
 554
 555         err = pci_enable_device(pdev);
 556         if (err)
 557                 return err;
 558
 559         err = pci_request_regions(pdev, DRV_NAME);
 560         if (err)
 561                 goto failure_disable_pci;
 562
 563         err = pci_read_config_word(pdev, 0x2e, &sub_sys_id);
 564         if (err)
 565                 goto failure_release_regions;
 566
 567         dev_dbg(&pdev->dev, "probing device %04x:%04x:%04x\n",
 568                 pdev->vendor, pdev->device, sub_sys_id);
 569
 570         err = pci_write_config_word(pdev, 0x44, 0);
 571         if (err)
 572                 goto failure_release_regions;
 573
 574         if (sub_sys_id >= 12)
 575                 channels = 4;
 576         else if (sub_sys_id >= 10)
 577                 channels = 3;
 578         else if (sub_sys_id >= 4)
 579                 channels = 2;
 580         else
 581                 channels = 1;
 582
 583         cfg_base = pci_iomap(pdev, 0, PEAK_PCI_CFG_SIZE);
 584         if (!cfg_base) {
 585                 dev_err(&pdev->dev, "failed to map PCI resource #0\n");
 586                 err = -ENOMEM;
 587                 goto failure_release_regions;
 588         }
 589
 590         reg_base = pci_iomap(pdev, 1, PEAK_PCI_CHAN_SIZE * channels);
 591         if (!reg_base) {
 592                 dev_err(&pdev->dev, "failed to map PCI resource #1\n");
 593                 err = -ENOMEM;
 594                 goto failure_unmap_cfg_base;
 595         }
 596
 597         /* Set GPIO control register */
 598         writew(0x0005, cfg_base + PITA_GPIOICR + 2);
 599         /* Enable all channels of this card */
 600         writeb(0x00, cfg_base + PITA_GPIOICR);
 601         /* Toggle reset */
 602         writeb(0x05, cfg_base + PITA_MISC + 3);
 603         usleep_range(5000, 6000);
 604         /* Leave parport mux mode */
 605         writeb(0x04, cfg_base + PITA_MISC + 3);
 606
 607         icr = readw(cfg_base + PITA_ICR + 2);
 608
 609         for (i = 0; i < channels; i++) {
 610                 dev = alloc_sja1000dev(sizeof(struct peak_pci_chan));
 611                 if (!dev) {
 612                         err = -ENOMEM;
 613                         goto failure_remove_channels;
 614                 }
 615
 616                 priv = netdev_priv(dev);
 617                 chan = priv->priv;
 618
 619                 chan->cfg_base = cfg_base;
 620                 priv->reg_base = reg_base + i * PEAK_PCI_CHAN_SIZE;
 621
 622                 priv->read_reg = peak_pci_read_reg;
 623                 priv->write_reg = peak_pci_write_reg;
 624                 priv->post_irq = peak_pci_post_irq;
 625
 626                 priv->can.clock.freq = PEAK_PCI_CAN_CLOCK;
 627                 priv->ocr = PEAK_PCI_OCR;
 628                 priv->cdr = PEAK_PCI_CDR;
 629                 /* Neither a slave nor a single device distributes the clock */
 630                 if (channels == 1 || i > 0)
 631                         priv->cdr |= CDR_CLK_OFF;
 632
 633                 /* Setup interrupt handling */
 634                 priv->irq_flags = IRQF_SHARED;
 635                 dev->irq = pdev->irq;
 636
 637                 chan->icr_mask = peak_pci_icr_masks[i];
 638                 icr |= chan->icr_mask;
 639
 640                 SET_NETDEV_DEV(dev, &pdev->dev);
 641                 dev->dev_id = i;
 642
 643                 /* Create chain of SJA1000 devices */
 644                 chan->prev_dev = pci_get_drvdata(pdev);
 645                 pci_set_drvdata(pdev, dev);
 646
 647                 /*
 648                  * PCAN-ExpressCard needs some additional i2c init.
 649                  * This must be done *before* register_sja1000dev() but
 650                  * *after* devices linkage
 651                  */
 652                 if (pdev->device == PEAK_PCIEC_DEVICE_ID ||
 653                     pdev->device == PEAK_PCIEC34_DEVICE_ID) {
 654                         err = peak_pciec_probe(pdev, dev);
 655                         if (err) {
 656                                 dev_err(&pdev->dev,
 657                                         "failed to probe device (err %d)\n",
 658                                         err);
 659                                 goto failure_free_dev;
 660                         }
 661                 }
 662
 663                 err = register_sja1000dev(dev);
 664                 if (err) {
 665                         dev_err(&pdev->dev, "failed to register device\n");
 666                         goto failure_free_dev;
 667                 }
 668
 669                 dev_info(&pdev->dev,
 670                          "%s at reg_base=0x%p cfg_base=0x%p irq=%d\n",
 671                          dev->name, priv->reg_base, chan->cfg_base, dev->irq);
 672         }
 673
 674         /* Enable interrupts */
 675         writew(icr, cfg_base + PITA_ICR + 2);
 676
 677         return 0;
 678
 679 failure_free_dev:
 680         pci_set_drvdata(pdev, chan->prev_dev);
 681         free_sja1000dev(dev);
 682
 683 failure_remove_channels:
 684         /* Disable interrupts */
 685         writew(0x0, cfg_base + PITA_ICR + 2);
 686
 687         chan = NULL;
 688         for (dev = pci_get_drvdata(pdev); dev; dev = prev_dev) {
 689                 priv = netdev_priv(dev);
 690                 chan = priv->priv;
 691                 prev_dev = chan->prev_dev;
 692
 693                 unregister_sja1000dev(dev);
 694                 free_sja1000dev(dev);
 695         }
 696
 697         /* free any PCIeC resources too */
 698         if (chan && chan->pciec_card)
 699                 peak_pciec_remove(chan->pciec_card);
 700
 701         pci_iounmap(pdev, reg_base);
 702
 703 failure_unmap_cfg_base:
 704         pci_iounmap(pdev, cfg_base);
 705
 706 failure_release_regions:
 707         pci_release_regions(pdev);
 708
 709 failure_disable_pci:
 710         pci_disable_device(pdev);
 711
 712         /* pci_xxx_config_word() return positive PCIBIOS_xxx error codes while
 713          * the probe() function must return a negative errno in case of failure
 714          * (err is unchanged if negative) */
 715         return pcibios_err_to_errno(err);
 716 }
 717
 718 static void peak_pci_remove(struct pci_dev *pdev)
 719 {
 720         struct net_device *dev = pci_get_drvdata(pdev); /* Last device */
 721         struct sja1000_priv *priv = netdev_priv(dev);
 722         struct peak_pci_chan *chan = priv->priv;
 723         void __iomem *cfg_base = chan->cfg_base;
 724         void __iomem *reg_base = priv->reg_base;
 725
 726         /* Disable interrupts */
 727         writew(0x0, cfg_base + PITA_ICR + 2);
 728
 729         /* Loop over all registered devices */
 730         while (1) {
 731                 struct net_device *prev_dev = chan->prev_dev;
 732
 733                 dev_info(&pdev->dev, "removing device %s\n", dev->name);
 734                 unregister_sja1000dev(dev);
 735                 free_sja1000dev(dev);
 736                 dev = prev_dev;
 737
 738                 if (!dev) {
 739                         /* do that only for first channel */
 740                         if (chan->pciec_card)
 741                                 peak_pciec_remove(chan->pciec_card);
 742                         break;
 743                 }
 744                 priv = netdev_priv(dev);
 745                 chan = priv->priv;
 746         }
 747
 748         pci_iounmap(pdev, reg_base);
 749         pci_iounmap(pdev, cfg_base);
 750         pci_release_regions(pdev);
 751         pci_disable_device(pdev);
 752 }
 753
 754 static struct pci_driver peak_pci_driver = {
 755         .name = DRV_NAME,
 756         .id_table = peak_pci_tbl,
 757         .probe = peak_pci_probe,
 758         .remove = peak_pci_remove,
 759 };
 760
 761 module_pci_driver(peak_pci_driver);