|
@@ -272,7 +272,6 @@ static int flexcan_get_berr_counter(const struct net_device *dev,
|
|
|
static int flexcan_start_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
{
|
|
|
const struct flexcan_priv *priv = netdev_priv(dev);
|
|
|
- struct net_device_stats *stats = &dev->stats;
|
|
|
struct flexcan_regs __iomem *regs = priv->base;
|
|
|
struct can_frame *cf = (struct can_frame *)skb->data;
|
|
|
u32 can_id;
|
|
@@ -302,14 +301,11 @@ static int flexcan_start_xmit(struct sk_buff *skb, struct net_device *dev)
|
|
|
flexcan_write(data, ®s->cantxfg[FLEXCAN_TX_BUF_ID].data[1]);
|
|
|
}
|
|
|
|
|
|
+ can_put_echo_skb(skb, dev, 0);
|
|
|
+
|
|
|
flexcan_write(can_id, ®s->cantxfg[FLEXCAN_TX_BUF_ID].can_id);
|
|
|
flexcan_write(ctrl, ®s->cantxfg[FLEXCAN_TX_BUF_ID].can_ctrl);
|
|
|
|
|
|
- kfree_skb(skb);
|
|
|
-
|
|
|
- /* tx_packets is incremented in flexcan_irq */
|
|
|
- stats->tx_bytes += cf->can_dlc;
|
|
|
-
|
|
|
return NETDEV_TX_OK;
|
|
|
}
|
|
|
|
|
@@ -322,34 +318,34 @@ static void do_bus_err(struct net_device *dev,
|
|
|
cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR;
|
|
|
|
|
|
if (reg_esr & FLEXCAN_ESR_BIT1_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "BIT1_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "BIT1_ERR irq\n");
|
|
|
cf->data[2] |= CAN_ERR_PROT_BIT1;
|
|
|
tx_errors = 1;
|
|
|
}
|
|
|
if (reg_esr & FLEXCAN_ESR_BIT0_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "BIT0_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "BIT0_ERR irq\n");
|
|
|
cf->data[2] |= CAN_ERR_PROT_BIT0;
|
|
|
tx_errors = 1;
|
|
|
}
|
|
|
if (reg_esr & FLEXCAN_ESR_ACK_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "ACK_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "ACK_ERR irq\n");
|
|
|
cf->can_id |= CAN_ERR_ACK;
|
|
|
cf->data[3] |= CAN_ERR_PROT_LOC_ACK;
|
|
|
tx_errors = 1;
|
|
|
}
|
|
|
if (reg_esr & FLEXCAN_ESR_CRC_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "CRC_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "CRC_ERR irq\n");
|
|
|
cf->data[2] |= CAN_ERR_PROT_BIT;
|
|
|
cf->data[3] |= CAN_ERR_PROT_LOC_CRC_SEQ;
|
|
|
rx_errors = 1;
|
|
|
}
|
|
|
if (reg_esr & FLEXCAN_ESR_FRM_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "FRM_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "FRM_ERR irq\n");
|
|
|
cf->data[2] |= CAN_ERR_PROT_FORM;
|
|
|
rx_errors = 1;
|
|
|
}
|
|
|
if (reg_esr & FLEXCAN_ESR_STF_ERR) {
|
|
|
- dev_dbg(dev->dev.parent, "STF_ERR irq\n");
|
|
|
+ netdev_dbg(dev, "STF_ERR irq\n");
|
|
|
cf->data[2] |= CAN_ERR_PROT_STUFF;
|
|
|
rx_errors = 1;
|
|
|
}
|
|
@@ -396,7 +392,7 @@ static void do_state(struct net_device *dev,
|
|
|
*/
|
|
|
if (new_state >= CAN_STATE_ERROR_WARNING &&
|
|
|
new_state <= CAN_STATE_BUS_OFF) {
|
|
|
- dev_dbg(dev->dev.parent, "Error Warning IRQ\n");
|
|
|
+ netdev_dbg(dev, "Error Warning IRQ\n");
|
|
|
priv->can.can_stats.error_warning++;
|
|
|
|
|
|
cf->can_id |= CAN_ERR_CRTL;
|
|
@@ -412,7 +408,7 @@ static void do_state(struct net_device *dev,
|
|
|
*/
|
|
|
if (new_state >= CAN_STATE_ERROR_PASSIVE &&
|
|
|
new_state <= CAN_STATE_BUS_OFF) {
|
|
|
- dev_dbg(dev->dev.parent, "Error Passive IRQ\n");
|
|
|
+ netdev_dbg(dev, "Error Passive IRQ\n");
|
|
|
priv->can.can_stats.error_passive++;
|
|
|
|
|
|
cf->can_id |= CAN_ERR_CRTL;
|
|
@@ -422,8 +418,8 @@ static void do_state(struct net_device *dev,
|
|
|
}
|
|
|
break;
|
|
|
case CAN_STATE_BUS_OFF:
|
|
|
- dev_err(dev->dev.parent,
|
|
|
- "BUG! hardware recovered automatically from BUS_OFF\n");
|
|
|
+ netdev_err(dev, "BUG! "
|
|
|
+ "hardware recovered automatically from BUS_OFF\n");
|
|
|
break;
|
|
|
default:
|
|
|
break;
|
|
@@ -432,7 +428,7 @@ static void do_state(struct net_device *dev,
|
|
|
/* process state changes depending on the new state */
|
|
|
switch (new_state) {
|
|
|
case CAN_STATE_ERROR_ACTIVE:
|
|
|
- dev_dbg(dev->dev.parent, "Error Active\n");
|
|
|
+ netdev_dbg(dev, "Error Active\n");
|
|
|
cf->can_id |= CAN_ERR_PROT;
|
|
|
cf->data[2] = CAN_ERR_PROT_ACTIVE;
|
|
|
break;
|
|
@@ -614,7 +610,7 @@ static irqreturn_t flexcan_irq(int irq, void *dev_id)
|
|
|
|
|
|
/* transmission complete interrupt */
|
|
|
if (reg_iflag1 & (1 << FLEXCAN_TX_BUF_ID)) {
|
|
|
- /* tx_bytes is incremented in flexcan_start_xmit */
|
|
|
+ stats->tx_bytes += can_get_echo_skb(dev, 0);
|
|
|
stats->tx_packets++;
|
|
|
flexcan_write((1 << FLEXCAN_TX_BUF_ID), ®s->iflag1);
|
|
|
netif_wake_queue(dev);
|
|
@@ -653,12 +649,12 @@ static void flexcan_set_bittiming(struct net_device *dev)
|
|
|
if (priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES)
|
|
|
reg |= FLEXCAN_CTRL_SMP;
|
|
|
|
|
|
- dev_info(dev->dev.parent, "writing ctrl=0x%08x\n", reg);
|
|
|
+ netdev_info(dev, "writing ctrl=0x%08x\n", reg);
|
|
|
flexcan_write(reg, ®s->ctrl);
|
|
|
|
|
|
/* print chip status */
|
|
|
- dev_dbg(dev->dev.parent, "%s: mcr=0x%08x ctrl=0x%08x\n", __func__,
|
|
|
- flexcan_read(®s->mcr), flexcan_read(®s->ctrl));
|
|
|
+ netdev_dbg(dev, "%s: mcr=0x%08x ctrl=0x%08x\n", __func__,
|
|
|
+ flexcan_read(®s->mcr), flexcan_read(®s->ctrl));
|
|
|
}
|
|
|
|
|
|
/*
|
|
@@ -684,9 +680,8 @@ static int flexcan_chip_start(struct net_device *dev)
|
|
|
|
|
|
reg_mcr = flexcan_read(®s->mcr);
|
|
|
if (reg_mcr & FLEXCAN_MCR_SOFTRST) {
|
|
|
- dev_err(dev->dev.parent,
|
|
|
- "Failed to softreset can module (mcr=0x%08x)\n",
|
|
|
- reg_mcr);
|
|
|
+ netdev_err(dev, "Failed to softreset can module (mcr=0x%08x)\n",
|
|
|
+ reg_mcr);
|
|
|
err = -ENODEV;
|
|
|
goto out;
|
|
|
}
|
|
@@ -702,13 +697,14 @@ static int flexcan_chip_start(struct net_device *dev)
|
|
|
* only supervisor access
|
|
|
* enable warning int
|
|
|
* choose format C
|
|
|
+ * disable local echo
|
|
|
*
|
|
|
*/
|
|
|
reg_mcr = flexcan_read(®s->mcr);
|
|
|
reg_mcr |= FLEXCAN_MCR_FRZ | FLEXCAN_MCR_FEN | FLEXCAN_MCR_HALT |
|
|
|
FLEXCAN_MCR_SUPV | FLEXCAN_MCR_WRN_EN |
|
|
|
- FLEXCAN_MCR_IDAM_C;
|
|
|
- dev_dbg(dev->dev.parent, "%s: writing mcr=0x%08x", __func__, reg_mcr);
|
|
|
+ FLEXCAN_MCR_IDAM_C | FLEXCAN_MCR_SRX_DIS;
|
|
|
+ netdev_dbg(dev, "%s: writing mcr=0x%08x", __func__, reg_mcr);
|
|
|
flexcan_write(reg_mcr, ®s->mcr);
|
|
|
|
|
|
/*
|
|
@@ -734,7 +730,7 @@ static int flexcan_chip_start(struct net_device *dev)
|
|
|
|
|
|
/* save for later use */
|
|
|
priv->reg_ctrl_default = reg_ctrl;
|
|
|
- dev_dbg(dev->dev.parent, "%s: writing ctrl=0x%08x", __func__, reg_ctrl);
|
|
|
+ netdev_dbg(dev, "%s: writing ctrl=0x%08x", __func__, reg_ctrl);
|
|
|
flexcan_write(reg_ctrl, ®s->ctrl);
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(regs->cantxfg); i++) {
|
|
@@ -766,8 +762,8 @@ static int flexcan_chip_start(struct net_device *dev)
|
|
|
flexcan_write(FLEXCAN_IFLAG_DEFAULT, ®s->imask1);
|
|
|
|
|
|
/* print chip status */
|
|
|
- dev_dbg(dev->dev.parent, "%s: reading mcr=0x%08x ctrl=0x%08x\n",
|
|
|
- __func__, flexcan_read(®s->mcr), flexcan_read(®s->ctrl));
|
|
|
+ netdev_dbg(dev, "%s: reading mcr=0x%08x ctrl=0x%08x\n", __func__,
|
|
|
+ flexcan_read(®s->mcr), flexcan_read(®s->ctrl));
|
|
|
|
|
|
return 0;
|
|
|
|
|
@@ -905,8 +901,7 @@ static int __devinit register_flexcandev(struct net_device *dev)
|
|
|
*/
|
|
|
reg = flexcan_read(®s->mcr);
|
|
|
if (!(reg & FLEXCAN_MCR_FEN)) {
|
|
|
- dev_err(dev->dev.parent,
|
|
|
- "Could not enable RX FIFO, unsupported core\n");
|
|
|
+ netdev_err(dev, "Could not enable RX FIFO, unsupported core\n");
|
|
|
err = -ENODEV;
|
|
|
goto out;
|
|
|
}
|
|
@@ -975,7 +970,7 @@ static int __devinit flexcan_probe(struct platform_device *pdev)
|
|
|
goto failed_map;
|
|
|
}
|
|
|
|
|
|
- dev = alloc_candev(sizeof(struct flexcan_priv), 0);
|
|
|
+ dev = alloc_candev(sizeof(struct flexcan_priv), 1);
|
|
|
if (!dev) {
|
|
|
err = -ENOMEM;
|
|
|
goto failed_alloc;
|
|
@@ -983,7 +978,7 @@ static int __devinit flexcan_probe(struct platform_device *pdev)
|
|
|
|
|
|
dev->netdev_ops = &flexcan_netdev_ops;
|
|
|
dev->irq = irq;
|
|
|
- dev->flags |= IFF_ECHO; /* we support local echo in hardware */
|
|
|
+ dev->flags |= IFF_ECHO;
|
|
|
|
|
|
priv = netdev_priv(dev);
|
|
|
priv->can.clock.freq = clock_freq;
|