drivers/net/can/sja1000/plx_pci.c

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