pch_can.c 33.8 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
/*
 * Copyright (C) 1999 - 2010 Intel Corporation.
 * Copyright (C) 2010 OKI SEMICONDUCTOR Co., LTD.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; version 2 of the License.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307, USA.
 */

#include <linux/interrupt.h>
#include <linux/delay.h>
#include <linux/io.h>
#include <linux/module.h>
#include <linux/sched.h>
#include <linux/pci.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/types.h>
#include <linux/errno.h>
#include <linux/netdevice.h>
#include <linux/skbuff.h>
#include <linux/can.h>
#include <linux/can/dev.h>
#include <linux/can/error.h>

T
Tomoya 已提交
35 36 37 38 39 40 41 42
#define PCH_CTRL_INIT		BIT(0) /* The INIT bit of CANCONT register. */
#define PCH_CTRL_IE		BIT(1) /* The IE bit of CAN control register */
#define PCH_CTRL_IE_SIE_EIE	(BIT(3) | BIT(2) | BIT(1))
#define PCH_CTRL_CCE		BIT(6)
#define PCH_CTRL_OPT		BIT(7) /* The OPT bit of CANCONT register. */
#define PCH_OPT_SILENT		BIT(3) /* The Silent bit of CANOPT reg. */
#define PCH_OPT_LBACK		BIT(4) /* The LoopBack bit of CANOPT reg. */

T
Tomoya 已提交
43 44 45
#define PCH_CMASK_RX_TX_SET	0x00f3
#define PCH_CMASK_RX_TX_GET	0x0073
#define PCH_CMASK_ALL		0xff
T
Tomoya 已提交
46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66
#define PCH_CMASK_NEWDAT	BIT(2)
#define PCH_CMASK_CLRINTPND	BIT(3)
#define PCH_CMASK_CTRL		BIT(4)
#define PCH_CMASK_ARB		BIT(5)
#define PCH_CMASK_MASK		BIT(6)
#define PCH_CMASK_RDWR		BIT(7)
#define PCH_IF_MCONT_NEWDAT	BIT(15)
#define PCH_IF_MCONT_MSGLOST	BIT(14)
#define PCH_IF_MCONT_INTPND	BIT(13)
#define PCH_IF_MCONT_UMASK	BIT(12)
#define PCH_IF_MCONT_TXIE	BIT(11)
#define PCH_IF_MCONT_RXIE	BIT(10)
#define PCH_IF_MCONT_RMTEN	BIT(9)
#define PCH_IF_MCONT_TXRQXT	BIT(8)
#define PCH_IF_MCONT_EOB	BIT(7)
#define PCH_IF_MCONT_DLC	(BIT(0) | BIT(1) | BIT(2) | BIT(3))
#define PCH_MASK2_MDIR_MXTD	(BIT(14) | BIT(15))
#define PCH_ID2_DIR		BIT(13)
#define PCH_ID2_XTD		BIT(14)
#define PCH_ID_MSGVAL		BIT(15)
#define PCH_IF_CREQ_BUSY	BIT(15)
T
Tomoya 已提交
67 68 69 70

#define PCH_STATUS_INT		0x8000
#define PCH_REC			0x00007f00
#define PCH_TEC			0x000000ff
71

T
Tomoya 已提交
72 73 74 75 76
#define PCH_TX_OK		BIT(3)
#define PCH_RX_OK		BIT(4)
#define PCH_EPASSIV		BIT(5)
#define PCH_EWARN		BIT(6)
#define PCH_BUS_OFF		BIT(7)
77 78

/* bit position of certain controller bits. */
T
Tomoya 已提交
79 80 81 82 83 84
#define PCH_BIT_BRP_SHIFT	0
#define PCH_BIT_SJW_SHIFT	6
#define PCH_BIT_TSEG1_SHIFT	8
#define PCH_BIT_TSEG2_SHIFT	12
#define PCH_BIT_BRPE_BRPE_SHIFT	6

T
Tomoya 已提交
85 86 87 88
#define PCH_MSK_BITT_BRP	0x3f
#define PCH_MSK_BRPE_BRPE	0x3c0
#define PCH_MSK_CTRL_IE_SIE_EIE	0x07
#define PCH_COUNTER_LIMIT	10
89 90 91 92 93 94

#define PCH_CAN_CLK		50000000	/* 50MHz */

/* Define the number of message object.
 * PCH CAN communications are done via Message RAM.
 * The Message RAM consists of 32 message objects. */
95 96 97 98 99 100
#define PCH_RX_OBJ_NUM		26
#define PCH_TX_OBJ_NUM		6
#define PCH_RX_OBJ_START	1
#define PCH_RX_OBJ_END		PCH_RX_OBJ_NUM
#define PCH_TX_OBJ_START	(PCH_RX_OBJ_END + 1)
#define PCH_TX_OBJ_END		(PCH_RX_OBJ_NUM + PCH_TX_OBJ_NUM)
101 102 103

#define PCH_FIFO_THRESH		16

T
Tomoya 已提交
104 105 106 107
/* TxRqst2 show status of MsgObjNo.17~32 */
#define PCH_TREQ2_TX_MASK	(((1 << PCH_TX_OBJ_NUM) - 1) <<\
							(PCH_RX_OBJ_END - 16))

108 109 110 111 112
enum pch_ifreg {
	PCH_RX_IFREG,
	PCH_TX_IFREG,
};

T
Tomoya 已提交
113 114 115 116 117 118 119 120 121 122
enum pch_can_err {
	PCH_STUF_ERR = 1,
	PCH_FORM_ERR,
	PCH_ACK_ERR,
	PCH_BIT1_ERR,
	PCH_BIT0_ERR,
	PCH_CRC_ERR,
	PCH_LEC_ALL,
};

123 124 125 126 127 128 129 130 131
enum pch_can_mode {
	PCH_CAN_ENABLE,
	PCH_CAN_DISABLE,
	PCH_CAN_ALL,
	PCH_CAN_NONE,
	PCH_CAN_STOP,
	PCH_CAN_RUN
};

132 133 134 135 136 137 138 139
struct pch_can_if_regs {
	u32 creq;
	u32 cmask;
	u32 mask1;
	u32 mask2;
	u32 id1;
	u32 id2;
	u32 mcont;
T
Tomoya 已提交
140
	u32 data[4];
141 142 143
	u32 rsv[13];
};

144 145 146 147 148 149 150 151
struct pch_can_regs {
	u32 cont;
	u32 stat;
	u32 errc;
	u32 bitt;
	u32 intr;
	u32 opt;
	u32 brpe;
152 153 154
	u32 reserve;
	struct pch_can_if_regs ifregs[2]; /* [0]=if1  [1]=if2 */
	u32 reserve1[8];
155 156
	u32 treq1;
	u32 treq2;
157 158 159 160 161 162 163 164 165 166
	u32 reserve2[6];
	u32 data1;
	u32 data2;
	u32 reserve3[6];
	u32 canipend1;
	u32 canipend2;
	u32 reserve4[6];
	u32 canmval1;
	u32 canmval2;
	u32 reserve5[37];
167 168 169 170 171 172
	u32 srst;
};

