Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags   |
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (C) 2008-2010 Pavel Cheblakov <P.B.Cheblakov@inp.nsk.su>
*
* Derived from the ems_pci.c driver:
* Copyright (C) 2007 Wolfgang Grandegger <wg@grandegger.com>
* Copyright (C) 2008 Markus Plessing <plessing@ems-wuensche.com>
* Copyright (C) 2008 Sebastian Haas <haas@ems-wuensche.com>
*/
#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/netdevice.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/pci.h>
#include <linux/can/dev.h>
#include <linux/io.h>
#include "sja1000.h"
#define DRV_NAME "sja1000_plx_pci"
MODULE_AUTHOR("Pavel Cheblakov <P.B.Cheblakov@inp.nsk.su>");
MODULE_DESCRIPTION("Socket-CAN driver for PLX90xx PCI-bridge cards with "
<------><------> "the SJA1000 chips");
MODULE_SUPPORTED_DEVICE("Adlink PCI-7841/cPCI-7841, "
<------><------><------>"Adlink PCI-7841/cPCI-7841 SE, "
<------><------><------>"Marathon CAN-bus-PCI, "
<------><------><------>"Marathon CAN-bus-PCIe, "
<------><------><------>"TEWS TECHNOLOGIES TPMC810, "
<------><------><------>"esd CAN-PCI/CPCI/PCI104/200, "
<------><------><------>"esd CAN-PCI/PMC/266, "
<------><------><------>"esd CAN-PCIe/2000, "
<------><------><------>"Connect Tech Inc. CANpro/104-Plus Opto (CRG001), "
<------><------><------>"IXXAT PC-I 04/PCI, "
<------><------><------>"ELCUS CAN-200-PCI, "
<------><------><------>"ASEM DUAL CAN-RAW")
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);