1afa17a50SWolfram Sang /* 2afa17a50SWolfram Sang * CAN bus driver for the alone generic (as possible as) MSCAN controller. 3afa17a50SWolfram Sang * 4afa17a50SWolfram Sang * Copyright (C) 2005-2006 Andrey Volkov <avolkov@varma-el.com>, 5afa17a50SWolfram Sang * Varma Electronics Oy 6afa17a50SWolfram Sang * Copyright (C) 2008-2009 Wolfgang Grandegger <wg@grandegger.com> 72d4b6fafSWolfgang Grandegger * Copyright (C) 2008-2009 Pengutronix <kernel@pengutronix.de> 8afa17a50SWolfram Sang * 9afa17a50SWolfram Sang * This program is free software; you can redistribute it and/or modify 10afa17a50SWolfram Sang * it under the terms of the version 2 of the GNU General Public License 11afa17a50SWolfram Sang * as published by the Free Software Foundation 12afa17a50SWolfram Sang * 13afa17a50SWolfram Sang * This program is distributed in the hope that it will be useful, 14afa17a50SWolfram Sang * but WITHOUT ANY WARRANTY; without even the implied warranty of 15afa17a50SWolfram Sang * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16afa17a50SWolfram Sang * GNU General Public License for more details. 17afa17a50SWolfram Sang * 18afa17a50SWolfram Sang * You should have received a copy of the GNU General Public License 19afa17a50SWolfram Sang * along with this program; if not, write to the Free Software 20afa17a50SWolfram Sang * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA 21afa17a50SWolfram Sang */ 22afa17a50SWolfram Sang 23afa17a50SWolfram Sang #include <linux/kernel.h> 24afa17a50SWolfram Sang #include <linux/module.h> 25afa17a50SWolfram Sang #include <linux/interrupt.h> 26afa17a50SWolfram Sang #include <linux/delay.h> 27afa17a50SWolfram Sang #include <linux/netdevice.h> 28afa17a50SWolfram Sang #include <linux/if_arp.h> 29afa17a50SWolfram Sang #include <linux/if_ether.h> 30afa17a50SWolfram Sang #include <linux/list.h> 31afa17a50SWolfram Sang #include <linux/can/dev.h> 32afa17a50SWolfram Sang #include <linux/can/error.h> 33afa17a50SWolfram Sang #include <linux/io.h> 34afa17a50SWolfram Sang 35afa17a50SWolfram Sang #include "mscan.h" 36afa17a50SWolfram Sang 37194b9a4cSMarc Kleine-Budde static const struct can_bittiming_const mscan_bittiming_const = { 38afa17a50SWolfram Sang .name = "mscan", 39afa17a50SWolfram Sang .tseg1_min = 4, 40afa17a50SWolfram Sang .tseg1_max = 16, 41afa17a50SWolfram Sang .tseg2_min = 2, 42afa17a50SWolfram Sang .tseg2_max = 8, 43afa17a50SWolfram Sang .sjw_max = 4, 44afa17a50SWolfram Sang .brp_min = 1, 45afa17a50SWolfram Sang .brp_max = 64, 46afa17a50SWolfram Sang .brp_inc = 1, 47afa17a50SWolfram Sang }; 48afa17a50SWolfram Sang 49afa17a50SWolfram Sang struct mscan_state { 50afa17a50SWolfram Sang u8 mode; 51afa17a50SWolfram Sang u8 canrier; 52afa17a50SWolfram Sang u8 cantier; 53afa17a50SWolfram Sang }; 54afa17a50SWolfram Sang 55afa17a50SWolfram Sang static enum can_state state_map[] = { 56afa17a50SWolfram Sang CAN_STATE_ERROR_ACTIVE, 57afa17a50SWolfram Sang CAN_STATE_ERROR_WARNING, 58afa17a50SWolfram Sang CAN_STATE_ERROR_PASSIVE, 59afa17a50SWolfram Sang CAN_STATE_BUS_OFF 60afa17a50SWolfram Sang }; 61afa17a50SWolfram Sang 62afa17a50SWolfram Sang static int mscan_set_mode(struct net_device *dev, u8 mode) 63afa17a50SWolfram Sang { 64afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 65665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 66afa17a50SWolfram Sang int ret = 0; 67afa17a50SWolfram Sang int i; 68afa17a50SWolfram Sang u8 canctl1; 69afa17a50SWolfram Sang 70afa17a50SWolfram Sang if (mode != MSCAN_NORMAL_MODE) { 71afa17a50SWolfram Sang if (priv->tx_active) { 72afa17a50SWolfram Sang /* Abort transfers before going to sleep */# 73afa17a50SWolfram Sang out_8(®s->cantarq, priv->tx_active); 74afa17a50SWolfram Sang /* Suppress TX done interrupts */ 75afa17a50SWolfram Sang out_8(®s->cantier, 0); 76afa17a50SWolfram Sang } 77afa17a50SWolfram Sang 78afa17a50SWolfram Sang canctl1 = in_8(®s->canctl1); 790285e7ceSWolfram Sang if ((mode & MSCAN_SLPRQ) && !(canctl1 & MSCAN_SLPAK)) { 8059179ea6SWolfram Sang setbits8(®s->canctl0, MSCAN_SLPRQ); 81afa17a50SWolfram Sang for (i = 0; i < MSCAN_SET_MODE_RETRIES; i++) { 82afa17a50SWolfram Sang if (in_8(®s->canctl1) & MSCAN_SLPAK) 83afa17a50SWolfram Sang break; 84afa17a50SWolfram Sang udelay(100); 85afa17a50SWolfram Sang } 86afa17a50SWolfram Sang /* 87afa17a50SWolfram Sang * The mscan controller will fail to enter sleep mode, 88afa17a50SWolfram Sang * while there are irregular activities on bus, like 89afa17a50SWolfram Sang * somebody keeps retransmitting. This behavior is 90afa17a50SWolfram Sang * undocumented and seems to differ between mscan built 91afa17a50SWolfram Sang * in mpc5200b and mpc5200. We proceed in that case, 92afa17a50SWolfram Sang * since otherwise the slprq will be kept set and the 93afa17a50SWolfram Sang * controller will get stuck. NOTE: INITRQ or CSWAI 94afa17a50SWolfram Sang * will abort all active transmit actions, if still 95afa17a50SWolfram Sang * any, at once. 96afa17a50SWolfram Sang */ 97afa17a50SWolfram Sang if (i >= MSCAN_SET_MODE_RETRIES) 98aabdfd6aSWolfgang Grandegger netdev_dbg(dev, 99afa17a50SWolfram Sang "device failed to enter sleep mode. " 100afa17a50SWolfram Sang "We proceed anyhow.\n"); 101afa17a50SWolfram Sang else 102afa17a50SWolfram Sang priv->can.state = CAN_STATE_SLEEPING; 103afa17a50SWolfram Sang } 104afa17a50SWolfram Sang 1050285e7ceSWolfram Sang if ((mode & MSCAN_INITRQ) && !(canctl1 & MSCAN_INITAK)) { 10659179ea6SWolfram Sang setbits8(®s->canctl0, MSCAN_INITRQ); 107afa17a50SWolfram Sang for (i = 0; i < MSCAN_SET_MODE_RETRIES; i++) { 108afa17a50SWolfram Sang if (in_8(®s->canctl1) & MSCAN_INITAK) 109afa17a50SWolfram Sang break; 110afa17a50SWolfram Sang } 111afa17a50SWolfram Sang if (i >= MSCAN_SET_MODE_RETRIES) 112afa17a50SWolfram Sang ret = -ENODEV; 113afa17a50SWolfram Sang } 114afa17a50SWolfram Sang if (!ret) 115afa17a50SWolfram Sang priv->can.state = CAN_STATE_STOPPED; 116afa17a50SWolfram Sang 117afa17a50SWolfram Sang if (mode & MSCAN_CSWAI) 11859179ea6SWolfram Sang setbits8(®s->canctl0, MSCAN_CSWAI); 119afa17a50SWolfram Sang 120afa17a50SWolfram Sang } else { 121afa17a50SWolfram Sang canctl1 = in_8(®s->canctl1); 122afa17a50SWolfram Sang if (canctl1 & (MSCAN_SLPAK | MSCAN_INITAK)) { 12359179ea6SWolfram Sang clrbits8(®s->canctl0, MSCAN_SLPRQ | MSCAN_INITRQ); 124afa17a50SWolfram Sang for (i = 0; i < MSCAN_SET_MODE_RETRIES; i++) { 125afa17a50SWolfram Sang canctl1 = in_8(®s->canctl1); 126afa17a50SWolfram Sang if (!(canctl1 & (MSCAN_INITAK | MSCAN_SLPAK))) 127afa17a50SWolfram Sang break; 128afa17a50SWolfram Sang } 129afa17a50SWolfram Sang if (i >= MSCAN_SET_MODE_RETRIES) 130afa17a50SWolfram Sang ret = -ENODEV; 131afa17a50SWolfram Sang else 132afa17a50SWolfram Sang priv->can.state = CAN_STATE_ERROR_ACTIVE; 133afa17a50SWolfram Sang } 134afa17a50SWolfram Sang } 135afa17a50SWolfram Sang return ret; 136afa17a50SWolfram Sang } 137afa17a50SWolfram Sang 138afa17a50SWolfram Sang static int mscan_start(struct net_device *dev) 139afa17a50SWolfram Sang { 140afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 141665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 142afa17a50SWolfram Sang u8 canrflg; 143afa17a50SWolfram Sang int err; 144afa17a50SWolfram Sang 145afa17a50SWolfram Sang out_8(®s->canrier, 0); 146afa17a50SWolfram Sang 147afa17a50SWolfram Sang INIT_LIST_HEAD(&priv->tx_head); 148afa17a50SWolfram Sang priv->prev_buf_id = 0; 149afa17a50SWolfram Sang priv->cur_pri = 0; 150afa17a50SWolfram Sang priv->tx_active = 0; 151afa17a50SWolfram Sang priv->shadow_canrier = 0; 152afa17a50SWolfram Sang priv->flags = 0; 153afa17a50SWolfram Sang 154bf3af547SWolfgang Grandegger if (priv->type == MSCAN_TYPE_MPC5121) { 155bf3af547SWolfgang Grandegger /* Clear pending bus-off condition */ 156bf3af547SWolfgang Grandegger if (in_8(®s->canmisc) & MSCAN_BOHOLD) 157bf3af547SWolfgang Grandegger out_8(®s->canmisc, MSCAN_BOHOLD); 158bf3af547SWolfgang Grandegger } 159bf3af547SWolfgang Grandegger 160afa17a50SWolfram Sang err = mscan_set_mode(dev, MSCAN_NORMAL_MODE); 161afa17a50SWolfram Sang if (err) 162afa17a50SWolfram Sang return err; 163afa17a50SWolfram Sang 164afa17a50SWolfram Sang canrflg = in_8(®s->canrflg); 165afa17a50SWolfram Sang priv->shadow_statflg = canrflg & MSCAN_STAT_MSK; 166afa17a50SWolfram Sang priv->can.state = state_map[max(MSCAN_STATE_RX(canrflg), 167afa17a50SWolfram Sang MSCAN_STATE_TX(canrflg))]; 168afa17a50SWolfram Sang out_8(®s->cantier, 0); 169afa17a50SWolfram Sang 170afa17a50SWolfram Sang /* Enable receive interrupts. */ 171bf3af547SWolfgang Grandegger out_8(®s->canrier, MSCAN_RX_INTS_ENABLE); 172bf3af547SWolfgang Grandegger 173bf3af547SWolfgang Grandegger return 0; 174bf3af547SWolfgang Grandegger } 175bf3af547SWolfgang Grandegger 176bf3af547SWolfgang Grandegger static int mscan_restart(struct net_device *dev) 177bf3af547SWolfgang Grandegger { 178bf3af547SWolfgang Grandegger struct mscan_priv *priv = netdev_priv(dev); 179bf3af547SWolfgang Grandegger 180bf3af547SWolfgang Grandegger if (priv->type == MSCAN_TYPE_MPC5121) { 181665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 182bf3af547SWolfgang Grandegger 183bf3af547SWolfgang Grandegger priv->can.state = CAN_STATE_ERROR_ACTIVE; 184bf3af547SWolfgang Grandegger WARN(!(in_8(®s->canmisc) & MSCAN_BOHOLD), 185c389ff80SJoe Perches "bus-off state expected\n"); 186bf3af547SWolfgang Grandegger out_8(®s->canmisc, MSCAN_BOHOLD); 187bf3af547SWolfgang Grandegger /* Re-enable receive interrupts. */ 188bf3af547SWolfgang Grandegger out_8(®s->canrier, MSCAN_RX_INTS_ENABLE); 189bf3af547SWolfgang Grandegger } else { 190bf3af547SWolfgang Grandegger if (priv->can.state <= CAN_STATE_BUS_OFF) 191bf3af547SWolfgang Grandegger mscan_set_mode(dev, MSCAN_INIT_MODE); 192bf3af547SWolfgang Grandegger return mscan_start(dev); 193bf3af547SWolfgang Grandegger } 194afa17a50SWolfram Sang 195afa17a50SWolfram Sang return 0; 196afa17a50SWolfram Sang } 197afa17a50SWolfram Sang 198afa17a50SWolfram Sang static netdev_tx_t mscan_start_xmit(struct sk_buff *skb, struct net_device *dev) 199afa17a50SWolfram Sang { 200afa17a50SWolfram Sang struct can_frame *frame = (struct can_frame *)skb->data; 201afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 202665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 203afa17a50SWolfram Sang int i, rtr, buf_id; 204afa17a50SWolfram Sang u32 can_id; 205afa17a50SWolfram Sang 2063ccd4c61SOliver Hartkopp if (can_dropped_invalid_skb(dev, skb)) 2072d4b6fafSWolfgang Grandegger return NETDEV_TX_OK; 208afa17a50SWolfram Sang 209afa17a50SWolfram Sang out_8(®s->cantier, 0); 210afa17a50SWolfram Sang 211afa17a50SWolfram Sang i = ~priv->tx_active & MSCAN_TXE; 212afa17a50SWolfram Sang buf_id = ffs(i) - 1; 213afa17a50SWolfram Sang switch (hweight8(i)) { 214afa17a50SWolfram Sang case 0: 215afa17a50SWolfram Sang netif_stop_queue(dev); 216aabdfd6aSWolfgang Grandegger netdev_err(dev, "Tx Ring full when queue awake!\n"); 217afa17a50SWolfram Sang return NETDEV_TX_BUSY; 218afa17a50SWolfram Sang case 1: 219afa17a50SWolfram Sang /* 220afa17a50SWolfram Sang * if buf_id < 3, then current frame will be send out of order, 221afa17a50SWolfram Sang * since buffer with lower id have higher priority (hell..) 222afa17a50SWolfram Sang */ 223afa17a50SWolfram Sang netif_stop_queue(dev); 224afa17a50SWolfram Sang case 2: 225afa17a50SWolfram Sang if (buf_id < priv->prev_buf_id) { 226afa17a50SWolfram Sang priv->cur_pri++; 227afa17a50SWolfram Sang if (priv->cur_pri == 0xff) { 228afa17a50SWolfram Sang set_bit(F_TX_WAIT_ALL, &priv->flags); 229afa17a50SWolfram Sang netif_stop_queue(dev); 230afa17a50SWolfram Sang } 231afa17a50SWolfram Sang } 232afa17a50SWolfram Sang set_bit(F_TX_PROGRESS, &priv->flags); 233afa17a50SWolfram Sang break; 234afa17a50SWolfram Sang } 235afa17a50SWolfram Sang priv->prev_buf_id = buf_id; 236afa17a50SWolfram Sang out_8(®s->cantbsel, i); 237afa17a50SWolfram Sang 238afa17a50SWolfram Sang rtr = frame->can_id & CAN_RTR_FLAG; 239afa17a50SWolfram Sang 24074ff60b2SWolfram Sang /* RTR is always the lowest bit of interest, then IDs follow */ 241afa17a50SWolfram Sang if (frame->can_id & CAN_EFF_FLAG) { 24274ff60b2SWolfram Sang can_id = (frame->can_id & CAN_EFF_MASK) 24374ff60b2SWolfram Sang << (MSCAN_EFF_RTR_SHIFT + 1); 244afa17a50SWolfram Sang if (rtr) 24574ff60b2SWolfram Sang can_id |= 1 << MSCAN_EFF_RTR_SHIFT; 246afa17a50SWolfram Sang out_be16(®s->tx.idr3_2, can_id); 247afa17a50SWolfram Sang 248afa17a50SWolfram Sang can_id >>= 16; 24925985edcSLucas De Marchi /* EFF_FLAGS are between the IDs :( */ 25074ff60b2SWolfram Sang can_id = (can_id & 0x7) | ((can_id << 2) & 0xffe0) 25174ff60b2SWolfram Sang | MSCAN_EFF_FLAGS; 252afa17a50SWolfram Sang } else { 25374ff60b2SWolfram Sang can_id = (frame->can_id & CAN_SFF_MASK) 25474ff60b2SWolfram Sang << (MSCAN_SFF_RTR_SHIFT + 1); 255afa17a50SWolfram Sang if (rtr) 25674ff60b2SWolfram Sang can_id |= 1 << MSCAN_SFF_RTR_SHIFT; 257afa17a50SWolfram Sang } 258afa17a50SWolfram Sang out_be16(®s->tx.idr1_0, can_id); 259afa17a50SWolfram Sang 260afa17a50SWolfram Sang if (!rtr) { 261afa17a50SWolfram Sang void __iomem *data = ®s->tx.dsr1_0; 262afa17a50SWolfram Sang u16 *payload = (u16 *)frame->data; 2630285e7ceSWolfram Sang 264a3a4bfdeSWolfgang Grandegger for (i = 0; i < frame->can_dlc / 2; i++) { 265afa17a50SWolfram Sang out_be16(data, *payload++); 266afa17a50SWolfram Sang data += 2 + _MSCAN_RESERVED_DSR_SIZE; 267afa17a50SWolfram Sang } 268a3a4bfdeSWolfgang Grandegger /* write remaining byte if necessary */ 269a3a4bfdeSWolfgang Grandegger if (frame->can_dlc & 1) 270a3a4bfdeSWolfgang Grandegger out_8(data, frame->data[frame->can_dlc - 1]); 271afa17a50SWolfram Sang } 272afa17a50SWolfram Sang 273afa17a50SWolfram Sang out_8(®s->tx.dlr, frame->can_dlc); 274afa17a50SWolfram Sang out_8(®s->tx.tbpr, priv->cur_pri); 275afa17a50SWolfram Sang 276afa17a50SWolfram Sang /* Start transmission. */ 277afa17a50SWolfram Sang out_8(®s->cantflg, 1 << buf_id); 278afa17a50SWolfram Sang 279afa17a50SWolfram Sang if (!test_bit(F_TX_PROGRESS, &priv->flags)) 280afa17a50SWolfram Sang dev->trans_start = jiffies; 281afa17a50SWolfram Sang 282afa17a50SWolfram Sang list_add_tail(&priv->tx_queue[buf_id].list, &priv->tx_head); 283afa17a50SWolfram Sang 284afa17a50SWolfram Sang can_put_echo_skb(skb, dev, buf_id); 285afa17a50SWolfram Sang 286afa17a50SWolfram Sang /* Enable interrupt. */ 287afa17a50SWolfram Sang priv->tx_active |= 1 << buf_id; 288afa17a50SWolfram Sang out_8(®s->cantier, priv->tx_active); 289afa17a50SWolfram Sang 290afa17a50SWolfram Sang return NETDEV_TX_OK; 291afa17a50SWolfram Sang } 292afa17a50SWolfram Sang 293afa17a50SWolfram Sang /* This function returns the old state to see where we came from */ 294afa17a50SWolfram Sang static enum can_state check_set_state(struct net_device *dev, u8 canrflg) 295afa17a50SWolfram Sang { 296afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 297afa17a50SWolfram Sang enum can_state state, old_state = priv->can.state; 298afa17a50SWolfram Sang 299afa17a50SWolfram Sang if (canrflg & MSCAN_CSCIF && old_state <= CAN_STATE_BUS_OFF) { 300afa17a50SWolfram Sang state = state_map[max(MSCAN_STATE_RX(canrflg), 301afa17a50SWolfram Sang MSCAN_STATE_TX(canrflg))]; 302afa17a50SWolfram Sang priv->can.state = state; 303afa17a50SWolfram Sang } 304afa17a50SWolfram Sang return old_state; 305afa17a50SWolfram Sang } 306afa17a50SWolfram Sang 307afa17a50SWolfram Sang static void mscan_get_rx_frame(struct net_device *dev, struct can_frame *frame) 308afa17a50SWolfram Sang { 309afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 310665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 311afa17a50SWolfram Sang u32 can_id; 312afa17a50SWolfram Sang int i; 313afa17a50SWolfram Sang 314afa17a50SWolfram Sang can_id = in_be16(®s->rx.idr1_0); 315afa17a50SWolfram Sang if (can_id & (1 << 3)) { 316afa17a50SWolfram Sang frame->can_id = CAN_EFF_FLAG; 317afa17a50SWolfram Sang can_id = ((can_id << 16) | in_be16(®s->rx.idr3_2)); 318afa17a50SWolfram Sang can_id = ((can_id & 0xffe00000) | 319afa17a50SWolfram Sang ((can_id & 0x7ffff) << 2)) >> 2; 320afa17a50SWolfram Sang } else { 321afa17a50SWolfram Sang can_id >>= 4; 322afa17a50SWolfram Sang frame->can_id = 0; 323afa17a50SWolfram Sang } 324afa17a50SWolfram Sang 325afa17a50SWolfram Sang frame->can_id |= can_id >> 1; 326afa17a50SWolfram Sang if (can_id & 1) 327afa17a50SWolfram Sang frame->can_id |= CAN_RTR_FLAG; 328c7cd606fSOliver Hartkopp 329c7cd606fSOliver Hartkopp frame->can_dlc = get_can_dlc(in_8(®s->rx.dlr) & 0xf); 330afa17a50SWolfram Sang 331afa17a50SWolfram Sang if (!(frame->can_id & CAN_RTR_FLAG)) { 332afa17a50SWolfram Sang void __iomem *data = ®s->rx.dsr1_0; 333afa17a50SWolfram Sang u16 *payload = (u16 *)frame->data; 3340285e7ceSWolfram Sang 335a3a4bfdeSWolfgang Grandegger for (i = 0; i < frame->can_dlc / 2; i++) { 336afa17a50SWolfram Sang *payload++ = in_be16(data); 337afa17a50SWolfram Sang data += 2 + _MSCAN_RESERVED_DSR_SIZE; 338afa17a50SWolfram Sang } 339a3a4bfdeSWolfgang Grandegger /* read remaining byte if necessary */ 340a3a4bfdeSWolfgang Grandegger if (frame->can_dlc & 1) 341a3a4bfdeSWolfgang Grandegger frame->data[frame->can_dlc - 1] = in_8(data); 342afa17a50SWolfram Sang } 343afa17a50SWolfram Sang 344afa17a50SWolfram Sang out_8(®s->canrflg, MSCAN_RXF); 345afa17a50SWolfram Sang } 346afa17a50SWolfram Sang 347afa17a50SWolfram Sang static void mscan_get_err_frame(struct net_device *dev, struct can_frame *frame, 348afa17a50SWolfram Sang u8 canrflg) 349afa17a50SWolfram Sang { 350afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 351665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 352afa17a50SWolfram Sang struct net_device_stats *stats = &dev->stats; 353afa17a50SWolfram Sang enum can_state old_state; 354afa17a50SWolfram Sang 355aabdfd6aSWolfgang Grandegger netdev_dbg(dev, "error interrupt (canrflg=%#x)\n", canrflg); 356afa17a50SWolfram Sang frame->can_id = CAN_ERR_FLAG; 357afa17a50SWolfram Sang 358afa17a50SWolfram Sang if (canrflg & MSCAN_OVRIF) { 359afa17a50SWolfram Sang frame->can_id |= CAN_ERR_CRTL; 360afa17a50SWolfram Sang frame->data[1] = CAN_ERR_CRTL_RX_OVERFLOW; 361afa17a50SWolfram Sang stats->rx_over_errors++; 362afa17a50SWolfram Sang stats->rx_errors++; 3630285e7ceSWolfram Sang } else { 364afa17a50SWolfram Sang frame->data[1] = 0; 3650285e7ceSWolfram Sang } 366afa17a50SWolfram Sang 367afa17a50SWolfram Sang old_state = check_set_state(dev, canrflg); 368afa17a50SWolfram Sang /* State changed */ 369afa17a50SWolfram Sang if (old_state != priv->can.state) { 370afa17a50SWolfram Sang switch (priv->can.state) { 371afa17a50SWolfram Sang case CAN_STATE_ERROR_WARNING: 372afa17a50SWolfram Sang frame->can_id |= CAN_ERR_CRTL; 373afa17a50SWolfram Sang priv->can.can_stats.error_warning++; 374afa17a50SWolfram Sang if ((priv->shadow_statflg & MSCAN_RSTAT_MSK) < 375afa17a50SWolfram Sang (canrflg & MSCAN_RSTAT_MSK)) 376afa17a50SWolfram Sang frame->data[1] |= CAN_ERR_CRTL_RX_WARNING; 377afa17a50SWolfram Sang if ((priv->shadow_statflg & MSCAN_TSTAT_MSK) < 378afa17a50SWolfram Sang (canrflg & MSCAN_TSTAT_MSK)) 379afa17a50SWolfram Sang frame->data[1] |= CAN_ERR_CRTL_TX_WARNING; 380afa17a50SWolfram Sang break; 381afa17a50SWolfram Sang case CAN_STATE_ERROR_PASSIVE: 382afa17a50SWolfram Sang frame->can_id |= CAN_ERR_CRTL; 383afa17a50SWolfram Sang priv->can.can_stats.error_passive++; 384afa17a50SWolfram Sang frame->data[1] |= CAN_ERR_CRTL_RX_PASSIVE; 385afa17a50SWolfram Sang break; 386afa17a50SWolfram Sang case CAN_STATE_BUS_OFF: 387afa17a50SWolfram Sang frame->can_id |= CAN_ERR_BUSOFF; 388afa17a50SWolfram Sang /* 389afa17a50SWolfram Sang * The MSCAN on the MPC5200 does recover from bus-off 390afa17a50SWolfram Sang * automatically. To avoid that we stop the chip doing 391afa17a50SWolfram Sang * a light-weight stop (we are in irq-context). 392afa17a50SWolfram Sang */ 393bf3af547SWolfgang Grandegger if (priv->type != MSCAN_TYPE_MPC5121) { 394afa17a50SWolfram Sang out_8(®s->cantier, 0); 395afa17a50SWolfram Sang out_8(®s->canrier, 0); 396bf3af547SWolfgang Grandegger setbits8(®s->canctl0, 397bf3af547SWolfgang Grandegger MSCAN_SLPRQ | MSCAN_INITRQ); 398bf3af547SWolfgang Grandegger } 399afa17a50SWolfram Sang can_bus_off(dev); 400afa17a50SWolfram Sang break; 401afa17a50SWolfram Sang default: 402afa17a50SWolfram Sang break; 403afa17a50SWolfram Sang } 404afa17a50SWolfram Sang } 405afa17a50SWolfram Sang priv->shadow_statflg = canrflg & MSCAN_STAT_MSK; 406afa17a50SWolfram Sang frame->can_dlc = CAN_ERR_DLC; 407afa17a50SWolfram Sang out_8(®s->canrflg, MSCAN_ERR_IF); 408afa17a50SWolfram Sang } 409afa17a50SWolfram Sang 410afa17a50SWolfram Sang static int mscan_rx_poll(struct napi_struct *napi, int quota) 411afa17a50SWolfram Sang { 412afa17a50SWolfram Sang struct mscan_priv *priv = container_of(napi, struct mscan_priv, napi); 413afa17a50SWolfram Sang struct net_device *dev = napi->dev; 414665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 415afa17a50SWolfram Sang struct net_device_stats *stats = &dev->stats; 416afa17a50SWolfram Sang int npackets = 0; 417afa17a50SWolfram Sang int ret = 1; 418afa17a50SWolfram Sang struct sk_buff *skb; 419afa17a50SWolfram Sang struct can_frame *frame; 420afa17a50SWolfram Sang u8 canrflg; 421afa17a50SWolfram Sang 42268bd7422SWolfram Sang while (npackets < quota) { 42368bd7422SWolfram Sang canrflg = in_8(®s->canrflg); 42468bd7422SWolfram Sang if (!(canrflg & (MSCAN_RXF | MSCAN_ERR_IF))) 42568bd7422SWolfram Sang break; 426afa17a50SWolfram Sang 427afa17a50SWolfram Sang skb = alloc_can_skb(dev, &frame); 428afa17a50SWolfram Sang if (!skb) { 429afa17a50SWolfram Sang if (printk_ratelimit()) 430aabdfd6aSWolfgang Grandegger netdev_notice(dev, "packet dropped\n"); 431afa17a50SWolfram Sang stats->rx_dropped++; 432afa17a50SWolfram Sang out_8(®s->canrflg, canrflg); 433afa17a50SWolfram Sang continue; 434afa17a50SWolfram Sang } 435afa17a50SWolfram Sang 436afa17a50SWolfram Sang if (canrflg & MSCAN_RXF) 437afa17a50SWolfram Sang mscan_get_rx_frame(dev, frame); 438afa17a50SWolfram Sang else if (canrflg & MSCAN_ERR_IF) 439afa17a50SWolfram Sang mscan_get_err_frame(dev, frame, canrflg); 440afa17a50SWolfram Sang 441afa17a50SWolfram Sang stats->rx_packets++; 442afa17a50SWolfram Sang stats->rx_bytes += frame->can_dlc; 443afa17a50SWolfram Sang npackets++; 444afa17a50SWolfram Sang netif_receive_skb(skb); 445afa17a50SWolfram Sang } 446afa17a50SWolfram Sang 447afa17a50SWolfram Sang if (!(in_8(®s->canrflg) & (MSCAN_RXF | MSCAN_ERR_IF))) { 448afa17a50SWolfram Sang napi_complete(&priv->napi); 449afa17a50SWolfram Sang clear_bit(F_RX_PROGRESS, &priv->flags); 450afa17a50SWolfram Sang if (priv->can.state < CAN_STATE_BUS_OFF) 451afa17a50SWolfram Sang out_8(®s->canrier, priv->shadow_canrier); 452afa17a50SWolfram Sang ret = 0; 453afa17a50SWolfram Sang } 454afa17a50SWolfram Sang return ret; 455afa17a50SWolfram Sang } 456afa17a50SWolfram Sang 457afa17a50SWolfram Sang static irqreturn_t mscan_isr(int irq, void *dev_id) 458afa17a50SWolfram Sang { 459afa17a50SWolfram Sang struct net_device *dev = (struct net_device *)dev_id; 460afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 461665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 462afa17a50SWolfram Sang struct net_device_stats *stats = &dev->stats; 463afa17a50SWolfram Sang u8 cantier, cantflg, canrflg; 464afa17a50SWolfram Sang irqreturn_t ret = IRQ_NONE; 465afa17a50SWolfram Sang 466afa17a50SWolfram Sang cantier = in_8(®s->cantier) & MSCAN_TXE; 467afa17a50SWolfram Sang cantflg = in_8(®s->cantflg) & cantier; 468afa17a50SWolfram Sang 469afa17a50SWolfram Sang if (cantier && cantflg) { 470afa17a50SWolfram Sang struct list_head *tmp, *pos; 471afa17a50SWolfram Sang 472afa17a50SWolfram Sang list_for_each_safe(pos, tmp, &priv->tx_head) { 473afa17a50SWolfram Sang struct tx_queue_entry *entry = 474afa17a50SWolfram Sang list_entry(pos, struct tx_queue_entry, list); 475afa17a50SWolfram Sang u8 mask = entry->mask; 476afa17a50SWolfram Sang 477afa17a50SWolfram Sang if (!(cantflg & mask)) 478afa17a50SWolfram Sang continue; 479afa17a50SWolfram Sang 480afa17a50SWolfram Sang out_8(®s->cantbsel, mask); 481afa17a50SWolfram Sang stats->tx_bytes += in_8(®s->tx.dlr); 482afa17a50SWolfram Sang stats->tx_packets++; 483afa17a50SWolfram Sang can_get_echo_skb(dev, entry->id); 484afa17a50SWolfram Sang priv->tx_active &= ~mask; 485afa17a50SWolfram Sang list_del(pos); 486afa17a50SWolfram Sang } 487afa17a50SWolfram Sang 488afa17a50SWolfram Sang if (list_empty(&priv->tx_head)) { 489afa17a50SWolfram Sang clear_bit(F_TX_WAIT_ALL, &priv->flags); 490afa17a50SWolfram Sang clear_bit(F_TX_PROGRESS, &priv->flags); 491afa17a50SWolfram Sang priv->cur_pri = 0; 4920285e7ceSWolfram Sang } else { 493afa17a50SWolfram Sang dev->trans_start = jiffies; 4940285e7ceSWolfram Sang } 495afa17a50SWolfram Sang 496afa17a50SWolfram Sang if (!test_bit(F_TX_WAIT_ALL, &priv->flags)) 497afa17a50SWolfram Sang netif_wake_queue(dev); 498afa17a50SWolfram Sang 499afa17a50SWolfram Sang out_8(®s->cantier, priv->tx_active); 500afa17a50SWolfram Sang ret = IRQ_HANDLED; 501afa17a50SWolfram Sang } 502afa17a50SWolfram Sang 503afa17a50SWolfram Sang canrflg = in_8(®s->canrflg); 504afa17a50SWolfram Sang if ((canrflg & ~MSCAN_STAT_MSK) && 505afa17a50SWolfram Sang !test_and_set_bit(F_RX_PROGRESS, &priv->flags)) { 506afa17a50SWolfram Sang if (canrflg & ~MSCAN_STAT_MSK) { 507afa17a50SWolfram Sang priv->shadow_canrier = in_8(®s->canrier); 508afa17a50SWolfram Sang out_8(®s->canrier, 0); 509afa17a50SWolfram Sang napi_schedule(&priv->napi); 510afa17a50SWolfram Sang ret = IRQ_HANDLED; 5110285e7ceSWolfram Sang } else { 512afa17a50SWolfram Sang clear_bit(F_RX_PROGRESS, &priv->flags); 513afa17a50SWolfram Sang } 5140285e7ceSWolfram Sang } 515afa17a50SWolfram Sang return ret; 516afa17a50SWolfram Sang } 517afa17a50SWolfram Sang 518afa17a50SWolfram Sang static int mscan_do_set_mode(struct net_device *dev, enum can_mode mode) 519afa17a50SWolfram Sang { 520afa17a50SWolfram Sang int ret = 0; 521afa17a50SWolfram Sang 522afa17a50SWolfram Sang switch (mode) { 523afa17a50SWolfram Sang case CAN_MODE_START: 524bf3af547SWolfgang Grandegger ret = mscan_restart(dev); 525afa17a50SWolfram Sang if (ret) 526afa17a50SWolfram Sang break; 527afa17a50SWolfram Sang if (netif_queue_stopped(dev)) 528afa17a50SWolfram Sang netif_wake_queue(dev); 529afa17a50SWolfram Sang break; 530afa17a50SWolfram Sang 531afa17a50SWolfram Sang default: 532afa17a50SWolfram Sang ret = -EOPNOTSUPP; 533afa17a50SWolfram Sang break; 534afa17a50SWolfram Sang } 535afa17a50SWolfram Sang return ret; 536afa17a50SWolfram Sang } 537afa17a50SWolfram Sang 538afa17a50SWolfram Sang static int mscan_do_set_bittiming(struct net_device *dev) 539afa17a50SWolfram Sang { 540afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 541665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 542afa17a50SWolfram Sang struct can_bittiming *bt = &priv->can.bittiming; 543afa17a50SWolfram Sang u8 btr0, btr1; 544afa17a50SWolfram Sang 545afa17a50SWolfram Sang btr0 = BTR0_SET_BRP(bt->brp) | BTR0_SET_SJW(bt->sjw); 546afa17a50SWolfram Sang btr1 = (BTR1_SET_TSEG1(bt->prop_seg + bt->phase_seg1) | 547afa17a50SWolfram Sang BTR1_SET_TSEG2(bt->phase_seg2) | 548afa17a50SWolfram Sang BTR1_SET_SAM(priv->can.ctrlmode & CAN_CTRLMODE_3_SAMPLES)); 549afa17a50SWolfram Sang 550aabdfd6aSWolfgang Grandegger netdev_info(dev, "setting BTR0=0x%02x BTR1=0x%02x\n", btr0, btr1); 551afa17a50SWolfram Sang 552afa17a50SWolfram Sang out_8(®s->canbtr0, btr0); 553afa17a50SWolfram Sang out_8(®s->canbtr1, btr1); 554afa17a50SWolfram Sang 555afa17a50SWolfram Sang return 0; 556afa17a50SWolfram Sang } 557afa17a50SWolfram Sang 55879d0d8a7SWolfgang Grandegger static int mscan_get_berr_counter(const struct net_device *dev, 55979d0d8a7SWolfgang Grandegger struct can_berr_counter *bec) 56079d0d8a7SWolfgang Grandegger { 56179d0d8a7SWolfgang Grandegger struct mscan_priv *priv = netdev_priv(dev); 56279d0d8a7SWolfgang Grandegger struct mscan_regs __iomem *regs = priv->reg_base; 56379d0d8a7SWolfgang Grandegger 56479d0d8a7SWolfgang Grandegger bec->txerr = in_8(®s->cantxerr); 56579d0d8a7SWolfgang Grandegger bec->rxerr = in_8(®s->canrxerr); 56679d0d8a7SWolfgang Grandegger 56779d0d8a7SWolfgang Grandegger return 0; 56879d0d8a7SWolfgang Grandegger } 56979d0d8a7SWolfgang Grandegger 570afa17a50SWolfram Sang static int mscan_open(struct net_device *dev) 571afa17a50SWolfram Sang { 572afa17a50SWolfram Sang int ret; 573afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 574665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 575afa17a50SWolfram Sang 5761149108eSGerhard Sittig if (priv->clk_ipg) { 5771149108eSGerhard Sittig ret = clk_prepare_enable(priv->clk_ipg); 5781149108eSGerhard Sittig if (ret) 5791149108eSGerhard Sittig goto exit_retcode; 5801149108eSGerhard Sittig } 5811149108eSGerhard Sittig if (priv->clk_can) { 5821149108eSGerhard Sittig ret = clk_prepare_enable(priv->clk_can); 5831149108eSGerhard Sittig if (ret) 5841149108eSGerhard Sittig goto exit_dis_ipg_clock; 5851149108eSGerhard Sittig } 5861149108eSGerhard Sittig 587afa17a50SWolfram Sang /* common open */ 588afa17a50SWolfram Sang ret = open_candev(dev); 589afa17a50SWolfram Sang if (ret) 5901149108eSGerhard Sittig goto exit_dis_can_clock; 591afa17a50SWolfram Sang 592afa17a50SWolfram Sang napi_enable(&priv->napi); 593afa17a50SWolfram Sang 594afa17a50SWolfram Sang ret = request_irq(dev->irq, mscan_isr, 0, dev->name, dev); 595afa17a50SWolfram Sang if (ret < 0) { 596aabdfd6aSWolfgang Grandegger netdev_err(dev, "failed to attach interrupt\n"); 597323907acSWolfram Sang goto exit_napi_disable; 598afa17a50SWolfram Sang } 599afa17a50SWolfram Sang 600abbd00b8SWolfgang Grandegger if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) 601452448f9SMarc Kleine-Budde setbits8(®s->canctl1, MSCAN_LISTEN); 602452448f9SMarc Kleine-Budde else 60359179ea6SWolfram Sang clrbits8(®s->canctl1, MSCAN_LISTEN); 604afa17a50SWolfram Sang 605afa17a50SWolfram Sang ret = mscan_start(dev); 606afa17a50SWolfram Sang if (ret) 607323907acSWolfram Sang goto exit_free_irq; 608afa17a50SWolfram Sang 609afa17a50SWolfram Sang netif_start_queue(dev); 610afa17a50SWolfram Sang 611afa17a50SWolfram Sang return 0; 612323907acSWolfram Sang 613323907acSWolfram Sang exit_free_irq: 614323907acSWolfram Sang free_irq(dev->irq, dev); 615323907acSWolfram Sang exit_napi_disable: 616323907acSWolfram Sang napi_disable(&priv->napi); 617323907acSWolfram Sang close_candev(dev); 6181149108eSGerhard Sittig exit_dis_can_clock: 6191149108eSGerhard Sittig if (priv->clk_can) 6201149108eSGerhard Sittig clk_disable_unprepare(priv->clk_can); 6211149108eSGerhard Sittig exit_dis_ipg_clock: 6221149108eSGerhard Sittig if (priv->clk_ipg) 6231149108eSGerhard Sittig clk_disable_unprepare(priv->clk_ipg); 6241149108eSGerhard Sittig exit_retcode: 625323907acSWolfram Sang return ret; 626afa17a50SWolfram Sang } 627afa17a50SWolfram Sang 628afa17a50SWolfram Sang static int mscan_close(struct net_device *dev) 629afa17a50SWolfram Sang { 630afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 631665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 632afa17a50SWolfram Sang 633afa17a50SWolfram Sang netif_stop_queue(dev); 634afa17a50SWolfram Sang napi_disable(&priv->napi); 635afa17a50SWolfram Sang 636afa17a50SWolfram Sang out_8(®s->cantier, 0); 637afa17a50SWolfram Sang out_8(®s->canrier, 0); 638afa17a50SWolfram Sang mscan_set_mode(dev, MSCAN_INIT_MODE); 639afa17a50SWolfram Sang close_candev(dev); 640afa17a50SWolfram Sang free_irq(dev->irq, dev); 641afa17a50SWolfram Sang 6421149108eSGerhard Sittig if (priv->clk_can) 6431149108eSGerhard Sittig clk_disable_unprepare(priv->clk_can); 6441149108eSGerhard Sittig if (priv->clk_ipg) 6451149108eSGerhard Sittig clk_disable_unprepare(priv->clk_ipg); 6461149108eSGerhard Sittig 647afa17a50SWolfram Sang return 0; 648afa17a50SWolfram Sang } 649afa17a50SWolfram Sang 650afa17a50SWolfram Sang static const struct net_device_ops mscan_netdev_ops = { 651afa17a50SWolfram Sang .ndo_open = mscan_open, 652afa17a50SWolfram Sang .ndo_stop = mscan_close, 653afa17a50SWolfram Sang .ndo_start_xmit = mscan_start_xmit, 654afa17a50SWolfram Sang }; 655afa17a50SWolfram Sang 656bf3af547SWolfgang Grandegger int register_mscandev(struct net_device *dev, int mscan_clksrc) 657afa17a50SWolfram Sang { 658afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 659665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 660afa17a50SWolfram Sang u8 ctl1; 661afa17a50SWolfram Sang 662afa17a50SWolfram Sang ctl1 = in_8(®s->canctl1); 663bf3af547SWolfgang Grandegger if (mscan_clksrc) 664afa17a50SWolfram Sang ctl1 |= MSCAN_CLKSRC; 665afa17a50SWolfram Sang else 666afa17a50SWolfram Sang ctl1 &= ~MSCAN_CLKSRC; 667afa17a50SWolfram Sang 66879d0d8a7SWolfgang Grandegger if (priv->type == MSCAN_TYPE_MPC5121) { 66979d0d8a7SWolfgang Grandegger priv->can.do_get_berr_counter = mscan_get_berr_counter; 670bf3af547SWolfgang Grandegger ctl1 |= MSCAN_BORM; /* bus-off recovery upon request */ 67179d0d8a7SWolfgang Grandegger } 672bf3af547SWolfgang Grandegger 673afa17a50SWolfram Sang ctl1 |= MSCAN_CANE; 674afa17a50SWolfram Sang out_8(®s->canctl1, ctl1); 675afa17a50SWolfram Sang udelay(100); 676afa17a50SWolfram Sang 677afa17a50SWolfram Sang /* acceptance mask/acceptance code (accept everything) */ 678afa17a50SWolfram Sang out_be16(®s->canidar1_0, 0); 679afa17a50SWolfram Sang out_be16(®s->canidar3_2, 0); 680afa17a50SWolfram Sang out_be16(®s->canidar5_4, 0); 681afa17a50SWolfram Sang out_be16(®s->canidar7_6, 0); 682afa17a50SWolfram Sang 683afa17a50SWolfram Sang out_be16(®s->canidmr1_0, 0xffff); 684afa17a50SWolfram Sang out_be16(®s->canidmr3_2, 0xffff); 685afa17a50SWolfram Sang out_be16(®s->canidmr5_4, 0xffff); 686afa17a50SWolfram Sang out_be16(®s->canidmr7_6, 0xffff); 687afa17a50SWolfram Sang /* Two 32 bit Acceptance Filters */ 688afa17a50SWolfram Sang out_8(®s->canidac, MSCAN_AF_32BIT); 689afa17a50SWolfram Sang 690afa17a50SWolfram Sang mscan_set_mode(dev, MSCAN_INIT_MODE); 691afa17a50SWolfram Sang 692afa17a50SWolfram Sang return register_candev(dev); 693afa17a50SWolfram Sang } 694afa17a50SWolfram Sang 695afa17a50SWolfram Sang void unregister_mscandev(struct net_device *dev) 696afa17a50SWolfram Sang { 697afa17a50SWolfram Sang struct mscan_priv *priv = netdev_priv(dev); 698665d7eb8SMarc Kleine-Budde struct mscan_regs __iomem *regs = priv->reg_base; 699afa17a50SWolfram Sang mscan_set_mode(dev, MSCAN_INIT_MODE); 70059179ea6SWolfram Sang clrbits8(®s->canctl1, MSCAN_CANE); 701afa17a50SWolfram Sang unregister_candev(dev); 702afa17a50SWolfram Sang } 703afa17a50SWolfram Sang 704afa17a50SWolfram Sang struct net_device *alloc_mscandev(void) 705afa17a50SWolfram Sang { 706afa17a50SWolfram Sang struct net_device *dev; 707afa17a50SWolfram Sang struct mscan_priv *priv; 708afa17a50SWolfram Sang int i; 709afa17a50SWolfram Sang 710afa17a50SWolfram Sang dev = alloc_candev(sizeof(struct mscan_priv), MSCAN_ECHO_SKB_MAX); 711afa17a50SWolfram Sang if (!dev) 712afa17a50SWolfram Sang return NULL; 713afa17a50SWolfram Sang priv = netdev_priv(dev); 714afa17a50SWolfram Sang 715afa17a50SWolfram Sang dev->netdev_ops = &mscan_netdev_ops; 716afa17a50SWolfram Sang 717afa17a50SWolfram Sang dev->flags |= IFF_ECHO; /* we support local echo */ 718afa17a50SWolfram Sang 719afa17a50SWolfram Sang netif_napi_add(dev, &priv->napi, mscan_rx_poll, 8); 720afa17a50SWolfram Sang 721afa17a50SWolfram Sang priv->can.bittiming_const = &mscan_bittiming_const; 722afa17a50SWolfram Sang priv->can.do_set_bittiming = mscan_do_set_bittiming; 723afa17a50SWolfram Sang priv->can.do_set_mode = mscan_do_set_mode; 724452448f9SMarc Kleine-Budde priv->can.ctrlmode_supported = CAN_CTRLMODE_3_SAMPLES | 725452448f9SMarc Kleine-Budde CAN_CTRLMODE_LISTENONLY; 726afa17a50SWolfram Sang 727afa17a50SWolfram Sang for (i = 0; i < TX_QUEUE_SIZE; i++) { 728afa17a50SWolfram Sang priv->tx_queue[i].id = i; 729afa17a50SWolfram Sang priv->tx_queue[i].mask = 1 << i; 730afa17a50SWolfram Sang } 731afa17a50SWolfram Sang 732afa17a50SWolfram Sang return dev; 733afa17a50SWolfram Sang } 734afa17a50SWolfram Sang 735afa17a50SWolfram Sang MODULE_AUTHOR("Andrey Volkov <avolkov@varma-el.com>"); 736afa17a50SWolfram Sang MODULE_LICENSE("GPL v2"); 737afa17a50SWolfram Sang MODULE_DESCRIPTION("CAN port driver for a MSCAN based chips"); 738