struct pch_can_priv {
	struct can_priv can;
	struct pci_dev *dev;
T
Tomoya 已提交
173 174 175 176
	u32 tx_enable[PCH_TX_OBJ_END];
	u32 rx_enable[PCH_TX_OBJ_END];
	u32 rx_link[PCH_TX_OBJ_END];
	u32 int_enables;
177 178 179
	struct net_device *ndev;
	struct pch_can_regs __iomem *regs;
	struct napi_struct napi;
T
Tomoya 已提交
180 181
	int tx_obj;	/* Point next Tx Obj index */
	int use_msi;
182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201
};

static struct can_bittiming_const pch_can_bittiming_const = {
	.name = KBUILD_MODNAME,
	.tseg1_min = 1,
	.tseg1_max = 16,
	.tseg2_min = 1,
	.tseg2_max = 8,
	.sjw_max = 4,
	.brp_min = 1,
	.brp_max = 1024, /* 6bit + extended 4bit */
	.brp_inc = 1,
};

static DEFINE_PCI_DEVICE_TABLE(pch_pci_tbl) = {
	{PCI_VENDOR_ID_INTEL, 0x8818, PCI_ANY_ID, PCI_ANY_ID,},
	{0,}
};
MODULE_DEVICE_TABLE(pci, pch_pci_tbl);

202
static inline void pch_can_bit_set(void __iomem *addr, u32 mask)
203 204 205 206
{
	iowrite32(ioread32(addr) | mask, addr);
}

207
static inline void pch_can_bit_clear(void __iomem *addr, u32 mask)
208 209 210 211 212 213 214 215 216
{
	iowrite32(ioread32(addr) & ~mask, addr);
}

static void pch_can_set_run_mode(struct pch_can_priv *priv,
				 enum pch_can_mode mode)
{
	switch (mode) {
	case PCH_CAN_RUN:
T
Tomoya 已提交
217
		pch_can_bit_clear(&priv->regs->cont, PCH_CTRL_INIT);
218 219 220
		break;

	case PCH_CAN_STOP:
T
Tomoya 已提交
221
		pch_can_bit_set(&priv->regs->cont, PCH_CTRL_INIT);
222 223 224 225 226 227 228 229 230 231 232 233 234
		break;

	default:
		dev_err(&priv->ndev->dev, "%s -> Invalid Mode.\n", __func__);
		break;
	}
}

static void pch_can_set_optmode(struct pch_can_priv *priv)
{
	u32 reg_val = ioread32(&priv->regs->opt);

	if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY)
T
Tomoya 已提交
235
		reg_val |= PCH_OPT_SILENT;
236 237

	if (priv->can.ctrlmode & CAN_CTRLMODE_LOOPBACK)
T
Tomoya 已提交
238
		reg_val |= PCH_OPT_LBACK;
239

T
Tomoya 已提交
240
	pch_can_bit_set(&priv->regs->cont, PCH_CTRL_OPT);
241 242 243
	iowrite32(reg_val, &priv->regs->opt);
}

T
Tomoya 已提交
244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260
static void pch_can_rw_msg_obj(void __iomem *creq_addr, u32 num)
{
	int counter = PCH_COUNTER_LIMIT;
	u32 ifx_creq;

	iowrite32(num, creq_addr);
	while (counter) {
		ifx_creq = ioread32(creq_addr) & PCH_IF_CREQ_BUSY;
		if (!ifx_creq)
			break;
		counter--;
		udelay(1);
	}
	if (!counter)
		pr_err("%s:IF1 BUSY Flag is set forever.\n", __func__);
}

261 262 263 264 265
static void pch_can_set_int_enables(struct pch_can_priv *priv,
				    enum pch_can_mode interrupt_no)
{
	switch (interrupt_no) {
	case PCH_CAN_DISABLE:
T
Tomoya 已提交
266
		pch_can_bit_clear(&priv->regs->cont, PCH_CTRL_IE);
267 268 269
		break;

	case PCH_CAN_ALL:
T
Tomoya 已提交
270
		pch_can_bit_set(&priv->regs->cont, PCH_CTRL_IE_SIE_EIE);
271 272 273
		break;

	case PCH_CAN_NONE:
T
Tomoya 已提交
274
		pch_can_bit_clear(&priv->regs->cont, PCH_CTRL_IE_SIE_EIE);
275 276 277 278 279 280 281 282
		break;

	default:
		dev_err(&priv->ndev->dev, "Invalid interrupt number.\n");
		break;
	}
}

283
static void pch_can_set_rxtx(struct pch_can_priv *priv, u32 buff_num,
T
Tomoya 已提交
284
			     int set, enum pch_ifreg dir)
285
{
286 287 288 289 290 291
	u32 ie;

	if (dir)
		ie = PCH_IF_MCONT_TXIE;
	else
		ie = PCH_IF_MCONT_RXIE;
292 293

	/* Reading the receive buffer data from RAM to Interface1 registers */
294
	iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[dir].cmask);
T
Tomoya 已提交
295
	pch_can_rw_msg_obj(&priv->regs->ifregs[dir].creq, buff_num);
296 297

	/* Setting the IF1MASK1 register to access MsgVal and RxIE bits */
T
Tomoya 已提交
298
	iowrite32(PCH_CMASK_RDWR | PCH_CMASK_ARB | PCH_CMASK_CTRL,
299
		  &priv->regs->ifregs[dir].cmask);
300

T
Tomoya 已提交
301
	if (set) {
302
		/* Setting the MsgVal and RxIE bits */
303 304
		pch_can_bit_set(&priv->regs->ifregs[dir].mcont, ie);
		pch_can_bit_set(&priv->regs->ifregs[dir].id2, PCH_ID_MSGVAL);
305

T
Tomoya 已提交
306
	} else {
307
		/* Resetting the MsgVal and RxIE bits */
308 309
		pch_can_bit_clear(&priv->regs->ifregs[dir].mcont, ie);
		pch_can_bit_clear(&priv->regs->ifregs[dir].id2, PCH_ID_MSGVAL);
310 311
	}

T
Tomoya 已提交
312
	pch_can_rw_msg_obj(&priv->regs->ifregs[dir].creq, buff_num);
313 314
}

T
Tomoya 已提交
315
static void pch_can_set_rx_all(struct pch_can_priv *priv, int set)
316 317 318 319
{
	int i;

	/* Traversing to obtain the object configured as receivers. */
320 321
	for (i = PCH_RX_OBJ_START; i <= PCH_RX_OBJ_END; i++)
		pch_can_set_rxtx(priv, i, set, PCH_RX_IFREG);
322 323
}

T
Tomoya 已提交
324
static void pch_can_set_tx_all(struct pch_can_priv *priv, int set)
325 326 327 328
{
	int i;

	/* Traversing to obtain the object configured as transmit object. */
329 330
	for (i = PCH_TX_OBJ_START; i <= PCH_TX_OBJ_END; i++)
		pch_can_set_rxtx(priv, i, set, PCH_TX_IFREG);
331 332
}

T
Tomoya 已提交
333
static u32 pch_can_int_pending(struct pch_can_priv *priv)
334 335 336 337
{
	return ioread32(&priv->regs->intr) & 0xffff;
}

