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