blob: a227586ddd52a6e16a835f5da903963ac748eef6 [file] [log] [blame]
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +00001/*
2 * Copyright (C) 2008-2010 Pavel Cheblakov <P.B.Cheblakov@inp.nsk.su>
3 *
4 * Derived from the ems_pci.c driver:
5 * Copyright (C) 2007 Wolfgang Grandegger <wg@grandegger.com>
6 * Copyright (C) 2008 Markus Plessing <plessing@ems-wuensche.com>
7 * Copyright (C) 2008 Sebastian Haas <haas@ems-wuensche.com>
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 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software Foundation,
20 * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21 */
22
23#include <linux/kernel.h>
24#include <linux/module.h>
25#include <linux/interrupt.h>
26#include <linux/netdevice.h>
27#include <linux/delay.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090028#include <linux/slab.h>
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000029#include <linux/pci.h>
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000030#include <linux/can/dev.h>
31#include <linux/io.h>
32
33#include "sja1000.h"
34
35#define DRV_NAME "sja1000_plx_pci"
36
37MODULE_AUTHOR("Pavel Cheblakov <P.B.Cheblakov@inp.nsk.su>");
38MODULE_DESCRIPTION("Socket-CAN driver for PLX90xx PCI-bridge cards with "
39 "the SJA1000 chips");
40MODULE_SUPPORTED_DEVICE("Adlink PCI-7841/cPCI-7841, "
41 "Adlink PCI-7841/cPCI-7841 SE, "
42 "Marathon CAN-bus-PCI, "
Matthias Fuchs82e38172010-04-07 01:09:56 +000043 "TEWS TECHNOLOGIES TPMC810, "
44 "esd CAN-PCI/CPCI/PCI104/200, "
45 "esd CAN-PCI/PMC/266, "
James Kimee08534b2011-12-12 13:45:58 +010046 "esd CAN-PCIe/2000, "
47 "IXXAT PC-I 04/PCI")
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000048MODULE_LICENSE("GPL v2");
49
50#define PLX_PCI_MAX_CHAN 2
51
52struct plx_pci_card {
53 int channels; /* detected channels count */
54 struct net_device *net_dev[PLX_PCI_MAX_CHAN];
55 void __iomem *conf_addr;
Matthias Fuchs82e38172010-04-07 01:09:56 +000056
57 /* Pointer to device-dependent reset function */
58 void (*reset_func)(struct pci_dev *pdev);
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000059};
60
61#define PLX_PCI_CAN_CLOCK (16000000 / 2)
62
Matthias Fuchs82e38172010-04-07 01:09:56 +000063/* PLX9030/9050/9052 registers */
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000064#define PLX_INTCSR 0x4c /* Interrupt Control/Status */
65#define PLX_CNTRL 0x50 /* User I/O, Direct Slave Response,
66 * Serial EEPROM, and Initialization
67 * Control register
68 */
69
70#define PLX_LINT1_EN 0x1 /* Local interrupt 1 enable */
71#define PLX_LINT2_EN (1 << 3) /* Local interrupt 2 enable */
72#define PLX_PCI_INT_EN (1 << 6) /* PCI Interrupt Enable */
73#define PLX_PCI_RESET (1 << 30) /* PCI Adapter Software Reset */
74
Matthias Fuchs82e38172010-04-07 01:09:56 +000075/* PLX9056 registers */
76#define PLX9056_INTCSR 0x68 /* Interrupt Control/Status */
77#define PLX9056_CNTRL 0x6c /* Control / Software Reset */
78
79#define PLX9056_LINTI (1 << 11)
80#define PLX9056_PCI_INT_EN (1 << 8)
81#define PLX9056_PCI_RCR (1 << 29) /* Read Configuration Registers */
82
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +000083/*
84 * The board configuration is probably following:
85 * RX1 is connected to ground.
86 * TX1 is not connected.
87 * CLKO is not connected.
88 * Setting the OCR register to 0xDA is a good idea.
89 * This means normal output mode, push-pull and the correct polarity.
90 */
91#define PLX_PCI_OCR (OCR_TX0_PUSHPULL | OCR_TX1_PUSHPULL)
92
93/*
94 * In the CDR register, you should set CBP to 1.
95 * You will probably also want to set the clock divider value to 7
96 * (meaning direct oscillator output) because the second SJA1000 chip
97 * is driven by the first one CLKOUT output.
98 */
99#define PLX_PCI_CDR (CDR_CBP | CDR_CLKOUT_MASK)
100
101/* SJA1000 Control Register in the BasicCAN Mode */
102#define REG_CR 0x00
103
104/* States of some SJA1000 registers after hardware reset in the BasicCAN mode*/
105#define REG_CR_BASICCAN_INITIAL 0x21
106#define REG_CR_BASICCAN_INITIAL_MASK 0xa1
107#define REG_SR_BASICCAN_INITIAL 0x0c
108#define REG_IR_BASICCAN_INITIAL 0xe0
109
110/* States of some SJA1000 registers after hardware reset in the PeliCAN mode*/
111#define REG_MOD_PELICAN_INITIAL 0x01
112#define REG_SR_PELICAN_INITIAL 0x3c
113#define REG_IR_PELICAN_INITIAL 0x00
114
115#define ADLINK_PCI_VENDOR_ID 0x144A
116#define ADLINK_PCI_DEVICE_ID 0x7841
117
Matthias Fuchs82e38172010-04-07 01:09:56 +0000118#define ESD_PCI_SUB_SYS_ID_PCI200 0x0004
119#define ESD_PCI_SUB_SYS_ID_PCI266 0x0009
120#define ESD_PCI_SUB_SYS_ID_PMC266 0x000e
121#define ESD_PCI_SUB_SYS_ID_CPCI200 0x010b
122#define ESD_PCI_SUB_SYS_ID_PCIE2000 0x0200
123#define ESD_PCI_SUB_SYS_ID_PCI104200 0x0501
124
James Kimee08534b2011-12-12 13:45:58 +0100125#define IXXAT_PCI_VENDOR_ID 0x10b5
126#define IXXAT_PCI_DEVICE_ID 0x9050
127#define IXXAT_PCI_SUB_SYS_ID 0x2540
128
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000129#define MARATHON_PCI_DEVICE_ID 0x2715
130
131#define TEWS_PCI_VENDOR_ID 0x1498
132#define TEWS_PCI_DEVICE_ID_TMPC810 0x032A
133
134static void plx_pci_reset_common(struct pci_dev *pdev);
135static void plx_pci_reset_marathon(struct pci_dev *pdev);
Matthias Fuchs82e38172010-04-07 01:09:56 +0000136static void plx9056_pci_reset_common(struct pci_dev *pdev);
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000137
138struct plx_pci_channel_map {
139 u32 bar;
140 u32 offset;
141 u32 size; /* 0x00 - auto, e.g. length of entire bar */
142};
143
144struct plx_pci_card_info {
145 const char *name;
146 int channel_count;
147 u32 can_clock;
148 u8 ocr; /* output control register */
149 u8 cdr; /* clock divider register */
150
151 /* Parameters for mapping local configuration space */
152 struct plx_pci_channel_map conf_map;
153
154 /* Parameters for mapping the SJA1000 chips */
155 struct plx_pci_channel_map chan_map_tbl[PLX_PCI_MAX_CHAN];
156
157 /* Pointer to device-dependent reset function */
158 void (*reset_func)(struct pci_dev *pdev);
159};
160
161static struct plx_pci_card_info plx_pci_card_info_adlink __devinitdata = {
162 "Adlink PCI-7841/cPCI-7841", 2,
163 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
164 {1, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x80, 0x80} },
165 &plx_pci_reset_common
166 /* based on PLX9052 */
167};
168
169static struct plx_pci_card_info plx_pci_card_info_adlink_se __devinitdata = {
170 "Adlink PCI-7841/cPCI-7841 SE", 2,
171 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
172 {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x80, 0x80} },
173 &plx_pci_reset_common
174 /* based on PLX9052 */
175};
176
Matthias Fuchs82e38172010-04-07 01:09:56 +0000177static struct plx_pci_card_info plx_pci_card_info_esd200 __devinitdata = {
178 "esd CAN-PCI/CPCI/PCI104/200", 2,
179 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
180 {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} },
181 &plx_pci_reset_common
182 /* based on PLX9030/9050 */
183};
184
185static struct plx_pci_card_info plx_pci_card_info_esd266 __devinitdata = {
186 "esd CAN-PCI/PMC/266", 2,
187 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
188 {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} },
189 &plx9056_pci_reset_common
190 /* based on PLX9056 */
191};
192
193static struct plx_pci_card_info plx_pci_card_info_esd2000 __devinitdata = {
194 "esd CAN-PCIe/2000", 2,
195 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
196 {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} },
197 &plx9056_pci_reset_common
198 /* based on PEX8311 */
199};
200
James Kimee08534b2011-12-12 13:45:58 +0100201static struct plx_pci_card_info plx_pci_card_info_ixxat __devinitdata = {
202 "IXXAT PC-I 04/PCI", 2,
203 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
204 {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x200, 0x80} },
205 &plx_pci_reset_common
206 /* based on PLX9050 */
207};
208
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000209static struct plx_pci_card_info plx_pci_card_info_marathon __devinitdata = {
210 "Marathon CAN-bus-PCI", 2,
211 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
212 {0, 0x00, 0x00}, { {2, 0x00, 0x00}, {4, 0x00, 0x00} },
213 &plx_pci_reset_marathon
214 /* based on PLX9052 */
215};
216
217static struct plx_pci_card_info plx_pci_card_info_tews __devinitdata = {
218 "TEWS TECHNOLOGIES TPMC810", 2,
219 PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR,
220 {0, 0x00, 0x00}, { {2, 0x000, 0x80}, {2, 0x100, 0x80} },
221 &plx_pci_reset_common
222 /* based on PLX9030 */
223};
224
225static DEFINE_PCI_DEVICE_TABLE(plx_pci_tbl) = {
226 {
227 /* Adlink PCI-7841/cPCI-7841 */
228 ADLINK_PCI_VENDOR_ID, ADLINK_PCI_DEVICE_ID,
229 PCI_ANY_ID, PCI_ANY_ID,
230 PCI_CLASS_NETWORK_OTHER << 8, ~0,
231 (kernel_ulong_t)&plx_pci_card_info_adlink
232 },
233 {
234 /* Adlink PCI-7841/cPCI-7841 SE */
235 ADLINK_PCI_VENDOR_ID, ADLINK_PCI_DEVICE_ID,
236 PCI_ANY_ID, PCI_ANY_ID,
237 PCI_CLASS_COMMUNICATION_OTHER << 8, ~0,
238 (kernel_ulong_t)&plx_pci_card_info_adlink_se
239 },
240 {
Matthias Fuchs82e38172010-04-07 01:09:56 +0000241 /* esd CAN-PCI/200 */
242 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050,
243 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI200,
244 0, 0,
245 (kernel_ulong_t)&plx_pci_card_info_esd200
246 },
247 {
248 /* esd CAN-CPCI/200 */
249 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030,
250 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_CPCI200,
251 0, 0,
252 (kernel_ulong_t)&plx_pci_card_info_esd200
253 },
254 {
255 /* esd CAN-PCI104/200 */
256 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030,
257 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI104200,
258 0, 0,
259 (kernel_ulong_t)&plx_pci_card_info_esd200
260 },
261 {
262 /* esd CAN-PCI/266 */
263 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056,
264 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI266,
265 0, 0,
266 (kernel_ulong_t)&plx_pci_card_info_esd266
267 },
268 {
269 /* esd CAN-PMC/266 */
270 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056,
271 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PMC266,
272 0, 0,
273 (kernel_ulong_t)&plx_pci_card_info_esd266
274 },
275 {
276 /* esd CAN-PCIE/2000 */
277 PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056,
278 PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCIE2000,
279 0, 0,
280 (kernel_ulong_t)&plx_pci_card_info_esd2000
281 },
282 {
James Kimee08534b2011-12-12 13:45:58 +0100283 /* IXXAT PC-I 04/PCI card */
284 IXXAT_PCI_VENDOR_ID, IXXAT_PCI_DEVICE_ID,
285 PCI_ANY_ID, IXXAT_PCI_SUB_SYS_ID,
286 0, 0,
287 (kernel_ulong_t)&plx_pci_card_info_ixxat
288 },
289 {
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000290 /* Marathon CAN-bus-PCI card */
291 PCI_VENDOR_ID_PLX, MARATHON_PCI_DEVICE_ID,
292 PCI_ANY_ID, PCI_ANY_ID,
293 0, 0,
294 (kernel_ulong_t)&plx_pci_card_info_marathon
295 },
296 {
297 /* TEWS TECHNOLOGIES TPMC810 card */
298 TEWS_PCI_VENDOR_ID, TEWS_PCI_DEVICE_ID_TMPC810,
299 PCI_ANY_ID, PCI_ANY_ID,
300 0, 0,
301 (kernel_ulong_t)&plx_pci_card_info_tews
302 },
303 { 0,}
304};
305MODULE_DEVICE_TABLE(pci, plx_pci_tbl);
306
307static u8 plx_pci_read_reg(const struct sja1000_priv *priv, int port)
308{
309 return ioread8(priv->reg_base + port);
310}
311
312static void plx_pci_write_reg(const struct sja1000_priv *priv, int port, u8 val)
313{
314 iowrite8(val, priv->reg_base + port);
315}
316
317/*
318 * Check if a CAN controller is present at the specified location
319 * by trying to switch 'em from the Basic mode into the PeliCAN mode.
320 * Also check states of some registers in reset mode.
321 */
322static inline int plx_pci_check_sja1000(const struct sja1000_priv *priv)
323{
324 int flag = 0;
325
326 /*
327 * Check registers after hardware reset (the Basic mode)
328 * See states on p. 10 of the Datasheet.
329 */
330 if ((priv->read_reg(priv, REG_CR) & REG_CR_BASICCAN_INITIAL_MASK) ==
331 REG_CR_BASICCAN_INITIAL &&
332 (priv->read_reg(priv, REG_SR) == REG_SR_BASICCAN_INITIAL) &&
333 (priv->read_reg(priv, REG_IR) == REG_IR_BASICCAN_INITIAL))
334 flag = 1;
335
336 /* Bring the SJA1000 into the PeliCAN mode*/
337 priv->write_reg(priv, REG_CDR, CDR_PELICAN);
338
339 /*
340 * Check registers after reset in the PeliCAN mode.
341 * See states on p. 23 of the Datasheet.
342 */
343 if (priv->read_reg(priv, REG_MOD) == REG_MOD_PELICAN_INITIAL &&
344 priv->read_reg(priv, REG_SR) == REG_SR_PELICAN_INITIAL &&
345 priv->read_reg(priv, REG_IR) == REG_IR_PELICAN_INITIAL)
346 return flag;
347
348 return 0;
349}
350
351/*
Matthias Fuchs82e38172010-04-07 01:09:56 +0000352 * PLX9030/50/52 software reset
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000353 * Also LRESET# asserts and brings to reset device on the Local Bus (if wired).
354 * For most cards it's enough for reset the SJA1000 chips.
355 */
356static void plx_pci_reset_common(struct pci_dev *pdev)
357{
358 struct plx_pci_card *card = pci_get_drvdata(pdev);
359 u32 cntrl;
360
361 cntrl = ioread32(card->conf_addr + PLX_CNTRL);
362 cntrl |= PLX_PCI_RESET;
363 iowrite32(cntrl, card->conf_addr + PLX_CNTRL);
364 udelay(100);
365 cntrl ^= PLX_PCI_RESET;
366 iowrite32(cntrl, card->conf_addr + PLX_CNTRL);
367};
368
Matthias Fuchs82e38172010-04-07 01:09:56 +0000369/*
370 * PLX9056 software reset
371 * Assert LRESET# and reset device(s) on the Local Bus (if wired).
372 */
373static void plx9056_pci_reset_common(struct pci_dev *pdev)
374{
375 struct plx_pci_card *card = pci_get_drvdata(pdev);
376 u32 cntrl;
377
378 /* issue a local bus reset */
379 cntrl = ioread32(card->conf_addr + PLX9056_CNTRL);
380 cntrl |= PLX_PCI_RESET;
381 iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL);
382 udelay(100);
383 cntrl ^= PLX_PCI_RESET;
384 iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL);
385
386 /* reload local configuration from EEPROM */
387 cntrl |= PLX9056_PCI_RCR;
388 iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL);
389
390 /*
391 * There is no safe way to poll for the end
392 * of reconfiguration process. Waiting for 10ms
393 * is safe.
394 */
395 mdelay(10);
396
397 cntrl ^= PLX9056_PCI_RCR;
398 iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL);
399};
400
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000401/* Special reset function for Marathon card */
402static void plx_pci_reset_marathon(struct pci_dev *pdev)
403{
404 void __iomem *reset_addr;
405 int i;
Joe Perches215faf92010-12-21 02:16:10 -0800406 static const int reset_bar[2] = {3, 5};
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000407
408 plx_pci_reset_common(pdev);
409
410 for (i = 0; i < 2; i++) {
411 reset_addr = pci_iomap(pdev, reset_bar[i], 0);
412 if (!reset_addr) {
413 dev_err(&pdev->dev, "Failed to remap reset "
414 "space %d (BAR%d)\n", i, reset_bar[i]);
415 } else {
416 /* reset the SJA1000 chip */
417 iowrite8(0x1, reset_addr);
418 udelay(100);
419 pci_iounmap(pdev, reset_addr);
420 }
421 }
422}
423
424static void plx_pci_del_card(struct pci_dev *pdev)
425{
426 struct plx_pci_card *card = pci_get_drvdata(pdev);
427 struct net_device *dev;
428 struct sja1000_priv *priv;
429 int i = 0;
430
Julia Lawall951f2f92011-08-08 06:28:50 +0000431 for (i = 0; i < PLX_PCI_MAX_CHAN; i++) {
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000432 dev = card->net_dev[i];
433 if (!dev)
434 continue;
435
436 dev_info(&pdev->dev, "Removing %s\n", dev->name);
437 unregister_sja1000dev(dev);
438 priv = netdev_priv(dev);
439 if (priv->reg_base)
440 pci_iounmap(pdev, priv->reg_base);
441 free_sja1000dev(dev);
442 }
443
Matthias Fuchs82e38172010-04-07 01:09:56 +0000444 card->reset_func(pdev);
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000445
446 /*
Matthias Fuchs82e38172010-04-07 01:09:56 +0000447 * Disable interrupts from PCI-card and disable local
448 * interrupts
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000449 */
Matthias Fuchs82e38172010-04-07 01:09:56 +0000450 if (pdev->device != PCI_DEVICE_ID_PLX_9056)
451 iowrite32(0x0, card->conf_addr + PLX_INTCSR);
452 else
453 iowrite32(0x0, card->conf_addr + PLX9056_INTCSR);
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000454
455 if (card->conf_addr)
456 pci_iounmap(pdev, card->conf_addr);
457
458 kfree(card);
459
460 pci_disable_device(pdev);
461 pci_set_drvdata(pdev, NULL);
462}
463
464/*
465 * Probe PLX90xx based device for the SJA1000 chips and register each
466 * available CAN channel to SJA1000 Socket-CAN subsystem.
467 */
468static int __devinit plx_pci_add_card(struct pci_dev *pdev,
469 const struct pci_device_id *ent)
470{
471 struct sja1000_priv *priv;
472 struct net_device *dev;
473 struct plx_pci_card *card;
474 struct plx_pci_card_info *ci;
475 int err, i;
476 u32 val;
477 void __iomem *addr;
478
479 ci = (struct plx_pci_card_info *)ent->driver_data;
480
481 if (pci_enable_device(pdev) < 0) {
482 dev_err(&pdev->dev, "Failed to enable PCI device\n");
483 return -ENODEV;
484 }
485
486 dev_info(&pdev->dev, "Detected \"%s\" card at slot #%i\n",
487 ci->name, PCI_SLOT(pdev->devfn));
488
489 /* Allocate card structures to hold addresses, ... */
490 card = kzalloc(sizeof(*card), GFP_KERNEL);
491 if (!card) {
492 dev_err(&pdev->dev, "Unable to allocate memory\n");
493 pci_disable_device(pdev);
494 return -ENOMEM;
495 }
496
497 pci_set_drvdata(pdev, card);
498
499 card->channels = 0;
500
501 /* Remap PLX90xx configuration space */
502 addr = pci_iomap(pdev, ci->conf_map.bar, ci->conf_map.size);
503 if (!addr) {
504 err = -ENOMEM;
505 dev_err(&pdev->dev, "Failed to remap configuration space "
506 "(BAR%d)\n", ci->conf_map.bar);
507 goto failure_cleanup;
508 }
509 card->conf_addr = addr + ci->conf_map.offset;
510
511 ci->reset_func(pdev);
Matthias Fuchs82e38172010-04-07 01:09:56 +0000512 card->reset_func = ci->reset_func;
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000513
514 /* Detect available channels */
515 for (i = 0; i < ci->channel_count; i++) {
516 struct plx_pci_channel_map *cm = &ci->chan_map_tbl[i];
517
518 dev = alloc_sja1000dev(0);
519 if (!dev) {
520 err = -ENOMEM;
521 goto failure_cleanup;
522 }
523
524 card->net_dev[i] = dev;
525 priv = netdev_priv(dev);
526 priv->priv = card;
527 priv->irq_flags = IRQF_SHARED;
528
529 dev->irq = pdev->irq;
530
531 /*
532 * Remap IO space of the SJA1000 chips
533 * This is device-dependent mapping
534 */
535 addr = pci_iomap(pdev, cm->bar, cm->size);
536 if (!addr) {
537 err = -ENOMEM;
538 dev_err(&pdev->dev, "Failed to remap BAR%d\n", cm->bar);
539 goto failure_cleanup;
540 }
541
542 priv->reg_base = addr + cm->offset;
543 priv->read_reg = plx_pci_read_reg;
544 priv->write_reg = plx_pci_write_reg;
545
546 /* Check if channel is present */
547 if (plx_pci_check_sja1000(priv)) {
548 priv->can.clock.freq = ci->can_clock;
549 priv->ocr = ci->ocr;
550 priv->cdr = ci->cdr;
551
552 SET_NETDEV_DEV(dev, &pdev->dev);
553
554 /* Register SJA1000 device */
555 err = register_sja1000dev(dev);
556 if (err) {
557 dev_err(&pdev->dev, "Registering device failed "
558 "(err=%d)\n", err);
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000559 goto failure_cleanup;
560 }
561
562 card->channels++;
563
564 dev_info(&pdev->dev, "Channel #%d at 0x%p, irq %d "
565 "registered as %s\n", i + 1, priv->reg_base,
566 dev->irq, dev->name);
567 } else {
568 dev_err(&pdev->dev, "Channel #%d not detected\n",
569 i + 1);
570 free_sja1000dev(dev);
Julia Lawall951f2f92011-08-08 06:28:50 +0000571 card->net_dev[i] = NULL;
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000572 }
573 }
574
575 if (!card->channels) {
576 err = -ENODEV;
577 goto failure_cleanup;
578 }
579
580 /*
581 * Enable interrupts from PCI-card (PLX90xx) and enable Local_1,
582 * Local_2 interrupts from the SJA1000 chips
583 */
Matthias Fuchs82e38172010-04-07 01:09:56 +0000584 if (pdev->device != PCI_DEVICE_ID_PLX_9056) {
585 val = ioread32(card->conf_addr + PLX_INTCSR);
586 if (pdev->subsystem_vendor == PCI_VENDOR_ID_ESDGMBH)
587 val |= PLX_LINT1_EN | PLX_PCI_INT_EN;
588 else
589 val |= PLX_LINT1_EN | PLX_LINT2_EN | PLX_PCI_INT_EN;
590 iowrite32(val, card->conf_addr + PLX_INTCSR);
591 } else {
592 iowrite32(PLX9056_LINTI | PLX9056_PCI_INT_EN,
593 card->conf_addr + PLX9056_INTCSR);
594 }
Pavel Cheblakov24c4a3b2010-02-01 09:42:44 +0000595 return 0;
596
597failure_cleanup:
598 dev_err(&pdev->dev, "Error: %d. Cleaning Up.\n", err);
599
600 plx_pci_del_card(pdev);
601
602 return err;
603}
604
605static struct pci_driver plx_pci_driver = {
606 .name = DRV_NAME,
607 .id_table = plx_pci_tbl,
608 .probe = plx_pci_add_card,
609 .remove = plx_pci_del_card,
610};
611
612static int __init plx_pci_init(void)
613{
614 return pci_register_driver(&plx_pci_driver);
615}
616
617static void __exit plx_pci_exit(void)
618{
619 pci_unregister_driver(&plx_pci_driver);
620}
621
622module_init(plx_pci_init);
623module_exit(plx_pci_exit);