T
Tomoya 已提交
338
static void pch_can_clear_if_buffers(struct pch_can_priv *priv)
339
{
T
Tomoya 已提交
340
	int i; /* Msg Obj ID (1~32) */
341

T
Tomoya 已提交
342
	for (i = PCH_RX_OBJ_START; i <= PCH_TX_OBJ_END; i++) {
343 344 345 346 347 348
		iowrite32(PCH_CMASK_RX_TX_SET, &priv->regs->ifregs[0].cmask);
		iowrite32(0xffff, &priv->regs->ifregs[0].mask1);
		iowrite32(0xffff, &priv->regs->ifregs[0].mask2);
		iowrite32(0x0, &priv->regs->ifregs[0].id1);
		iowrite32(0x0, &priv->regs->ifregs[0].id2);
		iowrite32(0x0, &priv->regs->ifregs[0].mcont);
T
Tomoya 已提交
349 350 351 352
		iowrite32(0x0, &priv->regs->ifregs[0].data[0]);
		iowrite32(0x0, &priv->regs->ifregs[0].data[1]);
		iowrite32(0x0, &priv->regs->ifregs[0].data[2]);
		iowrite32(0x0, &priv->regs->ifregs[0].data[3]);
T
Tomoya 已提交
353 354
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_MASK |
			  PCH_CMASK_ARB | PCH_CMASK_CTRL,
355
			  &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
356
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, i);
357 358 359 360 361 362 363
	}
}

static void pch_can_config_rx_tx_buffers(struct pch_can_priv *priv)
{
	int i;

364 365 366
	for (i = PCH_RX_OBJ_START; i <= PCH_RX_OBJ_END; i++) {
		iowrite32(PCH_CMASK_RX_TX_GET,
			&priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
367
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, i);
368

369 370
		iowrite32(0x0, &priv->regs->ifregs[0].id1);
		iowrite32(0x0, &priv->regs->ifregs[0].id2);
371

372 373
		pch_can_bit_set(&priv->regs->ifregs[0].mcont,
				PCH_IF_MCONT_UMASK);
374

375 376 377 378 379 380
		/* Set FIFO mode set to 0 except last Rx Obj*/
		pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
				  PCH_IF_MCONT_EOB);
		/* In case FIFO mode, Last EoB of Rx Obj must be 1 */
		if (i == PCH_RX_OBJ_END)
			pch_can_bit_set(&priv->regs->ifregs[0].mcont,
T
Tomoya 已提交
381 382 383
					PCH_IF_MCONT_EOB);
		else
			pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
T
Tomoya 已提交
384
					  PCH_IF_MCONT_EOB);
385

386 387 388
		iowrite32(0, &priv->regs->ifregs[0].mask1);
		pch_can_bit_clear(&priv->regs->ifregs[0].mask2,
				  0x1fff | PCH_MASK2_MDIR_MXTD);
389

390 391 392 393
		/* Setting CMASK for writing */
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_MASK |
			  PCH_CMASK_ARB | PCH_CMASK_CTRL,
			  &priv->regs->ifregs[0].cmask);
394

T
Tomoya 已提交
395
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, i);
396
	}
397

398 399 400
	for (i = PCH_TX_OBJ_START; i <= PCH_TX_OBJ_END; i++) {
		iowrite32(PCH_CMASK_RX_TX_GET,
			&priv->regs->ifregs[1].cmask);
T
Tomoya 已提交
401
		pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, i);
402

403 404 405 406
		/* Resetting DIR bit for reception */
		iowrite32(0x0, &priv->regs->ifregs[1].id1);
		iowrite32(0x0, &priv->regs->ifregs[1].id2);
		pch_can_bit_set(&priv->regs->ifregs[1].id2, PCH_ID2_DIR);
407

408 409
		/* Setting EOB bit for transmitter */
		iowrite32(PCH_IF_MCONT_EOB, &priv->regs->ifregs[1].mcont);
410

411 412 413 414 415 416 417 418 419 420 421
		pch_can_bit_set(&priv->regs->ifregs[1].mcont,
				PCH_IF_MCONT_UMASK);

		iowrite32(0, &priv->regs->ifregs[1].mask1);
		pch_can_bit_clear(&priv->regs->ifregs[1].mask2, 0x1fff);

		/* Setting CMASK for writing */
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_MASK |
			  PCH_CMASK_ARB | PCH_CMASK_CTRL,
			  &priv->regs->ifregs[1].cmask);

T
Tomoya 已提交
422
		pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, i);
423 424 425 426 427 428 429 430 431
	}
}

static void pch_can_init(struct pch_can_priv *priv)
{
	/* Stopping the Can device. */
	pch_can_set_run_mode(priv, PCH_CAN_STOP);

	/* Clearing all the message object buffers. */
T
Tomoya 已提交
432
	pch_can_clear_if_buffers(priv);
433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449

	/* Configuring the respective message object as either rx/tx object. */
	pch_can_config_rx_tx_buffers(priv);

	/* Enabling the interrupts. */
	pch_can_set_int_enables(priv, PCH_CAN_ALL);
}

static void pch_can_release(struct pch_can_priv *priv)
{
	/* Stooping the CAN device. */
	pch_can_set_run_mode(priv, PCH_CAN_STOP);

	/* Disabling the interrupts. */
	pch_can_set_int_enables(priv, PCH_CAN_NONE);

	/* Disabling all the receive object. */
450
	pch_can_set_rx_all(priv, 0);
451 452

	/* Disabling all the transmit object. */
453
	pch_can_set_tx_all(priv, 0);
454 455 456 457 458
}

/* This function clears interrupt(s) from the CAN device. */
static void pch_can_int_clr(struct pch_can_priv *priv, u32 mask)
{
T
Tomoya 已提交
459
	if (mask == PCH_STATUS_INT) {
460 461 462 463 464
		ioread32(&priv->regs->stat);
		return;
	}

	/* Clear interrupt for transmit object */
465 466 467 468 469 470 471 472 473 474 475 476
	if ((mask >= PCH_RX_OBJ_START) && (mask <= PCH_RX_OBJ_END)) {
		/* Setting CMASK for clearing the reception interrupts. */
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_CTRL | PCH_CMASK_ARB,
			  &priv->regs->ifregs[0].cmask);

		/* Clearing the Dir bit. */
		pch_can_bit_clear(&priv->regs->ifregs[0].id2, PCH_ID2_DIR);

		/* Clearing NewDat & IntPnd */
		pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
				  PCH_IF_MCONT_NEWDAT | PCH_IF_MCONT_INTPND);

T
Tomoya 已提交
477
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, mask);
478
	} else if ((mask >= PCH_TX_OBJ_START) && (mask <= PCH_TX_OBJ_END)) {
479 480
		/* Setting CMASK for clearing interrupts for
					 frame transmission. */
T
Tomoya 已提交
481
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_CTRL | PCH_CMASK_ARB,
482
			  &priv->regs->ifregs[1].cmask);
483 484

		/* Resetting the ID registers. */
485
		pch_can_bit_set(&priv->regs->ifregs[1].id2,
T
Tomoya 已提交
486
			       PCH_ID2_DIR | (0x7ff << 2));
