// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (C) 2008-2010 Pavel Cheblakov * * Derived from the ems_pci.c driver: * Copyright (C) 2007 Wolfgang Grandegger * Copyright (C) 2008 Markus Plessing * Copyright (C) 2008 Sebastian Haas */ #include #include #include #include #include #include #include #include #include #include "sja1000.h" #define DRV_NAME "sja1000_plx_pci" MODULE_AUTHOR("Pavel Cheblakov "); MODULE_DESCRIPTION("Socket-CAN driver for PLX90xx PCI-bridge cards with " "the SJA1000 chips"); MODULE_LICENSE("GPL v2"); #define PLX_PCI_MAX_CHAN 2 struct plx_pci_card { int channels; /* detected channels count */ struct net_device *net_dev[PLX_PCI_MAX_CHAN]; void __iomem *conf_addr; /* Pointer to device-dependent reset function */ void (*reset_func)(struct pci_dev *pdev); }; #define PLX_PCI_CAN_CLOCK (16000000 / 2) /* PLX9030/9050/9052 registers */ #define PLX_INTCSR 0x4c /* Interrupt Control/Status */ #define PLX_CNTRL 0x50 /* User I/O, Direct Slave Response, * Serial EEPROM, and Initialization * Control register */ #define PLX_LINT1_EN 0x1 /* Local interrupt 1 enable */ #define PLX_LINT1_POL (1 << 1) /* Local interrupt 1 polarity */ #define PLX_LINT2_EN (1 << 3) /* Local interrupt 2 enable */ #define PLX_LINT2_POL (1 << 4) /* Local interrupt 2 polarity */ #define PLX_PCI_INT_EN (1 << 6) /* PCI Interrupt Enable */ #define PLX_PCI_RESET (1 << 30) /* PCI Adapter Software Reset */ /* PLX9056 registers */ #define PLX9056_INTCSR 0x68 /* Interrupt Control/Status */ #define PLX9056_CNTRL 0x6c /* Control / Software Reset */ #define PLX9056_LINTI (1 << 11) #define PLX9056_PCI_INT_EN (1 << 8) #define PLX9056_PCI_RCR (1 << 29) /* Read Configuration Registers */ /* * The board configuration is probably following: * RX1 is connected to ground. * TX1 is not connected. * CLKO is not connected. * Setting the OCR register to 0xDA is a good idea. * This means normal output mode, push-pull and the correct polarity. */ #define PLX_PCI_OCR (OCR_TX0_PUSHPULL | OCR_TX1_PUSHPULL) /* OCR setting for ASEM Dual CAN raw */ #define ASEM_PCI_OCR 0xfe /* * In the CDR register, you should set CBP to 1. * You will probably also want to set the clock divider value to 7 * (meaning direct oscillator output) because the second SJA1000 chip * is driven by the first one CLKOUT output. */ #define PLX_PCI_CDR (CDR_CBP | CDR_CLKOUT_MASK) /* SJA1000 Control Register in the BasicCAN Mode */ #define REG_CR 0x00 /* States of some SJA1000 registers after hardware reset in the BasicCAN mode*/ #define REG_CR_BASICCAN_INITIAL 0x21 #define REG_CR_BASICCAN_INITIAL_MASK 0xa1 #define REG_SR_BASICCAN_INITIAL 0x0c #define REG_IR_BASICCAN_INITIAL 0xe0 /* States of some SJA1000 registers after hardware reset in the PeliCAN mode*/ #define REG_MOD_PELICAN_INITIAL 0x01 #define REG_SR_PELICAN_INITIAL 0x3c #define REG_IR_PELICAN_INITIAL 0x00 #define ADLINK_PCI_VENDOR_ID 0x144A #define ADLINK_PCI_DEVICE_ID 0x7841 #define ESD_PCI_SUB_SYS_ID_PCI200 0x0004 #define ESD_PCI_SUB_SYS_ID_PCI266 0x0009 #define ESD_PCI_SUB_SYS_ID_PMC266 0x000e #define ESD_PCI_SUB_SYS_ID_CPCI200 0x010b #define ESD_PCI_SUB_SYS_ID_PCIE2000 0x0200 #define ESD_PCI_SUB_SYS_ID_PCI104200 0x0501 #define CAN200PCI_DEVICE_ID 0x9030 #define CAN200PCI_VENDOR_ID 0x10b5 #define CAN200PCI_SUB_DEVICE_ID 0x0301 #define CAN200PCI_SUB_VENDOR_ID 0xe1c5 #define IXXAT_PCI_VENDOR_ID 0x10b5 #define IXXAT_PCI_DEVICE_ID 0x9050 #define IXXAT_PCI_SUB_SYS_ID 0x2540 #define MARATHON_PCI_DEVICE_ID 0x2715 #define MARATHON_PCIE_DEVICE_ID 0x3432 #define TEWS_PCI_VENDOR_ID 0x1498 #define TEWS_PCI_DEVICE_ID_TMPC810 0x032A #define CTI_PCI_VENDOR_ID 0x12c4 #define CTI_PCI_DEVICE_ID_CRG001 0x0900 #define MOXA_PCI_VENDOR_ID 0x1393 #define MOXA_PCI_DEVICE_ID 0x0100 #define ASEM_RAW_CAN_VENDOR_ID 0x10b5 #define ASEM_RAW_CAN_DEVICE_ID 0x9030 #define ASEM_RAW_CAN_SUB_VENDOR_ID 0x3000 #define ASEM_RAW_CAN_SUB_DEVICE_ID 0x1001 #define ASEM_RAW_CAN_SUB_DEVICE_ID_BIS 0x1002 #define ASEM_RAW_CAN_RST_REGISTER 0x54 #define ASEM_RAW_CAN_RST_MASK_CAN1 0x20 #define ASEM_RAW_CAN_RST_MASK_CAN2 0x04 static void plx_pci_reset_common(struct pci_dev *pdev); static void plx9056_pci_reset_common(struct pci_dev *pdev); static void plx_pci_reset_marathon_pci(struct pci_dev *pdev); static void plx_pci_reset_marathon_pcie(struct pci_dev *pdev); static void plx_pci_reset_asem_dual_can_raw(struct pci_dev *pdev); struct plx_pci_channel_map { u32 bar; u32 offset; u32 size; /* 0x00 - auto, e.g. length of entire bar */ }; struct plx_pci_card_info { const char *name; int channel_count; u32 can_clock; u8 ocr; /* output control register */ u8 cdr; /* clock divider register */ /* Parameters for mapping local configuration space */ struct plx_pci_channel_map conf_map; /* Parameters for mapping the SJA1000 chips */ struct plx_pci_channel_map chan_map_tbl[PLX_PCI_MAX_CHAN]; /* Pointer to device-dependent reset function */ void (*reset_func)(struct pci_dev *pdev); }; static struct plx_pci_card_info plx_pci_card_info_adlink = { "Adlink PCI-7841/cPCI-7841", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {1, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x80, 0x80} }, &plx_pci_reset_common /* based on PLX9052 */ }; static struct plx_pci_card_info plx_pci_card_info_adlink_se = { "Adlink PCI-7841/cPCI-7841 SE", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x80, 0x80} }, &plx_pci_reset_common /* based on PLX9052 */ }; static struct plx_pci_card_info plx_pci_card_info_esd200 = { "esd CAN-PCI/CPCI/PCI104/200", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} }, &plx_pci_reset_common /* based on PLX9030/9050 */ }; static struct plx_pci_card_info plx_pci_card_info_esd266 = { "esd CAN-PCI/PMC/266", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} }, &plx9056_pci_reset_common /* based on PLX9056 */ }; static struct plx_pci_card_info plx_pci_card_info_esd2000 = { "esd CAN-PCIe/2000", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x100, 0x80} }, &plx9056_pci_reset_common /* based on PEX8311 */ }; static struct plx_pci_card_info plx_pci_card_info_ixxat = { "IXXAT PC-I 04/PCI", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x80}, {2, 0x200, 0x80} }, &plx_pci_reset_common /* based on PLX9050 */ }; static struct plx_pci_card_info plx_pci_card_info_marathon_pci = { "Marathon CAN-bus-PCI", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x00}, {4, 0x00, 0x00} }, &plx_pci_reset_marathon_pci /* based on PLX9052 */ }; static struct plx_pci_card_info plx_pci_card_info_marathon_pcie = { "Marathon CAN-bus-PCIe", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x00}, {3, 0x80, 0x00} }, &plx_pci_reset_marathon_pcie /* based on PEX8311 */ }; static struct plx_pci_card_info plx_pci_card_info_tews = { "TEWS TECHNOLOGIES TPMC810", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x000, 0x80}, {2, 0x100, 0x80} }, &plx_pci_reset_common /* based on PLX9030 */ }; static struct plx_pci_card_info plx_pci_card_info_cti = { "Connect Tech Inc. CANpro/104-Plus Opto (CRG001)", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x000, 0x80}, {2, 0x100, 0x80} }, &plx_pci_reset_common /* based on PLX9030 */ }; static struct plx_pci_card_info plx_pci_card_info_elcus = { "Eclus CAN-200-PCI", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {1, 0x00, 0x00}, { {2, 0x00, 0x80}, {3, 0x00, 0x80} }, &plx_pci_reset_common /* based on PLX9030 */ }; static struct plx_pci_card_info plx_pci_card_info_moxa = { "MOXA", 2, PLX_PCI_CAN_CLOCK, PLX_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {0, 0x00, 0x80}, {1, 0x00, 0x80} }, &plx_pci_reset_common /* based on PLX9052 */ }; static struct plx_pci_card_info plx_pci_card_info_asem_dual_can = { "ASEM Dual CAN raw PCI", 2, PLX_PCI_CAN_CLOCK, ASEM_PCI_OCR, PLX_PCI_CDR, {0, 0x00, 0x00}, { {2, 0x00, 0x00}, {4, 0x00, 0x00} }, &plx_pci_reset_asem_dual_can_raw /* based on PLX9030 */ }; static const struct pci_device_id plx_pci_tbl[] = { { /* Adlink PCI-7841/cPCI-7841 */ ADLINK_PCI_VENDOR_ID, ADLINK_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_NETWORK_OTHER << 8, ~0, (kernel_ulong_t)&plx_pci_card_info_adlink }, { /* Adlink PCI-7841/cPCI-7841 SE */ ADLINK_PCI_VENDOR_ID, ADLINK_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_CLASS_COMMUNICATION_OTHER << 8, ~0, (kernel_ulong_t)&plx_pci_card_info_adlink_se }, { /* esd CAN-PCI/200 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9050, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI200, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd200 }, { /* esd CAN-CPCI/200 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_CPCI200, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd200 }, { /* esd CAN-PCI104/200 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI104200, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd200 }, { /* esd CAN-PCI/266 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCI266, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd266 }, { /* esd CAN-PMC/266 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PMC266, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd266 }, { /* esd CAN-PCIE/2000 */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9056, PCI_VENDOR_ID_ESDGMBH, ESD_PCI_SUB_SYS_ID_PCIE2000, 0, 0, (kernel_ulong_t)&plx_pci_card_info_esd2000 }, { /* IXXAT PC-I 04/PCI card */ IXXAT_PCI_VENDOR_ID, IXXAT_PCI_DEVICE_ID, PCI_ANY_ID, IXXAT_PCI_SUB_SYS_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_ixxat }, { /* Marathon CAN-bus-PCI card */ PCI_VENDOR_ID_PLX, MARATHON_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_marathon_pci }, { /* Marathon CAN-bus-PCIe card */ PCI_VENDOR_ID_PLX, MARATHON_PCIE_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_marathon_pcie }, { /* TEWS TECHNOLOGIES TPMC810 card */ TEWS_PCI_VENDOR_ID, TEWS_PCI_DEVICE_ID_TMPC810, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_tews }, { /* Connect Tech Inc. CANpro/104-Plus Opto (CRG001) card */ PCI_VENDOR_ID_PLX, PCI_DEVICE_ID_PLX_9030, CTI_PCI_VENDOR_ID, CTI_PCI_DEVICE_ID_CRG001, 0, 0, (kernel_ulong_t)&plx_pci_card_info_cti }, { /* Elcus CAN-200-PCI */ CAN200PCI_VENDOR_ID, CAN200PCI_DEVICE_ID, CAN200PCI_SUB_VENDOR_ID, CAN200PCI_SUB_DEVICE_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_elcus }, { /* moxa */ MOXA_PCI_VENDOR_ID, MOXA_PCI_DEVICE_ID, PCI_ANY_ID, PCI_ANY_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_moxa }, { /* ASEM Dual CAN raw */ ASEM_RAW_CAN_VENDOR_ID, ASEM_RAW_CAN_DEVICE_ID, ASEM_RAW_CAN_SUB_VENDOR_ID, ASEM_RAW_CAN_SUB_DEVICE_ID, 0, 0, (kernel_ulong_t)&plx_pci_card_info_asem_dual_can }, { /* ASEM Dual CAN raw -new model */ ASEM_RAW_CAN_VENDOR_ID, ASEM_RAW_CAN_DEVICE_ID, ASEM_RAW_CAN_SUB_VENDOR_ID, ASEM_RAW_CAN_SUB_DEVICE_ID_BIS, 0, 0, (kernel_ulong_t)&plx_pci_card_info_asem_dual_can }, { 0,} }; MODULE_DEVICE_TABLE(pci, plx_pci_tbl); static u8 plx_pci_read_reg(const struct sja1000_priv *priv, int port) { return ioread8(priv->reg_base + port); } static void plx_pci_write_reg(const struct sja1000_priv *priv, int port, u8 val) { iowrite8(val, priv->reg_base + port); } /* * Check if a CAN controller is present at the specified location * by trying to switch 'em from the Basic mode into the PeliCAN mode. * Also check states of some registers in reset mode. */ static inline int plx_pci_check_sja1000(const struct sja1000_priv *priv) { int flag = 0; /* * Check registers after hardware reset (the Basic mode) * See states on p. 10 of the Datasheet. */ if ((priv->read_reg(priv, REG_CR) & REG_CR_BASICCAN_INITIAL_MASK) == REG_CR_BASICCAN_INITIAL && (priv->read_reg(priv, SJA1000_SR) == REG_SR_BASICCAN_INITIAL) && (priv->read_reg(priv, SJA1000_IR) == REG_IR_BASICCAN_INITIAL)) flag = 1; /* Bring the SJA1000 into the PeliCAN mode*/ priv->write_reg(priv, SJA1000_CDR, CDR_PELICAN); /* * Check registers after reset in the PeliCAN mode. * See states on p. 23 of the Datasheet. */ if (priv->read_reg(priv, SJA1000_MOD) == REG_MOD_PELICAN_INITIAL && priv->read_reg(priv, SJA1000_SR) == REG_SR_PELICAN_INITIAL && priv->read_reg(priv, SJA1000_IR) == REG_IR_PELICAN_INITIAL) return flag; return 0; } /* * PLX9030/50/52 software reset * Also LRESET# asserts and brings to reset device on the Local Bus (if wired). * For most cards it's enough for reset the SJA1000 chips. */ static void plx_pci_reset_common(struct pci_dev *pdev) { struct plx_pci_card *card = pci_get_drvdata(pdev); u32 cntrl; cntrl = ioread32(card->conf_addr + PLX_CNTRL); cntrl |= PLX_PCI_RESET; iowrite32(cntrl, card->conf_addr + PLX_CNTRL); udelay(100); cntrl ^= PLX_PCI_RESET; iowrite32(cntrl, card->conf_addr + PLX_CNTRL); }; /* * PLX9056 software reset * Assert LRESET# and reset device(s) on the Local Bus (if wired). */ static void plx9056_pci_reset_common(struct pci_dev *pdev) { struct plx_pci_card *card = pci_get_drvdata(pdev); u32 cntrl; /* issue a local bus reset */ cntrl = ioread32(card->conf_addr + PLX9056_CNTRL); cntrl |= PLX_PCI_RESET; iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL); udelay(100); cntrl ^= PLX_PCI_RESET; iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL); /* reload local configuration from EEPROM */ cntrl |= PLX9056_PCI_RCR; iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL); /* * There is no safe way to poll for the end * of reconfiguration process. Waiting for 10ms * is safe. */ mdelay(10); cntrl ^= PLX9056_PCI_RCR; iowrite32(cntrl, card->conf_addr + PLX9056_CNTRL); }; /* Special reset function for Marathon CAN-bus-PCI card */ static void plx_pci_reset_marathon_pci(struct pci_dev *pdev) { void __iomem *reset_addr; int i; static const int reset_bar[2] = {3, 5}; plx_pci_reset_common(pdev); for (i = 0; i < 2; i++) { reset_addr = pci_iomap(pdev, reset_bar[i], 0); if (!reset_addr) { dev_err(&pdev->dev, "Failed to remap reset " "space %d (BAR%d)\n", i, reset_bar[i]); } else { /* reset the SJA1000 chip */ iowrite8(0x1, reset_addr); udelay(100); pci_iounmap(pdev, reset_addr); } } } /* Special reset function for Marathon CAN-bus-PCIe card */ static void plx_pci_reset_marathon_pcie(struct pci_dev *pdev) { void __iomem *addr; void __iomem *reset_addr; int i; plx9056_pci_reset_common(pdev); for (i = 0; i < 2; i++) { struct plx_pci_channel_map *chan_map = &plx_pci_card_info_marathon_pcie.chan_map_tbl[i]; addr = pci_iomap(pdev, chan_map->bar, chan_map->size); if (!addr) { dev_err(&pdev->dev, "Failed to remap reset " "space %d (BAR%d)\n", i, chan_map->bar); } else { /* reset the SJA1000 chip */ #define MARATHON_PCIE_RESET_OFFSET 32 reset_addr = addr + chan_map->offset + MARATHON_PCIE_RESET_OFFSET; iowrite8(0x1, reset_addr); udelay(100); pci_iounmap(pdev, addr); } } } /* Special reset function for ASEM Dual CAN raw card */ static void plx_pci_reset_asem_dual_can_raw(struct pci_dev *pdev) { void __iomem *bar0_addr; u8 tmpval; plx_pci_reset_common(pdev); bar0_addr = pci_iomap(pdev, 0, 0); if (!bar0_addr) { dev_err(&pdev->dev, "Failed to remap reset space 0 (BAR0)\n"); return; } /* reset the two SJA1000 chips */ tmpval = ioread8(bar0_addr + ASEM_RAW_CAN_RST_REGISTER); tmpval &= ~(ASEM_RAW_CAN_RST_MASK_CAN1 | ASEM_RAW_CAN_RST_MASK_CAN2); iowrite8(tmpval, bar0_addr + ASEM_RAW_CAN_RST_REGISTER); usleep_range(300, 400); tmpval |= ASEM_RAW_CAN_RST_MASK_CAN1 | ASEM_RAW_CAN_RST_MASK_CAN2; iowrite8(tmpval, bar0_addr + ASEM_RAW_CAN_RST_REGISTER); usleep_range(300, 400); pci_iounmap(pdev, bar0_addr); } static void plx_pci_del_card(struct pci_dev *pdev) { struct plx_pci_card *card = pci_get_drvdata(pdev); struct net_device *dev; struct sja1000_priv *priv; int i = 0; for (i = 0; i < PLX_PCI_MAX_CHAN; i++) { dev = card->net_dev[i]; if (!dev) continue; dev_info(&pdev->dev, "Removing %s\n", dev->name); unregister_sja1000dev(dev); priv = netdev_priv(dev); if (priv->reg_base) pci_iounmap(pdev, priv->reg_base); free_sja1000dev(dev); } card->reset_func(pdev); /* * Disable interrupts from PCI-card and disable local * interrupts */ if (pdev->device != PCI_DEVICE_ID_PLX_9056 && pdev->device != MARATHON_PCIE_DEVICE_ID) iowrite32(0x0, card->conf_addr + PLX_INTCSR); else iowrite32(0x0, card->conf_addr + PLX9056_INTCSR); if (card->conf_addr) pci_iounmap(pdev, card->conf_addr); kfree(card); pci_disable_device(pdev); } /* * Probe PLX90xx based device for the SJA1000 chips and register each * available CAN channel to SJA1000 Socket-CAN subsystem. */ static int plx_pci_add_card(struct pci_dev *pdev, const struct pci_device_id *ent) { struct sja1000_priv *priv; struct net_device *dev; struct plx_pci_card *card; struct plx_pci_card_info *ci; int err, i; u32 val; void __iomem *addr; ci = (struct plx_pci_card_info *)ent->driver_data; if (pci_enable_device(pdev) < 0) { dev_err(&pdev->dev, "Failed to enable PCI device\n"); return -ENODEV; } dev_info(&pdev->dev, "Detected \"%s\" card at slot #%i\n", ci->name, PCI_SLOT(pdev->devfn)); /* Allocate card structures to hold addresses, ... */ card = kzalloc(sizeof(*card), GFP_KERNEL); if (!card) { pci_disable_device(pdev); return -ENOMEM; } pci_set_drvdata(pdev, card); card->channels = 0; /* Remap PLX90xx configuration space */ addr = pci_iomap(pdev, ci->conf_map.bar, ci->conf_map.size); if (!addr) { err = -ENOMEM; dev_err(&pdev->dev, "Failed to remap configuration space " "(BAR%d)\n", ci->conf_map.bar); goto failure_cleanup; } card->conf_addr = addr + ci->conf_map.offset; ci->reset_func(pdev); card->reset_func = ci->reset_func; /* Detect available channels */ for (i = 0; i < ci->channel_count; i++) { struct plx_pci_channel_map *cm = &ci->chan_map_tbl[i]; dev = alloc_sja1000dev(0); if (!dev) { err = -ENOMEM; goto failure_cleanup; } card->net_dev[i] = dev; priv = netdev_priv(dev); priv->priv = card; priv->irq_flags = IRQF_SHARED; dev->irq = pdev->irq; /* * Remap IO space of the SJA1000 chips * This is device-dependent mapping */ addr = pci_iomap(pdev, cm->bar, cm->size); if (!addr) { err = -ENOMEM; dev_err(&pdev->dev, "Failed to remap BAR%d\n", cm->bar); goto failure_cleanup; } priv->reg_base = addr + cm->offset; priv->read_reg = plx_pci_read_reg; priv->write_reg = plx_pci_write_reg; /* Check if channel is present */ if (plx_pci_check_sja1000(priv)) { priv->can.clock.freq = ci->can_clock; priv->ocr = ci->ocr; priv->cdr = ci->cdr; SET_NETDEV_DEV(dev, &pdev->dev); dev->dev_id = i; /* Register SJA1000 device */ err = register_sja1000dev(dev); if (err) { dev_err(&pdev->dev, "Registering device failed " "(err=%d)\n", err); goto failure_cleanup; } card->channels++; dev_info(&pdev->dev, "Channel #%d at 0x%p, irq %d " "registered as %s\n", i + 1, priv->reg_base, dev->irq, dev->name); } else { dev_err(&pdev->dev, "Channel #%d not detected\n", i + 1); free_sja1000dev(dev); card->net_dev[i] = NULL; } } if (!card->channels) { err = -ENODEV; goto failure_cleanup; } /* * Enable interrupts from PCI-card (PLX90xx) and enable Local_1, * Local_2 interrupts from the SJA1000 chips */ if (pdev->device != PCI_DEVICE_ID_PLX_9056 && pdev->device != MARATHON_PCIE_DEVICE_ID) { val = ioread32(card->conf_addr + PLX_INTCSR); if (pdev->subsystem_vendor == PCI_VENDOR_ID_ESDGMBH) val |= PLX_LINT1_EN | PLX_PCI_INT_EN; else val |= PLX_LINT1_EN | PLX_LINT2_EN | PLX_PCI_INT_EN; iowrite32(val, card->conf_addr + PLX_INTCSR); } else { iowrite32(PLX9056_LINTI | PLX9056_PCI_INT_EN, card->conf_addr + PLX9056_INTCSR); } return 0; failure_cleanup: dev_err(&pdev->dev, "Error: %d. Cleaning Up.\n", err); plx_pci_del_card(pdev); return err; } static struct pci_driver plx_pci_driver = { .name = DRV_NAME, .id_table = plx_pci_tbl, .probe = plx_pci_add_card, .remove = plx_pci_del_card, }; module_pci_driver(plx_pci_driver);