199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_can.c - CAN network driver for AT91 SoC CAN controller
399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
43e9ebd3cf48d9181e0931c6fd8f1a7dc4d6cb27cHans J. Koch * (C) 2007 by Hans J. Koch <hjk@hansjkoch.de>
50909c1ec6f016b3f580fa2f4630659a5874a8ef8Marc Kleine-Budde * (C) 2008, 2009, 2010, 2011 by Marc Kleine-Budde <kernel@pengutronix.de>
699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * This software may be distributed under the terms of the GNU General
899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Public License ("GPL") version 2 as distributed in the 'COPYING'
999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * file from the main directory of the linux kernel source.
1099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
1199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
1299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Your platform definition file should specify something like:
1399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
1499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * static struct at91_can_data ek_can_data = {
1599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *	transceiver_switch = sam9263ek_transceiver_switch,
1699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * };
1799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
1899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_add_device_can(&ek_can_data);
1999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
2099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
2199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
2299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/clk.h>
2399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/errno.h>
2499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/if_arp.h>
2599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/init.h>
2699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/interrupt.h>
2799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/kernel.h>
2899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/module.h>
2999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/netdevice.h>
3099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/platform_device.h>
313a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde#include <linux/rtnetlink.h>
3299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/skbuff.h>
3399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/spinlock.h>
3499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/string.h>
3599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/types.h>
3699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
3799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/can/dev.h>
3899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <linux/can/error.h>
3999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
4099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#include <mach/board.h>
4199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
42b049994d0f3a19c1706627117a7269ce5bd335abMarc Kleine-Budde#define AT91_MB_MASK(i)		((1 << (i)) - 1)
4399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
4499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/* Common registers */
4599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerenum at91_reg {
4699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MR		= 0x000,
4799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_IER	= 0x004,
4899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_IDR	= 0x008,
4999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_IMR	= 0x00C,
5099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_SR		= 0x010,
5199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_BR		= 0x014,
5299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_TIM	= 0x018,
5399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_TIMESTP	= 0x01C,
5499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_ECR	= 0x020,
5599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_TCR	= 0x024,
5699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_ACR	= 0x028,
5799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
5899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
5999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/* Mailbox registers (0 <= i <= 15) */
6099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MMR(i)		(enum at91_reg)(0x200 + ((i) * 0x20))
6199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MAM(i)		(enum at91_reg)(0x204 + ((i) * 0x20))
6299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MID(i)		(enum at91_reg)(0x208 + ((i) * 0x20))
6399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MFID(i)		(enum at91_reg)(0x20C + ((i) * 0x20))
6499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MSR(i)		(enum at91_reg)(0x210 + ((i) * 0x20))
6599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MDL(i)		(enum at91_reg)(0x214 + ((i) * 0x20))
6699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MDH(i)		(enum at91_reg)(0x218 + ((i) * 0x20))
6799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MCR(i)		(enum at91_reg)(0x21C + ((i) * 0x20))
6899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
6999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/* Register bits */
7099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_CANEN		BIT(0)
7199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_LPM		BIT(1)
7299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_ABM		BIT(2)
7399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_OVL		BIT(3)
7499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_TEOF		BIT(4)
7599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_TTM		BIT(5)
7699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_TIMFRZ		BIT(6)
7799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MR_DRPT		BIT(7)
7899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
7999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_SR_RBSY		BIT(29)
8099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
8199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MMR_PRIO_SHIFT	(16)
8299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
8399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MID_MIDE		BIT(29)
8499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
8599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MSR_MRTR		BIT(20)
8699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MSR_MABT		BIT(22)
8799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MSR_MRDY		BIT(23)
8899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MSR_MMI		BIT(24)
8999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
9099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MCR_MRTR		BIT(20)
9199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_MCR_MTCR		BIT(23)
9299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
9399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/* Mailbox Modes */
9499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerenum at91_mb_mode {
9599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_DISABLED	= 0,
9699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_RX		= 1,
9799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_RX_OVRWR	= 2,
9899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_TX		= 3,
9999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_CONSUMER	= 4,
10099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	AT91_MB_MODE_PRODUCER	= 5,
10199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
10299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
10399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/* Interrupt mask bits */
10499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ERRA		(1 << 16)
10599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_WARN		(1 << 17)
10699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ERRP		(1 << 18)
10799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_BOFF		(1 << 19)
10899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_SLEEP		(1 << 20)
10999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_WAKEUP		(1 << 21)
11099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_TOVF		(1 << 22)
11199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_TSTP		(1 << 23)
11299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_CERR		(1 << 24)
11399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_SERR		(1 << 25)
11499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_AERR		(1 << 26)
11599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_FERR		(1 << 27)
11699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_BERR		(1 << 28)
11799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
11899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ERR_ALL	(0x1fff0000)
11999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ERR_FRAME	(AT91_IRQ_CERR | AT91_IRQ_SERR | \
12099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				 AT91_IRQ_AERR | AT91_IRQ_FERR | AT91_IRQ_BERR)
12199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ERR_LINE	(AT91_IRQ_ERRA | AT91_IRQ_WARN | \
12299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				 AT91_IRQ_ERRP | AT91_IRQ_BOFF)
12399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
12499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller#define AT91_IRQ_ALL		(0x1fffffff)
12599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
126d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddeenum at91_devtype {
127d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	AT91_DEVTYPE_SAM9263,
1286388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	AT91_DEVTYPE_SAM9X5,
129d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde};
130d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
131d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestruct at91_devtype_data {
132d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	unsigned int rx_first;
133d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	unsigned int rx_split;
134d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	unsigned int rx_last;
135d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	unsigned int tx_shift;
136d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	enum at91_devtype type;
137d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde};
138d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
13999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstruct at91_priv {
14044d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	struct can_priv can;		/* must be the first member! */
14144d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	struct net_device *dev;
14244d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	struct napi_struct napi;
14399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
14444d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	void __iomem *reg_base;
14599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
14644d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	u32 reg_sr;
14744d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	unsigned int tx_next;
14844d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	unsigned int tx_echo;
14944d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	unsigned int rx_next;
150d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	struct at91_devtype_data devtype_data;
15199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
15244d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	struct clk *clk;
15344d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	struct at91_can_data *pdata;
1543a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
15544d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	canid_t mb0_id;
15699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
15799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
158d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic const struct at91_devtype_data at91_devtype_data[] __devinitconst = {
159d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	[AT91_DEVTYPE_SAM9263] = {
160d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.rx_first = 1,
161d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.rx_split = 8,
162d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.rx_last = 11,
163d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.tx_shift = 2,
164d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	},
1656388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	[AT91_DEVTYPE_SAM9X5] = {
1666388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.rx_first = 0,
1676388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.rx_split = 4,
1686388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.rx_last = 5,
1696388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.tx_shift = 1,
1706388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	},
171d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde};
172d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
17399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic struct can_bittiming_const at91_bittiming_const = {
17400389b0820c44cceec3f6981cb4d217982ec73b2Marc Kleine-Budde	.name		= KBUILD_MODNAME,
17599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.tseg1_min	= 4,
17699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.tseg1_max	= 16,
17799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.tseg2_min	= 2,
17899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.tseg2_max	= 8,
17999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.sjw_max	= 4,
18099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.brp_min 	= 2,
18199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.brp_max	= 128,
18299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.brp_inc	= 1,
18399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
18499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
185d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde#define AT91_IS(_model) \
186d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline int at91_is_sam##_model(const struct at91_priv *priv) \
187d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{ \
188d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return priv->devtype_data.type == AT91_DEVTYPE_SAM##_model; \
189d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
190d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
191d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-BuddeAT91_IS(9263);
1926388b39614208d63661607f45157e3326548eb62Marc Kleine-BuddeAT91_IS(9X5);
193d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
194d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline unsigned int get_mb_rx_first(const struct at91_priv *priv)
195d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{
196d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return priv->devtype_data.rx_first;
197d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
198d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
199d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline unsigned int get_mb_rx_last(const struct at91_priv *priv)
200d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{
201d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return priv->devtype_data.rx_last;
202d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
203d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
204d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline unsigned int get_mb_rx_split(const struct at91_priv *priv)
205d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{
206d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return priv->devtype_data.rx_split;
207d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
208d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
209d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline unsigned int get_mb_rx_num(const struct at91_priv *priv)
210d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{
211d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return get_mb_rx_last(priv) - get_mb_rx_first(priv) + 1;
212d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
213d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
21479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_mb_rx_low_last(const struct at91_priv *priv)
21579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
216d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return get_mb_rx_split(priv) - 1;
21779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
21879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
21979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_mb_rx_low_mask(const struct at91_priv *priv)
22079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
221d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return AT91_MB_MASK(get_mb_rx_split(priv)) &
222d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		~AT91_MB_MASK(get_mb_rx_first(priv));
223d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde}
224d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
225d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic inline unsigned int get_mb_tx_shift(const struct at91_priv *priv)
226d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde{
227d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return priv->devtype_data.tx_shift;
22879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
22979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
23079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_mb_tx_num(const struct at91_priv *priv)
23179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
232d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return 1 << get_mb_tx_shift(priv);
23379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
23479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
23579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_mb_tx_first(const struct at91_priv *priv)
23679008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
237d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return get_mb_rx_last(priv) + 1;
23879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
23979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
24079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_mb_tx_last(const struct at91_priv *priv)
24179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
24279008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return get_mb_tx_first(priv) + get_mb_tx_num(priv) - 1;
24379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
24479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
24579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_next_prio_shift(const struct at91_priv *priv)
24679008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
247d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return get_mb_tx_shift(priv);
24879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
24979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
25079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_next_prio_mask(const struct at91_priv *priv)
25179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
252d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return 0xf << get_mb_tx_shift(priv);
25379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
25479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
25579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_next_mb_mask(const struct at91_priv *priv)
25679008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
257d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return AT91_MB_MASK(get_mb_tx_shift(priv));
25879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
25979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
26079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_next_mask(const struct at91_priv *priv)
26179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
26279008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return get_next_mb_mask(priv) | get_next_prio_mask(priv);
26379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
26479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
26579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_irq_mb_rx(const struct at91_priv *priv)
26679008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
267d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	return AT91_MB_MASK(get_mb_rx_last(priv) + 1) &
268d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		~AT91_MB_MASK(get_mb_rx_first(priv));
26979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
27079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
27179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Buddestatic inline unsigned int get_irq_mb_tx(const struct at91_priv *priv)
27279008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde{
27379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return AT91_MB_MASK(get_mb_tx_last(priv) + 1) &
27479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde		~AT91_MB_MASK(get_mb_tx_first(priv));
27579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde}
27679008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde
2779c2e0a6d2f7b7c76e0cbc42a8da99fd732f0fdfaMarc Kleine-Buddestatic inline unsigned int get_tx_next_mb(const struct at91_priv *priv)
27899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
27979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return (priv->tx_next & get_next_mb_mask(priv)) + get_mb_tx_first(priv);
28099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
28199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
2829c2e0a6d2f7b7c76e0cbc42a8da99fd732f0fdfaMarc Kleine-Buddestatic inline unsigned int get_tx_next_prio(const struct at91_priv *priv)
28399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
28479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return (priv->tx_next >> get_next_prio_shift(priv)) & 0xf;
28599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
28699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
2879c2e0a6d2f7b7c76e0cbc42a8da99fd732f0fdfaMarc Kleine-Buddestatic inline unsigned int get_tx_echo_mb(const struct at91_priv *priv)
28899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
28979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	return (priv->tx_echo & get_next_mb_mask(priv)) + get_mb_tx_first(priv);
29099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
29199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
29299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline u32 at91_read(const struct at91_priv *priv, enum at91_reg reg)
29399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
2947672fe7373c7b871220093e568610ac95e96de35Marc Kleine-Budde	return __raw_readl(priv->reg_base + reg);
29599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
29699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
29799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline void at91_write(const struct at91_priv *priv, enum at91_reg reg,
29899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		u32 value)
29999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
3007672fe7373c7b871220093e568610ac95e96de35Marc Kleine-Budde	__raw_writel(value, priv->reg_base + reg);
30199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
30299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
30399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline void set_mb_mode_prio(const struct at91_priv *priv,
30499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		unsigned int mb, enum at91_mb_mode mode, int prio)
30599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
30699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MMR(mb), (mode << 24) | (prio << 16));
30799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
30899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
30999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline void set_mb_mode(const struct at91_priv *priv, unsigned int mb,
31099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		enum at91_mb_mode mode)
31199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
31299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	set_mb_mode_prio(priv, mb, mode, 0);
31399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
31499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
3153a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Buddestatic inline u32 at91_can_id_to_reg_mid(canid_t can_id)
3163a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde{
3173a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	u32 reg_mid;
3183a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
3193a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	if (can_id & CAN_EFF_FLAG)
3203a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		reg_mid = (can_id & CAN_EFF_MASK) | AT91_MID_MIDE;
3213a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	else
3223a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		reg_mid = (can_id & CAN_SFF_MASK) << 18;
3233a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
3243a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	return reg_mid;
3253a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde}
3263a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
32799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
32899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Swtich transceiver on or off
32999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
33099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_transceiver_switch(const struct at91_priv *priv, int on)
33199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
33299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (priv->pdata && priv->pdata->transceiver_switch)
33399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->pdata->transceiver_switch(on);
33499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
33599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
33699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_setup_mailboxes(struct net_device *dev)
33799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
33899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
33999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	unsigned int i;
3403a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	u32 reg_mid;
34199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
34299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/*
3439e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde	 * Due to a chip bug (errata 50.2.6.3 & 50.3.5.3) the first
3449e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde	 * mailbox is disabled. The next 11 mailboxes are used as a
3459e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde	 * reception FIFO. The last mailbox is configured with
3469e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde	 * overwrite option. The overwrite flag indicates a FIFO
3479e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde	 * overflow.
34899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 */
3493a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	reg_mid = at91_can_id_to_reg_mid(priv->mb0_id);
350d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	for (i = 0; i < get_mb_rx_first(priv); i++) {
3519e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde		set_mb_mode(priv, i, AT91_MB_MODE_DISABLED);
3523a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		at91_write(priv, AT91_MID(i), reg_mid);
3533a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		at91_write(priv, AT91_MCR(i), 0x0);	/* clear dlc */
3543a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	}
3553a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
356d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	for (i = get_mb_rx_first(priv); i < get_mb_rx_last(priv); i++)
35799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		set_mb_mode(priv, i, AT91_MB_MODE_RX);
358d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	set_mb_mode(priv, get_mb_rx_last(priv), AT91_MB_MODE_RX_OVRWR);
35999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
3608a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde	/* reset acceptance mask and id register */
361d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	for (i = get_mb_rx_first(priv); i <= get_mb_rx_last(priv); i++) {
36244d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde		at91_write(priv, AT91_MAM(i), 0x0);
3638a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde		at91_write(priv, AT91_MID(i), AT91_MID_MIDE);
3648a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde	}
3658a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde
36699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* The last 4 mailboxes are used for transmitting. */
36779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	for (i = get_mb_tx_first(priv); i <= get_mb_tx_last(priv); i++)
36899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		set_mb_mode_prio(priv, i, AT91_MB_MODE_TX, 0);
36999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
37099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Reset tx and rx helper pointers */
3710909c1ec6f016b3f580fa2f4630659a5874a8ef8Marc Kleine-Budde	priv->tx_next = priv->tx_echo = 0;
372d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	priv->rx_next = get_mb_rx_first(priv);
37399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
37499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
37599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_set_bittiming(struct net_device *dev)
37699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
37799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	const struct at91_priv *priv = netdev_priv(dev);
37899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	const struct can_bittiming *bt = &priv->can.bittiming;
37999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_br;
38099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
381dbe91325c2d6ad34c1ce4f2aeae4bbd11b7a3fffMarc Kleine-Budde	reg_br = ((priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES) ? 1 << 24 : 0) |
382dbe91325c2d6ad34c1ce4f2aeae4bbd11b7a3fffMarc Kleine-Budde		((bt->brp - 1) << 16) | ((bt->sjw - 1) << 12) |
38399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		((bt->prop_seg - 1) << 8) | ((bt->phase_seg1 - 1) << 4) |
38499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		((bt->phase_seg2 - 1) << 0);
38599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
386882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde	netdev_info(dev, "writing AT91_BR: 0x%08x\n", reg_br);
38799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
38899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_BR, reg_br);
38999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
39099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
39199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
39299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
39333a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Buddestatic int at91_get_berr_counter(const struct net_device *dev,
39433a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde		struct can_berr_counter *bec)
39533a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde{
39633a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	const struct at91_priv *priv = netdev_priv(dev);
39733a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	u32 reg_ecr = at91_read(priv, AT91_ECR);
39833a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde
39933a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	bec->rxerr = reg_ecr & 0xff;
40033a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	bec->txerr = reg_ecr >> 16;
40133a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde
40233a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	return 0;
40333a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde}
40433a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde
40599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_chip_start(struct net_device *dev)
40699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
40799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
40899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_mr, reg_ier;
40999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
41099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* disable interrupts */
41199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IDR, AT91_IRQ_ALL);
41299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
41399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* disable chip */
41499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_mr = at91_read(priv, AT91_MR);
41599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MR, reg_mr & ~AT91_MR_CANEN);
41699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
417b156fd0483c8f18b3cc544d9c400fe454458e16aMarc Kleine-Budde	at91_set_bittiming(dev);
41899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_setup_mailboxes(dev);
41999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_transceiver_switch(priv, 1);
42099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
42199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* enable chip */
42299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MR, AT91_MR_CANEN);
42399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
42499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.state = CAN_STATE_ERROR_ACTIVE;
42599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
42699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Enable interrupts */
42779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	reg_ier = get_irq_mb_rx(priv) | AT91_IRQ_ERRP | AT91_IRQ_ERR_FRAME;
42899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IDR, AT91_IRQ_ALL);
42999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IER, reg_ier);
43099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
43199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
43299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_chip_stop(struct net_device *dev, enum can_state state)
43399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
43499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
43599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_mr;
43699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
43799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* disable interrupts */
43899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IDR, AT91_IRQ_ALL);
43999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
44099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_mr = at91_read(priv, AT91_MR);
44199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MR, reg_mr & ~AT91_MR_CANEN);
44299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
44399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_transceiver_switch(priv, 0);
44499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.state = state;
44599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
44699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
44799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
44899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * theory of operation:
44999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
45099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * According to the datasheet priority 0 is the highest priority, 15
45199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * is the lowest. If two mailboxes have the same priority level the
45299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * message of the mailbox with the lowest number is sent first.
45399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
45499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * We use the first TX mailbox (AT91_MB_TX_FIRST) with prio 0, then
45599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * the next mailbox with prio 0, and so on, until all mailboxes are
45699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * used. Then we start from the beginning with mailbox
45799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * AT91_MB_TX_FIRST, but with prio 1, mailbox AT91_MB_TX_FIRST + 1
45899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * prio 1. When we reach the last mailbox with prio 15, we have to
45999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * stop sending, waiting for all messages to be delivered, then start
46099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * again with mailbox AT91_MB_TX_FIRST prio 0.
46199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
46299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * We use the priv->tx_next as counter for the next transmission
46399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * mailbox, but without the offset AT91_MB_TX_FIRST. The lower bits
46499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * encode the mailbox number, the upper 4 bits the mailbox priority:
46599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
466d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde * priv->tx_next = (prio << get_next_prio_shift(priv)) |
467d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde *                 (mb - get_mb_tx_first(priv));
46899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
46999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
47099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic netdev_tx_t at91_start_xmit(struct sk_buff *skb, struct net_device *dev)
47199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
47299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
47399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device_stats *stats = &dev->stats;
47499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct can_frame *cf = (struct can_frame *)skb->data;
47599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	unsigned int mb, prio;
47699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_mid, reg_mcr;
47799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
4783ccd4c6167d3b39d52631767ebbf8b5677c5855dOliver Hartkopp	if (can_dropped_invalid_skb(dev, skb))
4793ccd4c6167d3b39d52631767ebbf8b5677c5855dOliver Hartkopp		return NETDEV_TX_OK;
4803ccd4c6167d3b39d52631767ebbf8b5677c5855dOliver Hartkopp
48199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	mb = get_tx_next_mb(priv);
48299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	prio = get_tx_next_prio(priv);
48399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
48499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (unlikely(!(at91_read(priv, AT91_MSR(mb)) & AT91_MSR_MRDY))) {
48599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		netif_stop_queue(dev);
48699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
487882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_err(dev, "BUG! TX buffer full when queue awake!\n");
48899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return NETDEV_TX_BUSY;
48999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
4903a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	reg_mid = at91_can_id_to_reg_mid(cf->can_id);
49199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_mcr = ((cf->can_id & CAN_RTR_FLAG) ? AT91_MCR_MRTR : 0) |
49299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		(cf->can_dlc << 16) | AT91_MCR_MTCR;
49399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
49499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* disable MB while writing ID (see datasheet) */
49599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	set_mb_mode(priv, mb, AT91_MB_MODE_DISABLED);
49699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MID(mb), reg_mid);
49799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	set_mb_mode_prio(priv, mb, AT91_MB_MODE_TX, prio);
49899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
49999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MDL(mb), *(u32 *)(cf->data + 0));
50099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MDH(mb), *(u32 *)(cf->data + 4));
50199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
50299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* This triggers transmission */
50399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_MCR(mb), reg_mcr);
50499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
50599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->tx_bytes += cf->can_dlc;
50699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
50725985edcedea6396277003854657b5f3cb31a628Lucas De Marchi	/* _NOTE_: subtract AT91_MB_TX_FIRST offset from mb! */
50879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	can_put_echo_skb(skb, dev, mb - get_mb_tx_first(priv));
50999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
51099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/*
51199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * we have to stop the queue and deliver all messages in case
51299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * of a prio+mb counter wrap around. This is the case if
51399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * tx_next buffer prio and mailbox equals 0.
51499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 *
51599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * also stop the queue if next buffer is still in use
51699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * (== not ready)
51799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 */
51899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->tx_next++;
51999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (!(at91_read(priv, AT91_MSR(get_tx_next_mb(priv))) &
52099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	      AT91_MSR_MRDY) ||
52179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	    (priv->tx_next & get_next_mask(priv)) == 0)
52299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		netif_stop_queue(dev);
52399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
52499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Enable interrupt for this mailbox */
52599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IER, 1 << mb);
52699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
52799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return NETDEV_TX_OK;
52899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
52999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
53099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
53199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_activate_rx_low - activate lower rx mailboxes
53299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @priv: a91 context
53399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
53499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Reenables the lower mailboxes for reception of new CAN messages
53599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
53699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline void at91_activate_rx_low(const struct at91_priv *priv)
53799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
53879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	u32 mask = get_mb_rx_low_mask(priv);
53999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_TCR, mask);
54099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
54199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
54299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
54399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_activate_rx_mb - reactive single rx mailbox
54499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @priv: a91 context
54599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @mb: mailbox to reactivate
54699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
54799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Reenables given mailbox for reception of new CAN messages
54899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
54999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic inline void at91_activate_rx_mb(const struct at91_priv *priv,
55099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		unsigned int mb)
55199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
55299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 mask = 1 << mb;
55399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_TCR, mask);
55499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
55599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
55699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
55799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_rx_overflow_err - send error frame due to rx overflow
55899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @dev: net device
55999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
56099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_rx_overflow_err(struct net_device *dev)
56199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
56299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device_stats *stats = &dev->stats;
56399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct sk_buff *skb;
56499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct can_frame *cf;
56599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
566882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde	netdev_dbg(dev, "RX buffer overflow\n");
56799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_over_errors++;
56899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_errors++;
56999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
57099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	skb = alloc_can_err_skb(dev, &cf);
57199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (unlikely(!skb))
57299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return;
57399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
57499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	cf->can_id |= CAN_ERR_CRTL;
57599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	cf->data[1] = CAN_ERR_CRTL_RX_OVERFLOW;
57699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_receive_skb(skb);
57799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
57899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_packets++;
57999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_bytes += cf->can_dlc;
58099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
58199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
58299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
58399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_read_mb - read CAN msg from mailbox (lowlevel impl)
58499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @dev: net device
58599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @mb: mailbox number to read from
58699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @cf: can frame where to store message
58799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
58899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Reads a CAN message from the given mailbox and stores data into
58999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * given can frame. "mb" and "cf" must be valid.
59099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
59199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_read_mb(struct net_device *dev, unsigned int mb,
59299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		struct can_frame *cf)
59399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
59499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	const struct at91_priv *priv = netdev_priv(dev);
59599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_msr, reg_mid;
59699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
59799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_mid = at91_read(priv, AT91_MID(mb));
59899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_mid & AT91_MID_MIDE)
59999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id = ((reg_mid >> 0) & CAN_EFF_MASK) | CAN_EFF_FLAG;
60099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	else
60199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id = (reg_mid >> 18) & CAN_SFF_MASK;
60299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
60399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_msr = at91_read(priv, AT91_MSR(mb));
604c7cd606f60e7679c7f9eee7010f02a6f000209c1Oliver Hartkopp	cf->can_dlc = get_can_dlc((reg_msr >> 16) & 0xf);
60599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
606e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde	if (reg_msr & AT91_MSR_MRTR)
607e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde		cf->can_id |= CAN_RTR_FLAG;
608e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde	else {
609e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde		*(u32 *)(cf->data + 0) = at91_read(priv, AT91_MDL(mb));
610e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde		*(u32 *)(cf->data + 4) = at91_read(priv, AT91_MDH(mb));
611e14ee40bece891b5edccdd514112999ec423a448Marc Kleine-Budde	}
61299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
6138a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde	/* allow RX of extended frames */
6148a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde	at91_write(priv, AT91_MID(mb), AT91_MID_MIDE);
6158a0e0a49b0a917c8c8dce6f7121ec73a5c8e3932Marc Kleine-Budde
616d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	if (unlikely(mb == get_mb_rx_last(priv) && reg_msr & AT91_MSR_MMI))
61799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_rx_overflow_err(dev);
61899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
61999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
62099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
62199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_read_msg - read CAN message from mailbox
62299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @dev: net device
62399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @mb: mail box to read from
62499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
62599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Reads a CAN message from given mailbox, and put into linux network
62699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * RX queue, does all housekeeping chores (stats, ...)
62799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
62899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_read_msg(struct net_device *dev, unsigned int mb)
62999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
63099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device_stats *stats = &dev->stats;
63199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct can_frame *cf;
63299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct sk_buff *skb;
63399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
63499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	skb = alloc_can_skb(dev, &cf);
63599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (unlikely(!skb)) {
63699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		stats->rx_dropped++;
63799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return;
63899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
63999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
64099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_read_mb(dev, mb, cf);
64199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_receive_skb(skb);
64299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
64399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_packets++;
64499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	stats->rx_bytes += cf->can_dlc;
64599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
64699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
64799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/**
64899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * at91_poll_rx - read multiple CAN messages from mailboxes
64999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @dev: net device
65099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * @quota: max number of pkgs we're allowed to receive
65199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
65299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Theory of Operation:
65399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
654d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde * About 3/4 of the mailboxes (get_mb_rx_first()...get_mb_rx_last())
655d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde * on the chip are reserved for RX. We split them into 2 groups. The
656d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde * lower group ranges from get_mb_rx_first() to get_mb_rx_low_last().
65799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
65899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * Like it or not, but the chip always saves a received CAN message
65999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * into the first free mailbox it finds (starting with the
66099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * lowest). This makes it very difficult to read the messages in the
66199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * right order from the chip. This is how we work around that problem:
66299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
6639e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde * The first message goes into mb nr. 1 and issues an interrupt. All
66499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * rx ints are disabled in the interrupt handler and a napi poll is
66599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * scheduled. We read the mailbox, but do _not_ reenable the mb (to
66699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * receive another message).
66799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
66899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *    lower mbxs      upper
6699e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *     ____^______    __^__
6709e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *    /           \  /     \
67199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * +-+-+-+-+-+-+-+-++-+-+-+-+
6729e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde * | |x|x|x|x|x|x|x|| | | | |
67399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * +-+-+-+-+-+-+-+-++-+-+-+-+
67499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *  0 0 0 0 0 0  0 0 0 0 1 1  \ mail
67599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *  0 1 2 3 4 5  6 7 8 9 0 1  / box
6769e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *  ^
6779e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *  |
6789e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *   \
6799e0a2d1ca3de6e284e99ad5cae1ae33ecb74c479Marc Kleine-Budde *     unused, due to chip bug
68099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
68199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * The variable priv->rx_next points to the next mailbox to read a
68299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * message from. As long we're in the lower mailboxes we just read the
68399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * mailbox but not reenable it.
68499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
68599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * With completion of the last of the lower mailboxes, we reenable the
68699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * whole first group, but continue to look for filled mailboxes in the
68799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * upper mailboxes. Imagine the second group like overflow mailboxes,
68899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * which takes CAN messages if the lower goup is full. While in the
68999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * upper group we reenable the mailbox right after reading it. Giving
69099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * the chip more room to store messages.
69199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
69299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * After finishing we look again in the lower group if we've still
69399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * quota.
69499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
69599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
69699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_poll_rx(struct net_device *dev, int quota)
69799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
69899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
69999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_sr = at91_read(priv, AT91_SR);
70099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	const unsigned long *addr = (unsigned long *)&reg_sr;
70199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	unsigned int mb;
70299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	int received = 0;
70399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
70479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if (priv->rx_next > get_mb_rx_low_last(priv) &&
70579008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	    reg_sr & get_mb_rx_low_mask(priv))
706882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_info(dev,
707882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde			"order of incoming frames cannot be guaranteed\n");
70899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
70999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller again:
71079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	for (mb = find_next_bit(addr, get_mb_tx_first(priv), priv->rx_next);
71179008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	     mb < get_mb_tx_first(priv) && quota > 0;
71299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	     reg_sr = at91_read(priv, AT91_SR),
71379008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	     mb = find_next_bit(addr, get_mb_tx_first(priv), ++priv->rx_next)) {
71499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_read_msg(dev, mb);
71599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
71699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/* reactivate mailboxes */
71779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde		if (mb == get_mb_rx_low_last(priv))
71899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			/* all lower mailboxed, if just finished it */
71999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			at91_activate_rx_low(priv);
72079008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde		else if (mb > get_mb_rx_low_last(priv))
72199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			/* only the mailbox we read */
72299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			at91_activate_rx_mb(priv, mb);
72399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
72499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		received++;
72599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		quota--;
72699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
72799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
72899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* upper group completed, look again in lower */
72979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if (priv->rx_next > get_mb_rx_low_last(priv) &&
730d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	    quota > 0 && mb > get_mb_rx_last(priv)) {
731d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		priv->rx_next = get_mb_rx_first(priv);
73299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto again;
73399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
73499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
73599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return received;
73699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
73799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
73899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_poll_err_frame(struct net_device *dev,
73999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		struct can_frame *cf, u32 reg_sr)
74099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
74199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
74299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
74399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* CRC error */
74499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_CERR) {
745882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "CERR irq\n");
74699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev->stats.rx_errors++;
74799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->can.can_stats.bus_error++;
74899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
74999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
75099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
75199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Stuffing Error */
75299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_SERR) {
753882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "SERR irq\n");
75499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev->stats.rx_errors++;
75599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->can.can_stats.bus_error++;
75699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
75799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->data[2] |= CAN_ERR_PROT_STUFF;
75899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
75999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
76099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Acknowledgement Error */
76199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_AERR) {
762882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "AERR irq\n");
76399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev->stats.tx_errors++;
76499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_ACK;
76599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
76699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
76799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Form error */
76899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_FERR) {
769882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "FERR irq\n");
77099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev->stats.rx_errors++;
77199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->can.can_stats.bus_error++;
77299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
77399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->data[2] |= CAN_ERR_PROT_FORM;
77499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
77599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
77699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Bit Error */
77799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_BERR) {
778882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "BERR irq\n");
77999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev->stats.tx_errors++;
78099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->can.can_stats.bus_error++;
78199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
78299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->data[2] |= CAN_ERR_PROT_BIT;
78399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
78499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
78599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
78699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_poll_err(struct net_device *dev, int quota, u32 reg_sr)
78799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
78899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct sk_buff *skb;
78999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct can_frame *cf;
79099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
79199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (quota == 0)
79299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return 0;
79399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
79499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	skb = alloc_can_err_skb(dev, &cf);
79599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (unlikely(!skb))
79699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return 0;
79799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
79899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_poll_err_frame(dev, cf, reg_sr);
79999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_receive_skb(skb);
80099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
80199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->stats.rx_packets++;
80299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->stats.rx_bytes += cf->can_dlc;
80399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
80499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 1;
80599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
80699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
80799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_poll(struct napi_struct *napi, int quota)
80899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
80999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device *dev = napi->dev;
81099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	const struct at91_priv *priv = netdev_priv(dev);
81199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_sr = at91_read(priv, AT91_SR);
81299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	int work_done = 0;
81399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
81479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if (reg_sr & get_irq_mb_rx(priv))
81599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		work_done += at91_poll_rx(dev, quota - work_done);
81699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
81799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/*
81899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * The error bits are clear on read,
81999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * so use saved value from irq handler.
82099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 */
82199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_sr |= priv->reg_sr;
82299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (reg_sr & AT91_IRQ_ERR_FRAME)
82399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		work_done += at91_poll_err(dev, quota - work_done, reg_sr);
82499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
82599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (work_done < quota) {
82699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/* enable IRQs for frame errors and all mailboxes >= rx_next */
82799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		u32 reg_ier = AT91_IRQ_ERR_FRAME;
82879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde		reg_ier |= get_irq_mb_rx(priv) & ~AT91_MB_MASK(priv->rx_next);
82999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
83099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		napi_complete(napi);
83199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_write(priv, AT91_IER, reg_ier);
83299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
83399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
83499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return work_done;
83599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
83699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
83799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
83899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * theory of operation:
83999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
84099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * priv->tx_echo holds the number of the oldest can_frame put for
84199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * transmission into the hardware, but not yet ACKed by the CAN tx
84299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * complete IRQ.
84399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
84499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * We iterate from priv->tx_echo to priv->tx_next and check if the
84599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * packet has been transmitted, echo it back to the CAN framework. If
84699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * we discover a not yet transmitted package, stop looking for more.
84799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller *
84899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
84999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_irq_tx(struct net_device *dev, u32 reg_sr)
85099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
85199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
85299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_msr;
85399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	unsigned int mb;
85499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
85599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* masking of reg_sr not needed, already done by at91_irq */
85699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
85799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	for (/* nix */; (priv->tx_next - priv->tx_echo) > 0; priv->tx_echo++) {
85899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		mb = get_tx_echo_mb(priv);
85999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
86099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/* no event in mailbox? */
86199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (!(reg_sr & (1 << mb)))
86299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			break;
86399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
86499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/* Disable irq for this TX mailbox */
86599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_write(priv, AT91_IDR, 1 << mb);
86699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
86799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
86899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * only echo if mailbox signals us a transfer
86999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * complete (MSR_MRDY). Otherwise it's a tansfer
87099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * abort. "can_bus_off()" takes care about the skbs
87199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * parked in the echo queue.
87299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
87399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_msr = at91_read(priv, AT91_MSR(mb));
87499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (likely(reg_msr & AT91_MSR_MRDY &&
87599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			   ~reg_msr & AT91_MSR_MABT)) {
87625985edcedea6396277003854657b5f3cb31a628Lucas De Marchi			/* _NOTE_: subtract AT91_MB_TX_FIRST offset from mb! */
87779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde			can_get_echo_skb(dev, mb - get_mb_tx_first(priv));
87899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			dev->stats.tx_packets++;
87999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		}
88099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
88199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
88299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/*
88399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * restart queue if we don't have a wrap around but restart if
88499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * we get a TX int for the last can frame directly before a
88599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 * wrap around.
88699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	 */
88779008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if ((priv->tx_next & get_next_mask(priv)) != 0 ||
88879008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	    (priv->tx_echo & get_next_mask(priv)) == 0)
88999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		netif_wake_queue(dev);
89099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
89199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
89299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_irq_err_state(struct net_device *dev,
89399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		struct can_frame *cf, enum can_state new_state)
89499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
89599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
89633a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	u32 reg_idr = 0, reg_ier = 0;
89733a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	struct can_berr_counter bec;
89899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
89933a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	at91_get_berr_counter(dev, &bec);
90099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
90199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	switch (priv->can.state) {
90299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_ERROR_ACTIVE:
90399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
90499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * from: ERROR_ACTIVE
90599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * to  : ERROR_WARNING, ERROR_PASSIVE, BUS_OFF
90699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * =>  : there was a warning int
90799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
90899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (new_state >= CAN_STATE_ERROR_WARNING &&
90999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		    new_state <= CAN_STATE_BUS_OFF) {
910882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde			netdev_dbg(dev, "Error Warning IRQ\n");
91199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			priv->can.can_stats.error_warning++;
91299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
91399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			cf->can_id |= CAN_ERR_CRTL;
91433a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde			cf->data[1] = (bec.txerr > bec.rxerr) ?
91599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				CAN_ERR_CRTL_TX_WARNING :
91699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				CAN_ERR_CRTL_RX_WARNING;
91799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		}
91899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_ERROR_WARNING:	/* fallthrough */
91999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
92099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * from: ERROR_ACTIVE, ERROR_WARNING
92199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * to  : ERROR_PASSIVE, BUS_OFF
92299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * =>  : error passive int
92399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
92499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (new_state >= CAN_STATE_ERROR_PASSIVE &&
92599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		    new_state <= CAN_STATE_BUS_OFF) {
926882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde			netdev_dbg(dev, "Error Passive IRQ\n");
92799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			priv->can.can_stats.error_passive++;
92899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
92999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			cf->can_id |= CAN_ERR_CRTL;
93033a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde			cf->data[1] = (bec.txerr > bec.rxerr) ?
93199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				CAN_ERR_CRTL_TX_PASSIVE :
93299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				CAN_ERR_CRTL_RX_PASSIVE;
93399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		}
93499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
93599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_BUS_OFF:
93699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
93799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * from: BUS_OFF
93899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * to  : ERROR_ACTIVE, ERROR_WARNING, ERROR_PASSIVE
93999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
94099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (new_state <= CAN_STATE_ERROR_PASSIVE) {
94199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			cf->can_id |= CAN_ERR_RESTARTED;
94299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
943882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde			netdev_dbg(dev, "restarted\n");
94499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			priv->can.can_stats.restarts++;
94599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
94699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			netif_carrier_on(dev);
94799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			netif_wake_queue(dev);
94899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		}
94999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
95099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	default:
95199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
95299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
95399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
95499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
95599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* process state changes depending on the new state */
95699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	switch (new_state) {
95799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_ERROR_ACTIVE:
95899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
95999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * actually we want to enable AT91_IRQ_WARN here, but
96099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * it screws up the system under certain
96199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * circumstances. so just enable AT91_IRQ_ERRP, thus
96299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * the "fallthrough"
96399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
964882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "Error Active\n");
96599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_PROT;
96699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->data[2] = CAN_ERR_PROT_ACTIVE;
96799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_ERROR_WARNING:	/* fallthrough */
96899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_idr = AT91_IRQ_ERRA | AT91_IRQ_WARN | AT91_IRQ_BOFF;
96999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_ier = AT91_IRQ_ERRP;
97099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
97199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_ERROR_PASSIVE:
97299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_idr = AT91_IRQ_ERRA | AT91_IRQ_WARN | AT91_IRQ_ERRP;
97399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_ier = AT91_IRQ_BOFF;
97499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
97599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_STATE_BUS_OFF:
97699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_idr = AT91_IRQ_ERRA | AT91_IRQ_ERRP |
97799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			AT91_IRQ_WARN | AT91_IRQ_BOFF;
97899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		reg_ier = 0;
97999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
98099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		cf->can_id |= CAN_ERR_BUSOFF;
98199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
982882055c8387e85cb380ab152b96ff69b570d8989Marc Kleine-Budde		netdev_dbg(dev, "bus-off\n");
98399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		netif_carrier_off(dev);
98499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->can.can_stats.bus_off++;
98599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
98699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/* turn off chip, if restart is disabled */
98799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		if (!priv->can.restart_ms) {
98899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			at91_chip_stop(dev, CAN_STATE_BUS_OFF);
98999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			return;
99099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		}
99199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
99299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	default:
99399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
99499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
99599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
99699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IDR, reg_idr);
99799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_write(priv, AT91_IER, reg_ier);
99899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
99999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
10006388b39614208d63661607f45157e3326548eb62Marc Kleine-Buddestatic int at91_get_state_by_bec(const struct net_device *dev,
10016388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		enum can_state *state)
10026388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde{
10036388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	struct can_berr_counter bec;
10046388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	int err;
10056388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
10066388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	err = at91_get_berr_counter(dev, &bec);
10076388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	if (err)
10086388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		return err;
10096388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
10106388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	if (bec.txerr < 96 && bec.rxerr < 96)
10116388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		*state = CAN_STATE_ERROR_ACTIVE;
10126388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	else if (bec.txerr < 128 && bec.rxerr < 128)
10136388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		*state = CAN_STATE_ERROR_WARNING;
10146388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	else if (bec.txerr < 256 && bec.rxerr < 256)
10156388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		*state = CAN_STATE_ERROR_PASSIVE;
10166388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	else
10176388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		*state = CAN_STATE_BUS_OFF;
10186388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
10196388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	return 0;
10206388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde}
10216388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
10226388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
102399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic void at91_irq_err(struct net_device *dev)
102499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
102599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
102699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct sk_buff *skb;
102799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct can_frame *cf;
102899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	enum can_state new_state;
102999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_sr;
10306388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	int err;
103199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
10326388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	if (at91_is_sam9263(priv)) {
10336388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		reg_sr = at91_read(priv, AT91_SR);
10346388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde
10356388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		/* we need to look at the unmasked reg_sr */
10366388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		if (unlikely(reg_sr & AT91_IRQ_BOFF))
10376388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			new_state = CAN_STATE_BUS_OFF;
10386388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		else if (unlikely(reg_sr & AT91_IRQ_ERRP))
10396388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			new_state = CAN_STATE_ERROR_PASSIVE;
10406388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		else if (unlikely(reg_sr & AT91_IRQ_WARN))
10416388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			new_state = CAN_STATE_ERROR_WARNING;
10426388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		else if (likely(reg_sr & AT91_IRQ_ERRA))
10436388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			new_state = CAN_STATE_ERROR_ACTIVE;
10446388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		else {
10456388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			netdev_err(dev, "BUG! hardware in undefined state\n");
10466388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			return;
10476388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		}
10486388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	} else {
10496388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		err = at91_get_state_by_bec(dev, &new_state);
10506388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		if (err)
10516388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde			return;
105299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
105399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
105499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* state hasn't changed */
105599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (likely(new_state == priv->can.state))
105699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return;
105799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
105899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	skb = alloc_can_err_skb(dev, &cf);
105999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (unlikely(!skb))
106099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return;
106199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
106299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_irq_err_state(dev, cf, new_state);
106399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_rx(skb);
106499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
106599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->stats.rx_packets++;
106699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->stats.rx_bytes += cf->can_dlc;
106799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
106899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.state = new_state;
106999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
107099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
107199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
107299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * interrupt handler
107399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
107499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic irqreturn_t at91_irq(int irq, void *dev_id)
107599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
107699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device *dev = dev_id;
107799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
107899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	irqreturn_t handled = IRQ_NONE;
107999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	u32 reg_sr, reg_imr;
108099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
108199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_sr = at91_read(priv, AT91_SR);
108299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_imr = at91_read(priv, AT91_IMR);
108399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
108499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Ignore masked interrupts */
108599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	reg_sr &= reg_imr;
108699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (!reg_sr)
108799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit;
108899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
108999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	handled = IRQ_HANDLED;
109099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
109199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Receive or error interrupt? -> napi */
109279008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if (reg_sr & (get_irq_mb_rx(priv) | AT91_IRQ_ERR_FRAME)) {
109399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		/*
109499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * The error bits are clear on read,
109599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 * save for later use.
109699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 */
109799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		priv->reg_sr = reg_sr;
109899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_write(priv, AT91_IDR,
109979008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde			   get_irq_mb_rx(priv) | AT91_IRQ_ERR_FRAME);
110099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		napi_schedule(&priv->napi);
110199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
110299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
110399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* Transmission complete interrupt */
110479008997e232ad1d871bb6fedfb7fbd77ea95af8Marc Kleine-Budde	if (reg_sr & get_irq_mb_tx(priv))
110599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_irq_tx(dev, reg_sr);
110699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
110799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_irq_err(dev);
110899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
110999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit:
111099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return handled;
111199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
111299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
111399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_open(struct net_device *dev)
111499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
111599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
111699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	int err;
111799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
111899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk_enable(priv->clk);
111999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
112099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* check or determine and set bittime */
112199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	err = open_candev(dev);
112299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (err)
112399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto out;
112499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
112599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* register interrupt handler */
112699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (request_irq(dev->irq, at91_irq, IRQF_SHARED,
112799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller			dev->name, dev)) {
112899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -EAGAIN;
112999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto out_close;
113099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
113199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
113299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	/* start chip and queuing */
113399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_chip_start(dev);
113499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	napi_enable(&priv->napi);
113599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_start_queue(dev);
113699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
113799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
113899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
113999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller out_close:
114099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	close_candev(dev);
114199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller out:
114299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk_disable(priv->clk);
114399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
114499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return err;
114599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
114699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
114799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller/*
114899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller * stop CAN bus activity
114999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller */
115099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_close(struct net_device *dev)
115199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
115299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
115399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
115499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	netif_stop_queue(dev);
115599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	napi_disable(&priv->napi);
115699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	at91_chip_stop(dev, CAN_STATE_STOPPED);
115799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
115899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	free_irq(dev->irq, dev);
115999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk_disable(priv->clk);
116099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
116199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	close_candev(dev);
116299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
116399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
116499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
116599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
116699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int at91_set_mode(struct net_device *dev, enum can_mode mode)
116799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
116899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	switch (mode) {
116999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	case CAN_MODE_START:
117099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		at91_chip_start(dev);
117199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		netif_wake_queue(dev);
117299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		break;
117399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
117499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	default:
117599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		return -EOPNOTSUPP;
117699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
117799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
117899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
117999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
118099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
118199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic const struct net_device_ops at91_netdev_ops = {
118299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.ndo_open	= at91_open,
118399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.ndo_stop	= at91_close,
118499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	.ndo_start_xmit	= at91_start_xmit,
118599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
118699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
11873a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Buddestatic ssize_t at91_sysfs_show_mb0_id(struct device *dev,
11883a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		struct device_attribute *attr, char *buf)
11893a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde{
11903a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	struct at91_priv *priv = netdev_priv(to_net_dev(dev));
11913a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
11923a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	if (priv->mb0_id & CAN_EFF_FLAG)
11933a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		return snprintf(buf, PAGE_SIZE, "0x%08x\n", priv->mb0_id);
11943a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	else
11953a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		return snprintf(buf, PAGE_SIZE, "0x%03x\n", priv->mb0_id);
11963a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde}
11973a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
11983a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Buddestatic ssize_t at91_sysfs_set_mb0_id(struct device *dev,
11993a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		struct device_attribute *attr, const char *buf, size_t count)
12003a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde{
12013a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	struct net_device *ndev = to_net_dev(dev);
12023a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	struct at91_priv *priv = netdev_priv(ndev);
12033a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	unsigned long can_id;
12043a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	ssize_t ret;
12053a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	int err;
12063a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12073a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	rtnl_lock();
12083a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12093a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	if (ndev->flags & IFF_UP) {
12103a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		ret = -EBUSY;
12113a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		goto out;
12123a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	}
12133a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12143a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	err = strict_strtoul(buf, 0, &can_id);
12153a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	if (err) {
12163a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		ret = err;
12173a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		goto out;
12183a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	}
12193a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12203a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	if (can_id & CAN_EFF_FLAG)
12213a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		can_id &= CAN_EFF_MASK | CAN_EFF_FLAG;
12223a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	else
12233a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde		can_id &= CAN_SFF_MASK;
12243a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12253a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	priv->mb0_id = can_id;
12263a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	ret = count;
12273a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12283a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde out:
12293a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	rtnl_unlock();
12303a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	return ret;
12313a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde}
12323a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
1233fef52b0171dfd7dd9b85c9cc201bd433b42a8dedVasiliy Kulikovstatic DEVICE_ATTR(mb0_id, S_IWUSR | S_IRUGO,
12343a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	at91_sysfs_show_mb0_id, at91_sysfs_set_mb0_id);
12353a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12363a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Buddestatic struct attribute *at91_sysfs_attrs[] = {
12373a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	&dev_attr_mb0_id.attr,
12383a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	NULL,
12393a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde};
12403a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
12413a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Buddestatic struct attribute_group at91_sysfs_attr_group = {
12423a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	.attrs = at91_sysfs_attrs,
12433a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde};
12443a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde
1245a9d992ecb36f8ed00130eaf41a406fda03433d23Marc Kleine-Buddestatic int __devinit at91_can_probe(struct platform_device *pdev)
124699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
1247d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	const struct at91_devtype_data *devtype_data;
1248d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	enum at91_devtype devtype;
124999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device *dev;
125099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv;
125199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct resource *res;
125299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct clk *clk;
125399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	void __iomem *addr;
125499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	int err, irq;
125599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1256d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	devtype = pdev->id_entry->driver_data;
1257d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	devtype_data = &at91_devtype_data[devtype];
1258d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
125999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk = clk_get(&pdev->dev, "can_clk");
126099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (IS_ERR(clk)) {
126199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev_err(&pdev->dev, "no clock defined\n");
126299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -ENODEV;
126399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit;
126499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
126599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
126699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
126799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	irq = platform_get_irq(pdev, 0);
12684773a47d8a564633cd80b94df397e91e946893e2Uwe Kleine-König	if (!res || irq <= 0) {
126999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -ENODEV;
127099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit_put;
127199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
127299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
127399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (!request_mem_region(res->start,
127499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				resource_size(res),
127599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller				pdev->name)) {
127699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -EBUSY;
127799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit_put;
127899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
127999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
128099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	addr = ioremap_nocache(res->start, resource_size(res));
128199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (!addr) {
128299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -ENOMEM;
128399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit_release;
128499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
128599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1286d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	dev = alloc_candev(sizeof(struct at91_priv),
1287d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde			   1 << devtype_data->tx_shift);
128899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (!dev) {
128999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		err = -ENOMEM;
129099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit_iounmap;
129199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
129299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
129399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->netdev_ops	= &at91_netdev_ops;
129499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->irq = irq;
129599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev->flags |= IFF_ECHO;
129699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
129799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv = netdev_priv(dev);
129899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.clock.freq = clk_get_rate(clk);
129999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.bittiming_const = &at91_bittiming_const;
130099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->can.do_set_mode = at91_set_mode;
130133a6f298c28a65fa643bc70222ebffe75077f197Marc Kleine-Budde	priv->can.do_get_berr_counter = at91_get_berr_counter;
1302ad72c347e56bf3a0231b9d686e17764157d2961cChristian Pellegrin	priv->can.ctrlmode_supported = CAN_CTRLMODE_3_SAMPLES;
130399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->dev = dev;
1304d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	priv->reg_base = addr;
1305d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	priv->devtype_data = *devtype_data;
1306d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	priv->devtype_data.type = devtype;
130799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->clk = clk;
130899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	priv->pdata = pdev->dev.platform_data;
13093a5655a5b545e9647c3437473ee3d815fe1b9050Marc Kleine-Budde	priv->mb0_id = 0x7ff;
131099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1311d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	netif_napi_add(dev, &priv->napi, at91_poll, get_mb_rx_num(priv));
131299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
131307a648e668aa7f7c94d41d8d2e4ad53b609e391dMarc Kleine-Budde	if (at91_is_sam9263(priv))
131407a648e668aa7f7c94d41d8d2e4ad53b609e391dMarc Kleine-Budde		dev->sysfs_groups[0] = &at91_sysfs_attr_group;
131507a648e668aa7f7c94d41d8d2e4ad53b609e391dMarc Kleine-Budde
131699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev_set_drvdata(&pdev->dev, dev);
131799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	SET_NETDEV_DEV(dev, &pdev->dev);
131899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
131999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	err = register_candev(dev);
132099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	if (err) {
132199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		dev_err(&pdev->dev, "registering netdev failed\n");
132299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		goto exit_free;
132399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	}
132499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
132599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	dev_info(&pdev->dev, "device registered (reg_base=%p, irq=%d)\n",
132699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller		 priv->reg_base, dev->irq);
132799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
132899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
132999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
133099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit_free:
1331759a6c768dcdbbb4d3f1fb965b674c15773e09caMarc Kleine-Budde	free_candev(dev);
133299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit_iounmap:
133399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	iounmap(addr);
133499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit_release:
133599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	release_mem_region(res->start, resource_size(res));
133699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit_put:
133799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk_put(clk);
133899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller exit:
133999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return err;
134099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
134199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
134299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic int __devexit at91_can_remove(struct platform_device *pdev)
134399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller{
134499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct net_device *dev = platform_get_drvdata(pdev);
134599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct at91_priv *priv = netdev_priv(dev);
134699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	struct resource *res;
134799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
134899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	unregister_netdev(dev);
134999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
135099c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	platform_set_drvdata(pdev, NULL);
135199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
135299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	iounmap(priv->reg_base);
135399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
135499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
135599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	release_mem_region(res->start, resource_size(res));
135699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
135799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	clk_put(priv->clk);
135899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1359759a6c768dcdbbb4d3f1fb965b674c15773e09caMarc Kleine-Budde	free_candev(dev);
1360759a6c768dcdbbb4d3f1fb965b674c15773e09caMarc Kleine-Budde
136199c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	return 0;
136299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller}
136399c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1364d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Buddestatic const struct platform_device_id at91_can_id_table[] = {
1365d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	{
1366d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.name = "at91_can",
1367d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		.driver_data = AT91_DEVTYPE_SAM9263,
1368d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	}, {
13696388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.name = "at91sam9x5_can",
13706388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde		.driver_data = AT91_DEVTYPE_SAM9X5,
13716388b39614208d63661607f45157e3326548eb62Marc Kleine-Budde	}, {
1372d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde		/* sentinel */
1373d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	}
1374d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde};
1375d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde
137699c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Millerstatic struct platform_driver at91_can_driver = {
137744d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	.probe = at91_can_probe,
137844d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	.remove = __devexit_p(at91_can_remove),
137944d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde	.driver = {
138044d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde		.name = KBUILD_MODNAME,
138144d856665789288859b7aa47ca25933c1c6ab57dMarc Kleine-Budde		.owner = THIS_MODULE,
138299c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller	},
1383d3d47264a364aa3adcbb485471dbf9f693fb4216Marc Kleine-Budde	.id_table = at91_can_id_table,
138499c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller};
138599c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
1386871d33725545ca2e402b4526f38f89d041ba930fAxel Linmodule_platform_driver(at91_can_driver);
138799c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. Miller
138899c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. MillerMODULE_AUTHOR("Marc Kleine-Budde <mkl@pengutronix.de>");
138999c4a6344f6574c97019ac16e8d54bfe5ad21f2dDavid S. MillerMODULE_LICENSE("GPL v2");
139000389b0820c44cceec3f6981cb4d217982ec73b2Marc Kleine-BuddeMODULE_DESCRIPTION(KBUILD_MODNAME " CAN netdevice driver");
1391