487
		iowrite32(0x0, &priv->regs->ifregs[1].id1);
488 489

		/* Claring NewDat, TxRqst & IntPnd */
490
		pch_can_bit_clear(&priv->regs->ifregs[1].mcont,
T
Tomoya 已提交
491 492
				  PCH_IF_MCONT_NEWDAT | PCH_IF_MCONT_INTPND |
				  PCH_IF_MCONT_TXRQXT);
T
Tomoya 已提交
493
		pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, mask);
494 495 496 497 498 499 500 501 502 503 504 505 506 507 508
	}
}

static void pch_can_reset(struct pch_can_priv *priv)
{
	/* write to sw reset register */
	iowrite32(1, &priv->regs->srst);
	iowrite32(0, &priv->regs->srst);
}

static void pch_can_error(struct net_device *ndev, u32 status)
{
	struct sk_buff *skb;
	struct pch_can_priv *priv = netdev_priv(ndev);
	struct can_frame *cf;
T
Tomoya 已提交
509
	u32 errc, lec;
510 511 512 513 514 515 516 517
	struct net_device_stats *stats = &(priv->ndev->stats);
	enum can_state state = priv->can.state;

	skb = alloc_can_err_skb(ndev, &cf);
	if (!skb)
		return;

	if (status & PCH_BUS_OFF) {
518 519
		pch_can_set_tx_all(priv, 0);
		pch_can_set_rx_all(priv, 0);
520 521 522 523 524 525 526 527 528 529 530 531 532
		state = CAN_STATE_BUS_OFF;
		cf->can_id |= CAN_ERR_BUSOFF;
		can_bus_off(ndev);
		pch_can_set_run_mode(priv, PCH_CAN_RUN);
		dev_err(&ndev->dev, "%s -> Bus Off occurres.\n", __func__);
	}

	/* Warning interrupt. */
	if (status & PCH_EWARN) {
		state = CAN_STATE_ERROR_WARNING;
		priv->can.can_stats.error_warning++;
		cf->can_id |= CAN_ERR_CRTL;
		errc = ioread32(&priv->regs->errc);
T
Tomoya 已提交
533
		if (((errc & PCH_REC) >> 8) > 96)
534
			cf->data[1] |= CAN_ERR_CRTL_RX_WARNING;
T
Tomoya 已提交
535
		if ((errc & PCH_TEC) > 96)
536 537 538 539 540 541 542 543 544 545
			cf->data[1] |= CAN_ERR_CRTL_TX_WARNING;
		dev_warn(&ndev->dev,
			"%s -> Error Counter is more than 96.\n", __func__);
	}
	/* Error passive interrupt. */
	if (status & PCH_EPASSIV) {
		priv->can.can_stats.error_passive++;
		state = CAN_STATE_ERROR_PASSIVE;
		cf->can_id |= CAN_ERR_CRTL;
		errc = ioread32(&priv->regs->errc);
T
Tomoya 已提交
546
		if (((errc & PCH_REC) >> 8) > 127)
547
			cf->data[1] |= CAN_ERR_CRTL_RX_PASSIVE;
T
Tomoya 已提交
548
		if ((errc & PCH_TEC) > 127)
549 550 551 552 553
			cf->data[1] |= CAN_ERR_CRTL_TX_PASSIVE;
		dev_err(&ndev->dev,
			"%s -> CAN controller is ERROR PASSIVE .\n", __func__);
	}

T
Tomoya 已提交
554 555 556 557
	lec = status & PCH_LEC_ALL;
	switch (lec) {
	case PCH_STUF_ERR:
		cf->data[2] |= CAN_ERR_PROT_STUFF;
558 559
		priv->can.can_stats.bus_error++;
		stats->rx_errors++;
T
Tomoya 已提交
560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584
		break;
	case PCH_FORM_ERR:
		cf->data[2] |= CAN_ERR_PROT_FORM;
		priv->can.can_stats.bus_error++;
		stats->rx_errors++;
		break;
	case PCH_ACK_ERR:
		cf->can_id |= CAN_ERR_ACK;
		priv->can.can_stats.bus_error++;
		stats->rx_errors++;
		break;
	case PCH_BIT1_ERR:
	case PCH_BIT0_ERR:
		cf->data[2] |= CAN_ERR_PROT_BIT;
		priv->can.can_stats.bus_error++;
		stats->rx_errors++;
		break;
	case PCH_CRC_ERR:
		cf->data[2] |= CAN_ERR_PROT_LOC_CRC_SEQ |
			       CAN_ERR_PROT_LOC_CRC_DEL;
		priv->can.can_stats.bus_error++;
		stats->rx_errors++;
		break;
	case PCH_LEC_ALL: /* Written by CPU. No error status */
		break;
585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605
	}

	priv->can.state = state;
	netif_rx(skb);

	stats->rx_packets++;
	stats->rx_bytes += cf->can_dlc;
}

static irqreturn_t pch_can_interrupt(int irq, void *dev_id)
{
	struct net_device *ndev = (struct net_device *)dev_id;
	struct pch_can_priv *priv = netdev_priv(ndev);

	pch_can_set_int_enables(priv, PCH_CAN_NONE);

	napi_schedule(&priv->napi);

	return IRQ_HANDLED;
}

T
Tomoya 已提交
606 607 608 609 610 611 612 613 614 615 616 617
static void pch_fifo_thresh(struct pch_can_priv *priv, int obj_id)
{
	if (obj_id < PCH_FIFO_THRESH) {
		iowrite32(PCH_CMASK_RDWR | PCH_CMASK_CTRL |
			  PCH_CMASK_ARB, &priv->regs->ifregs[0].cmask);

		/* Clearing the Dir bit. */
		pch_can_bit_clear(&priv->regs->ifregs[0].id2, PCH_ID2_DIR);

		/* Clearing NewDat & IntPnd */
		pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
				  PCH_IF_MCONT_INTPND);
T
Tomoya 已提交
618
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, obj_id);
T
Tomoya 已提交
619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
	} else if (obj_id > PCH_FIFO_THRESH) {
		pch_can_int_clr(priv, obj_id);
	} else if (obj_id == PCH_FIFO_THRESH) {
		int cnt;
		for (cnt = 0; cnt < PCH_FIFO_THRESH; cnt++)
			pch_can_int_clr(priv, cnt + 1);
	}
}

static void pch_can_rx_msg_lost(struct net_device *ndev, int obj_id)
{
	struct pch_can_priv *priv = netdev_priv(ndev);
	struct net_device_stats *stats = &(priv->ndev->stats);
	struct sk_buff *skb;
	struct can_frame *cf;

	netdev_dbg(priv->ndev, "Msg Obj is overwritten.\n");
	pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
			  PCH_IF_MCONT_MSGLOST);
	iowrite32(PCH_CMASK_RDWR | PCH_CMASK_CTRL,
		  &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
640
	pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, obj_id);
