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