mirror of
				https://git.kernel.org/pub/scm/linux/kernel/git/chenhuacai/linux-loongson
				synced 2025-10-31 06:18:54 +00:00 
			
		
		
		
	 829e001543
			
		
	
	
		829e001543
		
	
	
	
	
		
			
			In the current implementation, CAN drivers need to #include <linux/can.h> _before_ they #include <linux/can/dev.h>, which is both ugly and unnecessary. Fix this by including <linux/can.h> in <linux/can/dev.h> and remove the #include <linux/can.h> lines from drivers. Signed-off-by: Hans J. Koch <hjk@linutronix.de> Signed-off-by: David S. Miller <davem@davemloft.net>
		
			
				
	
	
		
			604 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			604 lines
		
	
	
		
			16 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * 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>
 | |
|  *
 | |
|  * This program is free software; you can redistribute it and/or modify
 | |
|  * it under the terms of the version 2 of the GNU General Public License
 | |
|  * as published by the Free Software Foundation
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program; if not, write to the Free Software Foundation,
 | |
|  * Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 | |
|  */
 | |
| 
 | |
| #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, "
 | |
| 			"TEWS TECHNOLOGIES TPMC810, "
 | |
| 			"esd CAN-PCI/CPCI/PCI104/200, "
 | |
| 			"esd CAN-PCI/PMC/266, "
 | |
| 			"esd CAN-PCIe/2000")
 | |
| 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_LINT2_EN	(1 << 3)	/* Local interrupt 2 enable */
 | |
| #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)
 | |
| 
 | |
| /*
 | |
|  * 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 MARATHON_PCI_DEVICE_ID		0x2715
 | |
| 
 | |
| #define TEWS_PCI_VENDOR_ID		0x1498
 | |
| #define TEWS_PCI_DEVICE_ID_TMPC810	0x032A
 | |
| 
 | |
| static void plx_pci_reset_common(struct pci_dev *pdev);
 | |
| static void plx_pci_reset_marathon(struct pci_dev *pdev);
 | |
| static void plx9056_pci_reset_common(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 __devinitdata = {
 | |
| 	"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 __devinitdata = {
 | |
| 	"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 __devinitdata = {
 | |
| 	"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 __devinitdata = {
 | |
| 	"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 __devinitdata = {
 | |
| 	"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_marathon __devinitdata = {
 | |
| 	"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
 | |
| 	/* based on PLX9052 */
 | |
| };
 | |
| 
 | |
| static struct plx_pci_card_info plx_pci_card_info_tews __devinitdata = {
 | |
| 	"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 DEFINE_PCI_DEVICE_TABLE(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
 | |
| 	},
 | |
| 	{
 | |
| 		/* 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
 | |
| 	},
 | |
| 	{
 | |
| 		/* 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
 | |
| 	},
 | |
| 	{ 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, REG_SR) == REG_SR_BASICCAN_INITIAL) &&
 | |
| 	    (priv->read_reg(priv, REG_IR) == REG_IR_BASICCAN_INITIAL))
 | |
| 		flag = 1;
 | |
| 
 | |
| 	/* Bring the SJA1000 into the PeliCAN mode*/
 | |
| 	priv->write_reg(priv, REG_CDR, CDR_PELICAN);
 | |
| 
 | |
| 	/*
 | |
| 	 * Check registers after reset in the PeliCAN mode.
 | |
| 	 * See states on p. 23 of the Datasheet.
 | |
| 	 */
 | |
| 	if (priv->read_reg(priv, REG_MOD) == REG_MOD_PELICAN_INITIAL &&
 | |
| 	    priv->read_reg(priv, REG_SR) == REG_SR_PELICAN_INITIAL &&
 | |
| 	    priv->read_reg(priv, REG_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 card */
 | |
| static void plx_pci_reset_marathon(struct pci_dev *pdev)
 | |
| {
 | |
| 	void __iomem *reset_addr;
 | |
| 	int i;
 | |
| 	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);
 | |
| 		}
 | |
| 	}
 | |
| }
 | |
| 
 | |
| 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 < card->channels; 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)
 | |
| 		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);
 | |
| 	pci_set_drvdata(pdev, NULL);
 | |
| }
 | |
| 
 | |
| /*
 | |
|  * Probe PLX90xx based device for the SJA1000 chips and register each
 | |
|  * available CAN channel to SJA1000 Socket-CAN subsystem.
 | |
|  */
 | |
| static int __devinit 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) {
 | |
| 		dev_err(&pdev->dev, "Unable to allocate memory\n");
 | |
| 		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);
 | |
| 
 | |
| 			/* Register SJA1000 device */
 | |
| 			err = register_sja1000dev(dev);
 | |
| 			if (err) {
 | |
| 				dev_err(&pdev->dev, "Registering device failed "
 | |
| 					"(err=%d)\n", err);
 | |
| 				free_sja1000dev(dev);
 | |
| 				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);
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	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) {
 | |
| 		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,
 | |
| };
 | |
| 
 | |
| static int __init plx_pci_init(void)
 | |
| {
 | |
| 	return pci_register_driver(&plx_pci_driver);
 | |
| }
 | |
| 
 | |
| static void __exit plx_pci_exit(void)
 | |
| {
 | |
| 	pci_unregister_driver(&plx_pci_driver);
 | |
| }
 | |
| 
 | |
| module_init(plx_pci_init);
 | |
| module_exit(plx_pci_exit);
 |