T
Tomoya 已提交
641 642 643 644 645 646 647 648 649 650 651 652 653 654

	skb = alloc_can_err_skb(ndev, &cf);
	if (!skb)
		return;

	cf->can_id |= CAN_ERR_CRTL;
	cf->data[1] = CAN_ERR_CRTL_RX_OVERFLOW;
	stats->rx_over_errors++;
	stats->rx_errors++;

	netif_receive_skb(skb);
}

static int pch_can_rx_normal(struct net_device *ndev, u32 obj_num, int quota)
655 656 657 658 659 660 661 662
{
	u32 reg;
	canid_t id;
	int rcv_pkts = 0;
	struct sk_buff *skb;
	struct can_frame *cf;
	struct pch_can_priv *priv = netdev_priv(ndev);
	struct net_device_stats *stats = &(priv->ndev->stats);
T
Tomoya 已提交
663 664
	int i;
	u32 id2;
T
Tomoya 已提交
665
	u16 data_reg;
666

T
Tomoya 已提交
667 668 669
	do {
		/* Reading the messsage object from the Message RAM */
		iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
670
		pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, obj_num);
671

T
Tomoya 已提交
672 673 674 675 676
		/* Reading the MCONT register. */
		reg = ioread32(&priv->regs->ifregs[0].mcont);

		if (reg & PCH_IF_MCONT_EOB)
			break;
677 678

		/* If MsgLost bit set. */
T
Tomoya 已提交
679
		if (reg & PCH_IF_MCONT_MSGLOST) {
T
Tomoya 已提交
680
			pch_can_rx_msg_lost(ndev, obj_num);
681
			rcv_pkts++;
T
Tomoya 已提交
682 683 684 685 686 687
			quota--;
			obj_num++;
			continue;
		} else if (!(reg & PCH_IF_MCONT_NEWDAT)) {
			obj_num++;
			continue;
688 689 690 691 692 693 694
		}

		skb = alloc_can_skb(priv->ndev, &cf);
		if (!skb)
			return -ENOMEM;

		/* Get Received data */
T
Tomoya 已提交
695 696
		id2 = ioread32(&priv->regs->ifregs[0].id2);
		if (id2 & PCH_ID2_XTD) {
697
			id = (ioread32(&priv->regs->ifregs[0].id1) & 0xffff);
T
Tomoya 已提交
698 699
			id |= (((id2) & 0x1fff) << 16);
			cf->can_id = id | CAN_EFF_FLAG;
700
		} else {
T
Tomoya 已提交
701 702
			id = (id2 >> 2) & CAN_SFF_MASK;
			cf->can_id = id;
703 704
		}

T
Tomoya 已提交
705
		if (id2 & PCH_ID2_DIR)
706
			cf->can_id |= CAN_RTR_FLAG;
T
Tomoya 已提交
707 708 709

		cf->can_dlc = get_can_dlc((ioread32(&priv->regs->
						    ifregs[0].mcont)) & 0xF);
710

T
Tomoya 已提交
711 712 713 714
		for (i = 0; i < cf->can_dlc; i += 2) {
			data_reg = ioread16(&priv->regs->ifregs[0].data[i / 2]);
			cf->data[i] = data_reg;
			cf->data[i + 1] = data_reg >> 8;
715 716 717 718 719
		}

		netif_receive_skb(skb);
		rcv_pkts++;
		stats->rx_packets++;
T
Tomoya 已提交
720
		quota--;
721 722
		stats->rx_bytes += cf->can_dlc;

T
Tomoya 已提交
723 724 725
		pch_fifo_thresh(priv, obj_num);
		obj_num++;
	} while (quota > 0);
726 727 728

	return rcv_pkts;
}
T
Tomoya 已提交
729 730

static void pch_can_tx_complete(struct net_device *ndev, u32 int_stat)
731 732 733 734
{
	struct pch_can_priv *priv = netdev_priv(ndev);
	struct net_device_stats *stats = &(priv->ndev->stats);
	u32 dlc;
T
Tomoya 已提交
735 736 737 738

	can_get_echo_skb(ndev, int_stat - PCH_RX_OBJ_END - 1);
	iowrite32(PCH_CMASK_RX_TX_GET | PCH_CMASK_CLRINTPND,
		  &priv->regs->ifregs[1].cmask);
T
Tomoya 已提交
739
	pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, int_stat);
T
Tomoya 已提交
740 741 742 743 744 745 746 747
	dlc = get_can_dlc(ioread32(&priv->regs->ifregs[1].mcont) &
			  PCH_IF_MCONT_DLC);
	stats->tx_bytes += dlc;
	stats->tx_packets++;
	if (int_stat == PCH_TX_OBJ_END)
		netif_wake_queue(ndev);
}

T
Tomoya 已提交
748
static int pch_can_poll(struct napi_struct *napi, int quota)
T
Tomoya 已提交
749 750 751
{
	struct net_device *ndev = napi->dev;
	struct pch_can_priv *priv = netdev_priv(ndev);
752 753 754 755 756 757
	u32 int_stat;
	int rcv_pkts = 0;
	u32 reg_stat;

	int_stat = pch_can_int_pending(priv);
	if (!int_stat)
T
Tomoya 已提交
758
		goto end;
759

T
Tomoya 已提交
760
	if ((int_stat == PCH_STATUS_INT) && (quota > 0)) {
761 762
		reg_stat = ioread32(&priv->regs->stat);
		if (reg_stat & (PCH_BUS_OFF | PCH_LEC_ALL)) {
T
Tomoya 已提交
763 764
			if (reg_stat & PCH_BUS_OFF ||
			   (reg_stat & PCH_LEC_ALL) != PCH_LEC_ALL) {
765
				pch_can_error(ndev, reg_stat);
T
Tomoya 已提交
766 767
				quota--;
			}
768 769
		}

T
Tomoya 已提交
770
		if (reg_stat & PCH_TX_OK)
771 772 773 774 775 776 777 778
			pch_can_bit_clear(&priv->regs->stat, PCH_TX_OK);

		if (reg_stat & PCH_RX_OK)
			pch_can_bit_clear(&priv->regs->stat, PCH_RX_OK);

		int_stat = pch_can_int_pending(priv);
	}

T
Tomoya 已提交
779 780 781
	if (quota == 0)
		goto end;

782
	if ((int_stat >= PCH_RX_OBJ_START) && (int_stat <= PCH_RX_OBJ_END)) {
T
Tomoya 已提交
783
		rcv_pkts += pch_can_rx_normal(ndev, int_stat, quota);
T
Tomoya 已提交
784 785 786
		quota -= rcv_pkts;
		if (quota < 0)
			goto end;
787 788 789
	} else if ((int_stat >= PCH_TX_OBJ_START) &&
		   (int_stat <= PCH_TX_OBJ_END)) {
		/* Handle transmission interrupt */
T
Tomoya 已提交
790
		pch_can_tx_complete(ndev, int_stat);
791 792
	}

T
Tomoya 已提交
793
end:
794 795 796 797 798 799 800 801 802 803 804 805 806 807 808
	napi_complete(napi);
	pch_can_set_int_enables(priv, PCH_CAN_ALL);

	return rcv_pkts;
}

static int pch_set_bittiming(struct net_device *ndev)
{
	struct pch_can_priv *priv = netdev_priv(ndev);
	const struct can_bittiming *bt = &priv->can.bittiming;
	u32 canbit;
	u32 bepe;
	u32 brp;

	/* Setting the CCE bit for accessing the Can Timing register. */
T
Tomoya 已提交
809
	pch_can_bit_set(&priv->regs->cont, PCH_CTRL_CCE);
810 811

	brp = (bt->tq) / (1000000000/PCH_CAN_CLK) - 1;
T
Tomoya 已提交
812
	canbit = brp & PCH_MSK_BITT_BRP;
T
Tomoya 已提交
813 814 815 816
	canbit |= (bt->sjw - 1) << PCH_BIT_SJW_SHIFT;
	canbit |= (bt->phase_seg1 + bt->prop_seg - 1) << PCH_BIT_TSEG1_SHIFT;
	canbit |= (bt->phase_seg2 - 1) << PCH_BIT_TSEG2_SHIFT;
	bepe = (brp & PCH_MSK_BRPE_BRPE) >> PCH_BIT_BRPE_BRPE_SHIFT;
817 818
	iowrite32(canbit, &priv->regs->bitt);
	iowrite32(bepe, &priv->regs->brpe);
T
Tomoya 已提交
819
	pch_can_bit_clear(&priv->regs->cont, PCH_CTRL_CCE);
820 821 822 823 824 825 826 827 828 829 830 831 832 833

	return 0;
}

static void pch_can_start(struct net_device *ndev)
{
	struct pch_can_priv *priv = netdev_priv(ndev);

	if (priv->can.state != CAN_STATE_STOPPED)
		pch_can_reset(priv);

	pch_set_bittiming(ndev);
	pch_can_set_optmode(priv);

834 835
	pch_can_set_tx_all(priv, 1);
	pch_can_set_rx_all(priv, 1);
836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927

	/* Setting the CAN to run mode. */
	pch_can_set_run_mode(priv, PCH_CAN_RUN);

	priv->can.state = CAN_STATE_ERROR_ACTIVE;

	return;
}

static int pch_can_do_set_mode(struct net_device *ndev, enum can_mode mode)
{
	int ret = 0;

	switch (mode) {
	case CAN_MODE_START:
		pch_can_start(ndev);
		netif_wake_queue(ndev);
		break;
	default:
		ret = -EOPNOTSUPP;
		break;
	}

	return ret;
}

static int pch_can_open(struct net_device *ndev)
{
	struct pch_can_priv *priv = netdev_priv(ndev);
	int retval;

	retval = pci_enable_msi(priv->dev);
	if (retval) {
		dev_info(&ndev->dev, "PCH CAN opened without MSI\n");
		priv->use_msi = 0;
	} else {
		dev_info(&ndev->dev, "PCH CAN opened with MSI\n");
		priv->use_msi = 1;
	}

	/* Regsitering the interrupt. */
	retval = request_irq(priv->dev->irq, pch_can_interrupt, IRQF_SHARED,
			     ndev->name, ndev);
	if (retval) {
		dev_err(&ndev->dev, "request_irq failed.\n");
		goto req_irq_err;
	}

	/* Open common can device */
	retval = open_candev(ndev);
	if (retval) {
		dev_err(ndev->dev.parent, "open_candev() failed %d\n", retval);
		goto err_open_candev;
	}

	pch_can_init(priv);
	pch_can_start(ndev);
	napi_enable(&priv->napi);
	netif_start_queue(ndev);

	return 0;

err_open_candev:
	free_irq(priv->dev->irq, ndev);
req_irq_err:
	if (priv->use_msi)
		pci_disable_msi(priv->dev);

	pch_can_release(priv);

	return retval;
}

static int pch_close(struct net_device *ndev)
{
	struct pch_can_priv *priv = netdev_priv(ndev);

	netif_stop_queue(ndev);
	napi_disable(&priv->napi);
	pch_can_release(priv);
	free_irq(priv->dev->irq, ndev);
	if (priv->use_msi)
		pci_disable_msi(priv->dev);
	close_candev(ndev);
	priv->can.state = CAN_STATE_STOPPED;
	return 0;
}

static netdev_tx_t pch_xmit(struct sk_buff *skb, struct net_device *ndev)
{
	struct pch_can_priv *priv = netdev_priv(ndev);
	struct can_frame *cf = (struct can_frame *)skb->data;
T
Tomoya 已提交
928
	int tx_obj_no;
T
Tomoya 已提交
929
	int i;
930 931 932 933

	if (can_dropped_invalid_skb(ndev, skb))
		return NETDEV_TX_OK;

T
Tomoya 已提交
934 935 936
	if (priv->tx_obj == PCH_TX_OBJ_END) {
		if (ioread32(&priv->regs->treq2) & PCH_TREQ2_TX_MASK)
			netif_stop_queue(ndev);
937

T
Tomoya 已提交
938
		tx_obj_no = priv->tx_obj;
T
Tomoya 已提交
939
		priv->tx_obj = PCH_TX_OBJ_START;
940
	} else {
T
Tomoya 已提交
941
		tx_obj_no = priv->tx_obj;
T
Tomoya 已提交
942
		priv->tx_obj++;
943 944 945
	}

	/* Reading the Msg Obj from the Msg RAM to the Interface register. */
946
	iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[1].cmask);
T
Tomoya 已提交
947
	pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, tx_obj_no);
948 949

	/* Setting the CMASK register. */
950
	pch_can_bit_set(&priv->regs->ifregs[1].cmask, PCH_CMASK_ALL);
951 952

	/* If ID extended is set. */
953 954
	pch_can_bit_clear(&priv->regs->ifregs[1].id1, 0xffff);
	pch_can_bit_clear(&priv->regs->ifregs[1].id2, 0x1fff | PCH_ID2_XTD);
955
	if (cf->can_id & CAN_EFF_FLAG) {
956 957 958
		pch_can_bit_set(&priv->regs->ifregs[1].id1,
				cf->can_id & 0xffff);
		pch_can_bit_set(&priv->regs->ifregs[1].id2,
T
Tomoya 已提交
959
				((cf->can_id >> 16) & 0x1fff) | PCH_ID2_XTD);
960
	} else {
961 962
		pch_can_bit_set(&priv->regs->ifregs[1].id1, 0);
		pch_can_bit_set(&priv->regs->ifregs[1].id2,
963 964 965 966 967
				(cf->can_id & CAN_SFF_MASK) << 2);
	}

	/* If remote frame has to be transmitted.. */
	if (cf->can_id & CAN_RTR_FLAG)
968
		pch_can_bit_clear(&priv->regs->ifregs[1].id2, PCH_ID2_DIR);
969

T
Tomoya 已提交
970 971 972 973
	/* Copy data to register */
	for (i = 0; i < cf->can_dlc; i += 2) {
		iowrite16(cf->data[i] | (cf->data[i + 1] << 8),
			  &priv->regs->ifregs[1].data[i / 2]);
974 975
	}

T
Tomoya 已提交
976
	can_put_echo_skb(skb, ndev, tx_obj_no - PCH_RX_OBJ_END - 1);
977 978

	/* Updating the size of the data. */
979 980
	pch_can_bit_clear(&priv->regs->ifregs[1].mcont, 0x0f);
	pch_can_bit_set(&priv->regs->ifregs[1].mcont, cf->can_dlc);
981 982

	/* Clearing IntPend, NewDat & TxRqst */
983
	pch_can_bit_clear(&priv->regs->ifregs[1].mcont,
T
Tomoya 已提交
984 985
			  PCH_IF_MCONT_NEWDAT | PCH_IF_MCONT_INTPND |
			  PCH_IF_MCONT_TXRQXT);
986 987

	/* Setting NewDat, TxRqst bits */
988
	pch_can_bit_set(&priv->regs->ifregs[1].mcont,
T
Tomoya 已提交
989
			PCH_IF_MCONT_NEWDAT | PCH_IF_MCONT_TXRQXT);
990

T
Tomoya 已提交
991
	pch_can_rw_msg_obj(&priv->regs->ifregs[1].creq, tx_obj_no);
992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016

	return NETDEV_TX_OK;
}

static const struct net_device_ops pch_can_netdev_ops = {
	.ndo_open		= pch_can_open,
	.ndo_stop		= pch_close,
	.ndo_start_xmit		= pch_xmit,
};

static void __devexit pch_can_remove(struct pci_dev *pdev)
{
	struct net_device *ndev = pci_get_drvdata(pdev);
	struct pch_can_priv *priv = netdev_priv(ndev);

	unregister_candev(priv->ndev);
	free_candev(priv->ndev);
	pci_iounmap(pdev, priv->regs);
	pci_release_regions(pdev);
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);
	pch_can_reset(priv);
}

#ifdef CONFIG_PM
T
Tomoya 已提交
1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027
static void pch_can_set_int_custom(struct pch_can_priv *priv)
{
	/* Clearing the IE, SIE and EIE bits of Can control register. */
	pch_can_bit_clear(&priv->regs->cont, PCH_CTRL_IE_SIE_EIE);

	/* Appropriately setting them. */
	pch_can_bit_set(&priv->regs->cont,
			((priv->int_enables & PCH_MSK_CTRL_IE_SIE_EIE) << 1));
}

/* This function retrieves interrupt enabled for the CAN device. */
T
Tomoya 已提交
1028
static u32 pch_can_get_int_enables(struct pch_can_priv *priv)
T
Tomoya 已提交
1029 1030
{
	/* Obtaining the status of IE, SIE and EIE interrupt bits. */
T
Tomoya 已提交
1031
	return (ioread32(&priv->regs->cont) & PCH_CTRL_IE_SIE_EIE) >> 1;
T
Tomoya 已提交
1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044
}

static u32 pch_can_get_rxtx_ir(struct pch_can_priv *priv, u32 buff_num,
			       enum pch_ifreg dir)
{
	u32 ie, enable;

	if (dir)
		ie = PCH_IF_MCONT_RXIE;
	else
		ie = PCH_IF_MCONT_TXIE;

	iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[dir].cmask);
T
Tomoya 已提交
1045
	pch_can_rw_msg_obj(&priv->regs->ifregs[dir].creq, buff_num);
T
Tomoya 已提交
1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056

	if (((ioread32(&priv->regs->ifregs[dir].id2)) & PCH_ID_MSGVAL) &&
			((ioread32(&priv->regs->ifregs[dir].mcont)) & ie)) {
		enable = 1;
	} else {
		enable = 0;
	}
	return enable;
}

static void pch_can_set_rx_buffer_link(struct pch_can_priv *priv,
T
Tomoya 已提交
1057
				       u32 buffer_num, int set)
T
Tomoya 已提交
1058 1059
{
	iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
1060
	pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, buffer_num);
T
Tomoya 已提交
1061 1062
	iowrite32(PCH_CMASK_RDWR | PCH_CMASK_CTRL,
		  &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
1063
	if (set)
T
Tomoya 已提交
1064 1065 1066 1067 1068
		pch_can_bit_clear(&priv->regs->ifregs[0].mcont,
				  PCH_IF_MCONT_EOB);
	else
		pch_can_bit_set(&priv->regs->ifregs[0].mcont, PCH_IF_MCONT_EOB);

T
Tomoya 已提交
1069
	pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, buffer_num);
T
Tomoya 已提交
1070 1071
}

T
Tomoya 已提交
1072
static u32 pch_can_get_rx_buffer_link(struct pch_can_priv *priv, u32 buffer_num)
T
Tomoya 已提交
1073
{
T
Tomoya 已提交
1074 1075
	u32 link;

T
Tomoya 已提交
1076
	iowrite32(PCH_CMASK_RX_TX_GET, &priv->regs->ifregs[0].cmask);
T
Tomoya 已提交
1077
	pch_can_rw_msg_obj(&priv->regs->ifregs[0].creq, buffer_num);
T
Tomoya 已提交
1078 1079

	if (ioread32(&priv->regs->ifregs[0].mcont) & PCH_IF_MCONT_EOB)
T
Tomoya 已提交
1080
		link = 0;
T
Tomoya 已提交
1081
	else
T
Tomoya 已提交
1082 1083
		link = 1;
	return link;
T
Tomoya 已提交
1084 1085 1086 1087 1088
}

static int pch_can_get_buffer_status(struct pch_can_priv *priv)
{
	return (ioread32(&priv->regs->treq1) & 0xffff) |
T
Tomoya 已提交
1089
	       (ioread32(&priv->regs->treq2) << 16);
T
Tomoya 已提交
1090 1091
}

1092 1093 1094 1095 1096
static int pch_can_suspend(struct pci_dev *pdev, pm_message_t state)
{
	int i;			/* Counter variable. */
	int retval;		/* Return value. */
	u32 buf_stat;	/* Variable for reading the transmit buffer status. */
T
Tomoya 已提交
1097
	int counter = PCH_COUNTER_LIMIT;
1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119

	struct net_device *dev = pci_get_drvdata(pdev);
	struct pch_can_priv *priv = netdev_priv(dev);

	/* Stop the CAN controller */
	pch_can_set_run_mode(priv, PCH_CAN_STOP);

	/* Indicate that we are aboutto/in suspend */
	priv->can.state = CAN_STATE_SLEEPING;

	/* Waiting for all transmission to complete. */
	while (counter) {
		buf_stat = pch_can_get_buffer_status(priv);
		if (!buf_stat)
			break;
		counter--;
		udelay(1);
	}
	if (!counter)
		dev_err(&pdev->dev, "%s -> Transmission time out.\n", __func__);

	/* Save interrupt configuration and then disable them */
T
Tomoya 已提交
1120
	priv->int_enables = pch_can_get_int_enables(priv);
1121 1122 1123
	pch_can_set_int_enables(priv, PCH_CAN_DISABLE);

	/* Save Tx buffer enable state */
1124 1125
	for (i = PCH_TX_OBJ_START; i <= PCH_TX_OBJ_END; i++)
		priv->tx_enable[i] = pch_can_get_rxtx_ir(priv, i, PCH_TX_IFREG);
1126 1127

	/* Disable all Transmit buffers */
1128
	pch_can_set_tx_all(priv, 0);
1129 1130

	/* Save Rx buffer enable state */
1131 1132
	for (i = PCH_RX_OBJ_START; i <= PCH_RX_OBJ_END; i++) {
		priv->rx_enable[i] = pch_can_get_rxtx_ir(priv, i, PCH_RX_IFREG);
T
Tomoya 已提交
1133
		priv->rx_link[i] = pch_can_get_rx_buffer_link(priv, i);
1134 1135 1136
	}

	/* Disable all Receive buffers */
1137
	pch_can_set_rx_all(priv, 0);
1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184
	retval = pci_save_state(pdev);
	if (retval) {
		dev_err(&pdev->dev, "pci_save_state failed.\n");
	} else {
		pci_enable_wake(pdev, PCI_D3hot, 0);
		pci_disable_device(pdev);
		pci_set_power_state(pdev, pci_choose_state(pdev, state));
	}

	return retval;
}

static int pch_can_resume(struct pci_dev *pdev)
{
	int i;			/* Counter variable. */
	int retval;		/* Return variable. */
	struct net_device *dev = pci_get_drvdata(pdev);
	struct pch_can_priv *priv = netdev_priv(dev);

	pci_set_power_state(pdev, PCI_D0);
	pci_restore_state(pdev);
	retval = pci_enable_device(pdev);
	if (retval) {
		dev_err(&pdev->dev, "pci_enable_device failed.\n");
		return retval;
	}

	pci_enable_wake(pdev, PCI_D3hot, 0);

	priv->can.state = CAN_STATE_ERROR_ACTIVE;

	/* Disabling all interrupts. */
	pch_can_set_int_enables(priv, PCH_CAN_DISABLE);

	/* Setting the CAN device in Stop Mode. */
	pch_can_set_run_mode(priv, PCH_CAN_STOP);

	/* Configuring the transmit and receive buffers. */
	pch_can_config_rx_tx_buffers(priv);

	/* Restore the CAN state */
	pch_set_bittiming(dev);

	/* Listen/Active */
	pch_can_set_optmode(priv);

	/* Enabling the transmit buffer. */
1185 1186
	for (i = PCH_TX_OBJ_START; i <= PCH_TX_OBJ_END; i++)
		pch_can_set_rxtx(priv, i, priv->tx_enable[i], PCH_TX_IFREG);
1187 1188

	/* Configuring the receive buffer and enabling them. */
1189 1190 1191
	for (i = PCH_RX_OBJ_START; i <= PCH_RX_OBJ_END; i++) {
		/* Restore buffer link */
		pch_can_set_rx_buffer_link(priv, i, priv->rx_link[i]);
1192

1193 1194
		/* Restore buffer enables */
		pch_can_set_rxtx(priv, i, priv->rx_enable[i], PCH_RX_IFREG);
1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214
	}

	/* Enable CAN Interrupts */
	pch_can_set_int_custom(priv);

	/* Restore Run Mode */
	pch_can_set_run_mode(priv, PCH_CAN_RUN);

	return retval;
}
#else
#define pch_can_suspend NULL
#define pch_can_resume NULL
#endif

static int pch_can_get_berr_counter(const struct net_device *dev,
				    struct can_berr_counter *bec)
{
	struct pch_can_priv *priv = netdev_priv(dev);

T
Tomoya 已提交
1215 1216
	bec->txerr = ioread32(&priv->regs->errc) & PCH_TEC;
	bec->rxerr = (ioread32(&priv->regs->errc) & PCH_REC) >> 8;
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247

	return 0;
}

static int __devinit pch_can_probe(struct pci_dev *pdev,
				   const struct pci_device_id *id)
{
	struct net_device *ndev;
	struct pch_can_priv *priv;
	int rc;
	void __iomem *addr;

	rc = pci_enable_device(pdev);
	if (rc) {
		dev_err(&pdev->dev, "Failed pci_enable_device %d\n", rc);
		goto probe_exit_endev;
	}

	rc = pci_request_regions(pdev, KBUILD_MODNAME);
	if (rc) {
		dev_err(&pdev->dev, "Failed pci_request_regions %d\n", rc);
		goto probe_exit_pcireq;
	}

	addr = pci_iomap(pdev, 1, 0);
	if (!addr) {
		rc = -EIO;
		dev_err(&pdev->dev, "Failed pci_iomap\n");
		goto probe_exit_ipmap;
	}

1248
	ndev = alloc_candev(sizeof(struct pch_can_priv), PCH_TX_OBJ_END);
1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263
	if (!ndev) {
		rc = -ENOMEM;
		dev_err(&pdev->dev, "Failed alloc_candev\n");
		goto probe_exit_alloc_candev;
	}

	priv = netdev_priv(ndev);
	priv->ndev = ndev;
	priv->regs = addr;
	priv->dev = pdev;
	priv->can.bittiming_const = &pch_can_bittiming_const;
	priv->can.do_set_mode = pch_can_do_set_mode;
	priv->can.do_get_berr_counter = pch_can_get_berr_counter;
	priv->can.ctrlmode_supported = CAN_CTRLMODE_LISTENONLY |
				       CAN_CTRLMODE_LOOPBACK;
1264
	priv->tx_obj = PCH_TX_OBJ_START; /* Point head of Tx Obj */
1265 1266 1267 1268 1269 1270 1271 1272 1273

	ndev->irq = pdev->irq;
	ndev->flags |= IFF_ECHO;

	pci_set_drvdata(pdev, ndev);
	SET_NETDEV_DEV(ndev, &pdev->dev);
	ndev->netdev_ops = &pch_can_netdev_ops;
	priv->can.clock.freq = PCH_CAN_CLK; /* Hz */

T
Tomoya 已提交
1274
	netif_napi_add(ndev, &priv->napi, pch_can_poll, PCH_RX_OBJ_END);
1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295

	rc = register_candev(ndev);
	if (rc) {
		dev_err(&pdev->dev, "Failed register_candev %d\n", rc);
		goto probe_exit_reg_candev;
	}

	return 0;

probe_exit_reg_candev:
	free_candev(ndev);
probe_exit_alloc_candev:
	pci_iounmap(pdev, addr);
probe_exit_ipmap:
	pci_release_regions(pdev);
probe_exit_pcireq:
	pci_disable_device(pdev);
probe_exit_endev:
	return rc;
}

1296
static struct pci_driver pch_can_pci_driver = {
1297 1298 1299 1300 1301 1302 1303 1304 1305 1306
	.name = "pch_can",
	.id_table = pch_pci_tbl,
	.probe = pch_can_probe,
	.remove = __devexit_p(pch_can_remove),
	.suspend = pch_can_suspend,
	.resume = pch_can_resume,
};

static int __init pch_can_pci_init(void)
{
1307
	return pci_register_driver(&pch_can_pci_driver);
1308 1309 1310 1311 1312
}
module_init(pch_can_pci_init);

static void __exit pch_can_pci_exit(void)
{
1313
	pci_unregister_driver(&pch_can_pci_driver);
1314 1315 1316 1317 1318 1319
}
module_exit(pch_can_pci_exit);

MODULE_DESCRIPTION("Controller Area Network Driver");
MODULE_LICENSE("GPL v2");
MODULE_VERSION("0.94");