1 /* 2 * CAN bus driver for IFI CANFD controller 3 * 4 * Copyright (C) 2016 Marek Vasut <marex@denx.de> 5 * 6 * Details about this controller can be found at 7 * http://www.ifi-pld.de/IP/CANFD/canfd.html 8 * 9 * This file is licensed under the terms of the GNU General Public 10 * License version 2. This program is licensed "as is" without any 11 * warranty of any kind, whether express or implied. 12 */ 13 14 #include <linux/clk.h> 15 #include <linux/delay.h> 16 #include <linux/interrupt.h> 17 #include <linux/io.h> 18 #include <linux/kernel.h> 19 #include <linux/module.h> 20 #include <linux/netdevice.h> 21 #include <linux/of.h> 22 #include <linux/of_device.h> 23 #include <linux/platform_device.h> 24 25 #include <linux/can/dev.h> 26 27 #define IFI_CANFD_STCMD 0x0 28 #define IFI_CANFD_STCMD_HARDRESET 0xDEADCAFD 29 #define IFI_CANFD_STCMD_ENABLE BIT(0) 30 #define IFI_CANFD_STCMD_ERROR_ACTIVE BIT(2) 31 #define IFI_CANFD_STCMD_ERROR_PASSIVE BIT(3) 32 #define IFI_CANFD_STCMD_BUSOFF BIT(4) 33 #define IFI_CANFD_STCMD_BUSMONITOR BIT(16) 34 #define IFI_CANFD_STCMD_LOOPBACK BIT(18) 35 #define IFI_CANFD_STCMD_DISABLE_CANFD BIT(24) 36 #define IFI_CANFD_STCMD_ENABLE_ISO BIT(25) 37 #define IFI_CANFD_STCMD_ENABLE_7_9_8_8_TIMING BIT(26) 38 #define IFI_CANFD_STCMD_NORMAL_MODE ((u32)BIT(31)) 39 40 #define IFI_CANFD_RXSTCMD 0x4 41 #define IFI_CANFD_RXSTCMD_REMOVE_MSG BIT(0) 42 #define IFI_CANFD_RXSTCMD_RESET BIT(7) 43 #define IFI_CANFD_RXSTCMD_EMPTY BIT(8) 44 #define IFI_CANFD_RXSTCMD_OVERFLOW BIT(13) 45 46 #define IFI_CANFD_TXSTCMD 0x8 47 #define IFI_CANFD_TXSTCMD_ADD_MSG BIT(0) 48 #define IFI_CANFD_TXSTCMD_HIGH_PRIO BIT(1) 49 #define IFI_CANFD_TXSTCMD_RESET BIT(7) 50 #define IFI_CANFD_TXSTCMD_EMPTY BIT(8) 51 #define IFI_CANFD_TXSTCMD_FULL BIT(12) 52 #define IFI_CANFD_TXSTCMD_OVERFLOW BIT(13) 53 54 #define IFI_CANFD_INTERRUPT 0xc 55 #define IFI_CANFD_INTERRUPT_ERROR_WARNING BIT(1) 56 #define IFI_CANFD_INTERRUPT_ERROR_COUNTER BIT(10) 57 #define IFI_CANFD_INTERRUPT_TXFIFO_EMPTY BIT(16) 58 #define IFI_CANFD_INTERRUPT_TXFIFO_REMOVE BIT(22) 59 #define IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY BIT(24) 60 #define IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY_PER BIT(25) 61 #define IFI_CANFD_INTERRUPT_SET_IRQ ((u32)BIT(31)) 62 63 #define IFI_CANFD_IRQMASK 0x10 64 #define IFI_CANFD_IRQMASK_SET_ERR BIT(7) 65 #define IFI_CANFD_IRQMASK_SET_TS BIT(15) 66 #define IFI_CANFD_IRQMASK_TXFIFO_EMPTY BIT(16) 67 #define IFI_CANFD_IRQMASK_SET_TX BIT(23) 68 #define IFI_CANFD_IRQMASK_RXFIFO_NEMPTY BIT(24) 69 #define IFI_CANFD_IRQMASK_SET_RX ((u32)BIT(31)) 70 71 #define IFI_CANFD_TIME 0x14 72 #define IFI_CANFD_FTIME 0x18 73 #define IFI_CANFD_TIME_TIMEB_OFF 0 74 #define IFI_CANFD_TIME_TIMEA_OFF 8 75 #define IFI_CANFD_TIME_PRESCALE_OFF 16 76 #define IFI_CANFD_TIME_SJW_OFF_7_9_8_8 25 77 #define IFI_CANFD_TIME_SJW_OFF_4_12_6_6 28 78 #define IFI_CANFD_TIME_SET_SJW_4_12_6_6 BIT(6) 79 #define IFI_CANFD_TIME_SET_TIMEB_4_12_6_6 BIT(7) 80 #define IFI_CANFD_TIME_SET_PRESC_4_12_6_6 BIT(14) 81 #define IFI_CANFD_TIME_SET_TIMEA_4_12_6_6 BIT(15) 82 83 #define IFI_CANFD_TDELAY 0x1c 84 #define IFI_CANFD_TDELAY_DEFAULT 0xb 85 #define IFI_CANFD_TDELAY_MASK 0x3fff 86 #define IFI_CANFD_TDELAY_ABS BIT(14) 87 #define IFI_CANFD_TDELAY_EN BIT(15) 88 89 #define IFI_CANFD_ERROR 0x20 90 #define IFI_CANFD_ERROR_TX_OFFSET 0 91 #define IFI_CANFD_ERROR_TX_MASK 0xff 92 #define IFI_CANFD_ERROR_RX_OFFSET 16 93 #define IFI_CANFD_ERROR_RX_MASK 0xff 94 95 #define IFI_CANFD_ERRCNT 0x24 96 97 #define IFI_CANFD_SUSPEND 0x28 98 99 #define IFI_CANFD_REPEAT 0x2c 100 101 #define IFI_CANFD_TRAFFIC 0x30 102 103 #define IFI_CANFD_TSCONTROL 0x34 104 105 #define IFI_CANFD_TSC 0x38 106 107 #define IFI_CANFD_TST 0x3c 108 109 #define IFI_CANFD_RES1 0x40 110 111 #define IFI_CANFD_ERROR_CTR 0x44 112 #define IFI_CANFD_ERROR_CTR_UNLOCK_MAGIC 0x21302899 113 #define IFI_CANFD_ERROR_CTR_OVERLOAD_FIRST BIT(0) 114 #define IFI_CANFD_ERROR_CTR_ACK_ERROR_FIRST BIT(1) 115 #define IFI_CANFD_ERROR_CTR_BIT0_ERROR_FIRST BIT(2) 116 #define IFI_CANFD_ERROR_CTR_BIT1_ERROR_FIRST BIT(3) 117 #define IFI_CANFD_ERROR_CTR_STUFF_ERROR_FIRST BIT(4) 118 #define IFI_CANFD_ERROR_CTR_CRC_ERROR_FIRST BIT(5) 119 #define IFI_CANFD_ERROR_CTR_FORM_ERROR_FIRST BIT(6) 120 #define IFI_CANFD_ERROR_CTR_OVERLOAD_ALL BIT(8) 121 #define IFI_CANFD_ERROR_CTR_ACK_ERROR_ALL BIT(9) 122 #define IFI_CANFD_ERROR_CTR_BIT0_ERROR_ALL BIT(10) 123 #define IFI_CANFD_ERROR_CTR_BIT1_ERROR_ALL BIT(11) 124 #define IFI_CANFD_ERROR_CTR_STUFF_ERROR_ALL BIT(12) 125 #define IFI_CANFD_ERROR_CTR_CRC_ERROR_ALL BIT(13) 126 #define IFI_CANFD_ERROR_CTR_FORM_ERROR_ALL BIT(14) 127 #define IFI_CANFD_ERROR_CTR_BITPOSITION_OFFSET 16 128 #define IFI_CANFD_ERROR_CTR_BITPOSITION_MASK 0xff 129 #define IFI_CANFD_ERROR_CTR_ER_RESET BIT(30) 130 #define IFI_CANFD_ERROR_CTR_ER_ENABLE ((u32)BIT(31)) 131 132 #define IFI_CANFD_PAR 0x48 133 134 #define IFI_CANFD_CANCLOCK 0x4c 135 136 #define IFI_CANFD_SYSCLOCK 0x50 137 138 #define IFI_CANFD_VER 0x54 139 140 #define IFI_CANFD_IP_ID 0x58 141 #define IFI_CANFD_IP_ID_VALUE 0xD073CAFD 142 143 #define IFI_CANFD_TEST 0x5c 144 145 #define IFI_CANFD_RXFIFO_TS_63_32 0x60 146 147 #define IFI_CANFD_RXFIFO_TS_31_0 0x64 148 149 #define IFI_CANFD_RXFIFO_DLC 0x68 150 #define IFI_CANFD_RXFIFO_DLC_DLC_OFFSET 0 151 #define IFI_CANFD_RXFIFO_DLC_DLC_MASK 0xf 152 #define IFI_CANFD_RXFIFO_DLC_RTR BIT(4) 153 #define IFI_CANFD_RXFIFO_DLC_EDL BIT(5) 154 #define IFI_CANFD_RXFIFO_DLC_BRS BIT(6) 155 #define IFI_CANFD_RXFIFO_DLC_ESI BIT(7) 156 #define IFI_CANFD_RXFIFO_DLC_OBJ_OFFSET 8 157 #define IFI_CANFD_RXFIFO_DLC_OBJ_MASK 0x1ff 158 #define IFI_CANFD_RXFIFO_DLC_FNR_OFFSET 24 159 #define IFI_CANFD_RXFIFO_DLC_FNR_MASK 0xff 160 161 #define IFI_CANFD_RXFIFO_ID 0x6c 162 #define IFI_CANFD_RXFIFO_ID_ID_OFFSET 0 163 #define IFI_CANFD_RXFIFO_ID_ID_STD_MASK CAN_SFF_MASK 164 #define IFI_CANFD_RXFIFO_ID_ID_STD_OFFSET 0 165 #define IFI_CANFD_RXFIFO_ID_ID_STD_WIDTH 10 166 #define IFI_CANFD_RXFIFO_ID_ID_XTD_MASK CAN_EFF_MASK 167 #define IFI_CANFD_RXFIFO_ID_ID_XTD_OFFSET 11 168 #define IFI_CANFD_RXFIFO_ID_ID_XTD_WIDTH 18 169 #define IFI_CANFD_RXFIFO_ID_IDE BIT(29) 170 171 #define IFI_CANFD_RXFIFO_DATA 0x70 /* 0x70..0xac */ 172 173 #define IFI_CANFD_TXFIFO_SUSPEND_US 0xb0 174 175 #define IFI_CANFD_TXFIFO_REPEATCOUNT 0xb4 176 177 #define IFI_CANFD_TXFIFO_DLC 0xb8 178 #define IFI_CANFD_TXFIFO_DLC_DLC_OFFSET 0 179 #define IFI_CANFD_TXFIFO_DLC_DLC_MASK 0xf 180 #define IFI_CANFD_TXFIFO_DLC_RTR BIT(4) 181 #define IFI_CANFD_TXFIFO_DLC_EDL BIT(5) 182 #define IFI_CANFD_TXFIFO_DLC_BRS BIT(6) 183 #define IFI_CANFD_TXFIFO_DLC_FNR_OFFSET 24 184 #define IFI_CANFD_TXFIFO_DLC_FNR_MASK 0xff 185 186 #define IFI_CANFD_TXFIFO_ID 0xbc 187 #define IFI_CANFD_TXFIFO_ID_ID_OFFSET 0 188 #define IFI_CANFD_TXFIFO_ID_ID_STD_MASK CAN_SFF_MASK 189 #define IFI_CANFD_TXFIFO_ID_ID_STD_OFFSET 0 190 #define IFI_CANFD_TXFIFO_ID_ID_STD_WIDTH 10 191 #define IFI_CANFD_TXFIFO_ID_ID_XTD_MASK CAN_EFF_MASK 192 #define IFI_CANFD_TXFIFO_ID_ID_XTD_OFFSET 11 193 #define IFI_CANFD_TXFIFO_ID_ID_XTD_WIDTH 18 194 #define IFI_CANFD_TXFIFO_ID_IDE BIT(29) 195 196 #define IFI_CANFD_TXFIFO_DATA 0xc0 /* 0xb0..0xfc */ 197 198 #define IFI_CANFD_FILTER_MASK(n) (0x800 + ((n) * 8) + 0) 199 #define IFI_CANFD_FILTER_MASK_EXT BIT(29) 200 #define IFI_CANFD_FILTER_MASK_EDL BIT(30) 201 #define IFI_CANFD_FILTER_MASK_VALID ((u32)BIT(31)) 202 203 #define IFI_CANFD_FILTER_IDENT(n) (0x800 + ((n) * 8) + 4) 204 #define IFI_CANFD_FILTER_IDENT_IDE BIT(29) 205 #define IFI_CANFD_FILTER_IDENT_CANFD BIT(30) 206 #define IFI_CANFD_FILTER_IDENT_VALID ((u32)BIT(31)) 207 208 /* IFI CANFD private data structure */ 209 struct ifi_canfd_priv { 210 struct can_priv can; /* must be the first member */ 211 struct napi_struct napi; 212 struct net_device *ndev; 213 void __iomem *base; 214 }; 215 216 static void ifi_canfd_irq_enable(struct net_device *ndev, bool enable) 217 { 218 struct ifi_canfd_priv *priv = netdev_priv(ndev); 219 u32 enirq = 0; 220 221 if (enable) { 222 enirq = IFI_CANFD_IRQMASK_TXFIFO_EMPTY | 223 IFI_CANFD_IRQMASK_RXFIFO_NEMPTY; 224 if (priv->can.ctrlmode & CAN_CTRLMODE_BERR_REPORTING) 225 enirq |= IFI_CANFD_INTERRUPT_ERROR_COUNTER; 226 } 227 228 writel(IFI_CANFD_IRQMASK_SET_ERR | 229 IFI_CANFD_IRQMASK_SET_TS | 230 IFI_CANFD_IRQMASK_SET_TX | 231 IFI_CANFD_IRQMASK_SET_RX | enirq, 232 priv->base + IFI_CANFD_IRQMASK); 233 } 234 235 static void ifi_canfd_read_fifo(struct net_device *ndev) 236 { 237 struct net_device_stats *stats = &ndev->stats; 238 struct ifi_canfd_priv *priv = netdev_priv(ndev); 239 struct canfd_frame *cf; 240 struct sk_buff *skb; 241 const u32 rx_irq_mask = IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY | 242 IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY_PER; 243 u32 rxdlc, rxid; 244 u32 dlc, id; 245 int i; 246 247 rxdlc = readl(priv->base + IFI_CANFD_RXFIFO_DLC); 248 if (rxdlc & IFI_CANFD_RXFIFO_DLC_EDL) 249 skb = alloc_canfd_skb(ndev, &cf); 250 else 251 skb = alloc_can_skb(ndev, (struct can_frame **)&cf); 252 253 if (!skb) { 254 stats->rx_dropped++; 255 return; 256 } 257 258 dlc = (rxdlc >> IFI_CANFD_RXFIFO_DLC_DLC_OFFSET) & 259 IFI_CANFD_RXFIFO_DLC_DLC_MASK; 260 if (rxdlc & IFI_CANFD_RXFIFO_DLC_EDL) 261 cf->len = can_dlc2len(dlc); 262 else 263 cf->len = get_can_dlc(dlc); 264 265 rxid = readl(priv->base + IFI_CANFD_RXFIFO_ID); 266 id = (rxid >> IFI_CANFD_RXFIFO_ID_ID_OFFSET); 267 if (id & IFI_CANFD_RXFIFO_ID_IDE) { 268 id &= IFI_CANFD_RXFIFO_ID_ID_XTD_MASK; 269 /* 270 * In case the Extended ID frame is received, the standard 271 * and extended part of the ID are swapped in the register, 272 * so swap them back to obtain the correct ID. 273 */ 274 id = (id >> IFI_CANFD_RXFIFO_ID_ID_XTD_OFFSET) | 275 ((id & IFI_CANFD_RXFIFO_ID_ID_STD_MASK) << 276 IFI_CANFD_RXFIFO_ID_ID_XTD_WIDTH); 277 id |= CAN_EFF_FLAG; 278 } else { 279 id &= IFI_CANFD_RXFIFO_ID_ID_STD_MASK; 280 } 281 cf->can_id = id; 282 283 if (rxdlc & IFI_CANFD_RXFIFO_DLC_ESI) { 284 cf->flags |= CANFD_ESI; 285 netdev_dbg(ndev, "ESI Error\n"); 286 } 287 288 if (!(rxdlc & IFI_CANFD_RXFIFO_DLC_EDL) && 289 (rxdlc & IFI_CANFD_RXFIFO_DLC_RTR)) { 290 cf->can_id |= CAN_RTR_FLAG; 291 } else { 292 if (rxdlc & IFI_CANFD_RXFIFO_DLC_BRS) 293 cf->flags |= CANFD_BRS; 294 295 for (i = 0; i < cf->len; i += 4) { 296 *(u32 *)(cf->data + i) = 297 readl(priv->base + IFI_CANFD_RXFIFO_DATA + i); 298 } 299 } 300 301 /* Remove the packet from FIFO */ 302 writel(IFI_CANFD_RXSTCMD_REMOVE_MSG, priv->base + IFI_CANFD_RXSTCMD); 303 writel(rx_irq_mask, priv->base + IFI_CANFD_INTERRUPT); 304 305 stats->rx_packets++; 306 stats->rx_bytes += cf->len; 307 308 netif_receive_skb(skb); 309 } 310 311 static int ifi_canfd_do_rx_poll(struct net_device *ndev, int quota) 312 { 313 struct ifi_canfd_priv *priv = netdev_priv(ndev); 314 u32 pkts = 0; 315 u32 rxst; 316 317 rxst = readl(priv->base + IFI_CANFD_RXSTCMD); 318 if (rxst & IFI_CANFD_RXSTCMD_EMPTY) { 319 netdev_dbg(ndev, "No messages in RX FIFO\n"); 320 return 0; 321 } 322 323 for (;;) { 324 if (rxst & IFI_CANFD_RXSTCMD_EMPTY) 325 break; 326 if (quota <= 0) 327 break; 328 329 ifi_canfd_read_fifo(ndev); 330 quota--; 331 pkts++; 332 rxst = readl(priv->base + IFI_CANFD_RXSTCMD); 333 } 334 335 if (pkts) 336 can_led_event(ndev, CAN_LED_EVENT_RX); 337 338 return pkts; 339 } 340 341 static int ifi_canfd_handle_lost_msg(struct net_device *ndev) 342 { 343 struct net_device_stats *stats = &ndev->stats; 344 struct sk_buff *skb; 345 struct can_frame *frame; 346 347 netdev_err(ndev, "RX FIFO overflow, message(s) lost.\n"); 348 349 stats->rx_errors++; 350 stats->rx_over_errors++; 351 352 skb = alloc_can_err_skb(ndev, &frame); 353 if (unlikely(!skb)) 354 return 0; 355 356 frame->can_id |= CAN_ERR_CRTL; 357 frame->data[1] = CAN_ERR_CRTL_RX_OVERFLOW; 358 359 netif_receive_skb(skb); 360 361 return 1; 362 } 363 364 static int ifi_canfd_handle_lec_err(struct net_device *ndev, const u32 errctr) 365 { 366 struct ifi_canfd_priv *priv = netdev_priv(ndev); 367 struct net_device_stats *stats = &ndev->stats; 368 struct can_frame *cf; 369 struct sk_buff *skb; 370 const u32 errmask = IFI_CANFD_ERROR_CTR_OVERLOAD_FIRST | 371 IFI_CANFD_ERROR_CTR_ACK_ERROR_FIRST | 372 IFI_CANFD_ERROR_CTR_BIT0_ERROR_FIRST | 373 IFI_CANFD_ERROR_CTR_BIT1_ERROR_FIRST | 374 IFI_CANFD_ERROR_CTR_STUFF_ERROR_FIRST | 375 IFI_CANFD_ERROR_CTR_CRC_ERROR_FIRST | 376 IFI_CANFD_ERROR_CTR_FORM_ERROR_FIRST; 377 378 if (!(errctr & errmask)) /* No error happened. */ 379 return 0; 380 381 priv->can.can_stats.bus_error++; 382 stats->rx_errors++; 383 384 /* Propagate the error condition to the CAN stack. */ 385 skb = alloc_can_err_skb(ndev, &cf); 386 if (unlikely(!skb)) 387 return 0; 388 389 /* Read the error counter register and check for new errors. */ 390 cf->can_id |= CAN_ERR_PROT | CAN_ERR_BUSERROR; 391 392 if (errctr & IFI_CANFD_ERROR_CTR_OVERLOAD_FIRST) 393 cf->data[2] |= CAN_ERR_PROT_OVERLOAD; 394 395 if (errctr & IFI_CANFD_ERROR_CTR_ACK_ERROR_FIRST) 396 cf->data[3] = CAN_ERR_PROT_LOC_ACK; 397 398 if (errctr & IFI_CANFD_ERROR_CTR_BIT0_ERROR_FIRST) 399 cf->data[2] |= CAN_ERR_PROT_BIT0; 400 401 if (errctr & IFI_CANFD_ERROR_CTR_BIT1_ERROR_FIRST) 402 cf->data[2] |= CAN_ERR_PROT_BIT1; 403 404 if (errctr & IFI_CANFD_ERROR_CTR_STUFF_ERROR_FIRST) 405 cf->data[2] |= CAN_ERR_PROT_STUFF; 406 407 if (errctr & IFI_CANFD_ERROR_CTR_CRC_ERROR_FIRST) 408 cf->data[3] = CAN_ERR_PROT_LOC_CRC_SEQ; 409 410 if (errctr & IFI_CANFD_ERROR_CTR_FORM_ERROR_FIRST) 411 cf->data[2] |= CAN_ERR_PROT_FORM; 412 413 /* Reset the error counter, ack the IRQ and re-enable the counter. */ 414 writel(IFI_CANFD_ERROR_CTR_ER_RESET, priv->base + IFI_CANFD_ERROR_CTR); 415 writel(IFI_CANFD_INTERRUPT_ERROR_COUNTER, 416 priv->base + IFI_CANFD_INTERRUPT); 417 writel(IFI_CANFD_ERROR_CTR_ER_ENABLE, priv->base + IFI_CANFD_ERROR_CTR); 418 419 stats->rx_packets++; 420 stats->rx_bytes += cf->can_dlc; 421 netif_receive_skb(skb); 422 423 return 1; 424 } 425 426 static int ifi_canfd_get_berr_counter(const struct net_device *ndev, 427 struct can_berr_counter *bec) 428 { 429 struct ifi_canfd_priv *priv = netdev_priv(ndev); 430 u32 err; 431 432 err = readl(priv->base + IFI_CANFD_ERROR); 433 bec->rxerr = (err >> IFI_CANFD_ERROR_RX_OFFSET) & 434 IFI_CANFD_ERROR_RX_MASK; 435 bec->txerr = (err >> IFI_CANFD_ERROR_TX_OFFSET) & 436 IFI_CANFD_ERROR_TX_MASK; 437 438 return 0; 439 } 440 441 static int ifi_canfd_handle_state_change(struct net_device *ndev, 442 enum can_state new_state) 443 { 444 struct ifi_canfd_priv *priv = netdev_priv(ndev); 445 struct net_device_stats *stats = &ndev->stats; 446 struct can_frame *cf; 447 struct sk_buff *skb; 448 struct can_berr_counter bec; 449 450 switch (new_state) { 451 case CAN_STATE_ERROR_ACTIVE: 452 /* error warning state */ 453 priv->can.can_stats.error_warning++; 454 priv->can.state = CAN_STATE_ERROR_WARNING; 455 break; 456 case CAN_STATE_ERROR_PASSIVE: 457 /* error passive state */ 458 priv->can.can_stats.error_passive++; 459 priv->can.state = CAN_STATE_ERROR_PASSIVE; 460 break; 461 case CAN_STATE_BUS_OFF: 462 /* bus-off state */ 463 priv->can.state = CAN_STATE_BUS_OFF; 464 ifi_canfd_irq_enable(ndev, 0); 465 priv->can.can_stats.bus_off++; 466 can_bus_off(ndev); 467 break; 468 default: 469 break; 470 } 471 472 /* propagate the error condition to the CAN stack */ 473 skb = alloc_can_err_skb(ndev, &cf); 474 if (unlikely(!skb)) 475 return 0; 476 477 ifi_canfd_get_berr_counter(ndev, &bec); 478 479 switch (new_state) { 480 case CAN_STATE_ERROR_ACTIVE: 481 /* error warning state */ 482 cf->can_id |= CAN_ERR_CRTL; 483 cf->data[1] = (bec.txerr > bec.rxerr) ? 484 CAN_ERR_CRTL_TX_WARNING : 485 CAN_ERR_CRTL_RX_WARNING; 486 cf->data[6] = bec.txerr; 487 cf->data[7] = bec.rxerr; 488 break; 489 case CAN_STATE_ERROR_PASSIVE: 490 /* error passive state */ 491 cf->can_id |= CAN_ERR_CRTL; 492 cf->data[1] |= CAN_ERR_CRTL_RX_PASSIVE; 493 if (bec.txerr > 127) 494 cf->data[1] |= CAN_ERR_CRTL_TX_PASSIVE; 495 cf->data[6] = bec.txerr; 496 cf->data[7] = bec.rxerr; 497 break; 498 case CAN_STATE_BUS_OFF: 499 /* bus-off state */ 500 cf->can_id |= CAN_ERR_BUSOFF; 501 break; 502 default: 503 break; 504 } 505 506 stats->rx_packets++; 507 stats->rx_bytes += cf->can_dlc; 508 netif_receive_skb(skb); 509 510 return 1; 511 } 512 513 static int ifi_canfd_handle_state_errors(struct net_device *ndev, u32 stcmd) 514 { 515 struct ifi_canfd_priv *priv = netdev_priv(ndev); 516 int work_done = 0; 517 u32 isr; 518 519 /* 520 * The ErrWarn condition is a little special, since the bit is 521 * located in the INTERRUPT register instead of STCMD register. 522 */ 523 isr = readl(priv->base + IFI_CANFD_INTERRUPT); 524 if ((isr & IFI_CANFD_INTERRUPT_ERROR_WARNING) && 525 (priv->can.state != CAN_STATE_ERROR_WARNING)) { 526 /* Clear the interrupt */ 527 writel(IFI_CANFD_INTERRUPT_ERROR_WARNING, 528 priv->base + IFI_CANFD_INTERRUPT); 529 netdev_dbg(ndev, "Error, entered warning state\n"); 530 work_done += ifi_canfd_handle_state_change(ndev, 531 CAN_STATE_ERROR_WARNING); 532 } 533 534 if ((stcmd & IFI_CANFD_STCMD_ERROR_PASSIVE) && 535 (priv->can.state != CAN_STATE_ERROR_PASSIVE)) { 536 netdev_dbg(ndev, "Error, entered passive state\n"); 537 work_done += ifi_canfd_handle_state_change(ndev, 538 CAN_STATE_ERROR_PASSIVE); 539 } 540 541 if ((stcmd & IFI_CANFD_STCMD_BUSOFF) && 542 (priv->can.state != CAN_STATE_BUS_OFF)) { 543 netdev_dbg(ndev, "Error, entered bus-off state\n"); 544 work_done += ifi_canfd_handle_state_change(ndev, 545 CAN_STATE_BUS_OFF); 546 } 547 548 return work_done; 549 } 550 551 static int ifi_canfd_poll(struct napi_struct *napi, int quota) 552 { 553 struct net_device *ndev = napi->dev; 554 struct ifi_canfd_priv *priv = netdev_priv(ndev); 555 const u32 stcmd_state_mask = IFI_CANFD_STCMD_ERROR_PASSIVE | 556 IFI_CANFD_STCMD_BUSOFF; 557 int work_done = 0; 558 559 u32 stcmd = readl(priv->base + IFI_CANFD_STCMD); 560 u32 rxstcmd = readl(priv->base + IFI_CANFD_RXSTCMD); 561 u32 errctr = readl(priv->base + IFI_CANFD_ERROR_CTR); 562 563 /* Handle bus state changes */ 564 if ((stcmd & stcmd_state_mask) || 565 ((stcmd & IFI_CANFD_STCMD_ERROR_ACTIVE) == 0)) 566 work_done += ifi_canfd_handle_state_errors(ndev, stcmd); 567 568 /* Handle lost messages on RX */ 569 if (rxstcmd & IFI_CANFD_RXSTCMD_OVERFLOW) 570 work_done += ifi_canfd_handle_lost_msg(ndev); 571 572 /* Handle lec errors on the bus */ 573 if (priv->can.ctrlmode & CAN_CTRLMODE_BERR_REPORTING) 574 work_done += ifi_canfd_handle_lec_err(ndev, errctr); 575 576 /* Handle normal messages on RX */ 577 if (!(rxstcmd & IFI_CANFD_RXSTCMD_EMPTY)) 578 work_done += ifi_canfd_do_rx_poll(ndev, quota - work_done); 579 580 if (work_done < quota) { 581 napi_complete_done(napi, work_done); 582 ifi_canfd_irq_enable(ndev, 1); 583 } 584 585 return work_done; 586 } 587 588 static irqreturn_t ifi_canfd_isr(int irq, void *dev_id) 589 { 590 struct net_device *ndev = (struct net_device *)dev_id; 591 struct ifi_canfd_priv *priv = netdev_priv(ndev); 592 struct net_device_stats *stats = &ndev->stats; 593 const u32 rx_irq_mask = IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY | 594 IFI_CANFD_INTERRUPT_RXFIFO_NEMPTY_PER | 595 IFI_CANFD_INTERRUPT_ERROR_WARNING | 596 IFI_CANFD_INTERRUPT_ERROR_COUNTER; 597 const u32 tx_irq_mask = IFI_CANFD_INTERRUPT_TXFIFO_EMPTY | 598 IFI_CANFD_INTERRUPT_TXFIFO_REMOVE; 599 const u32 clr_irq_mask = ~((u32)(IFI_CANFD_INTERRUPT_SET_IRQ | 600 IFI_CANFD_INTERRUPT_ERROR_WARNING)); 601 u32 isr; 602 603 isr = readl(priv->base + IFI_CANFD_INTERRUPT); 604 605 /* No interrupt */ 606 if (isr == 0) 607 return IRQ_NONE; 608 609 /* Clear all pending interrupts but ErrWarn */ 610 writel(clr_irq_mask, priv->base + IFI_CANFD_INTERRUPT); 611 612 /* RX IRQ or bus warning, start NAPI */ 613 if (isr & rx_irq_mask) { 614 ifi_canfd_irq_enable(ndev, 0); 615 napi_schedule(&priv->napi); 616 } 617 618 /* TX IRQ */ 619 if (isr & IFI_CANFD_INTERRUPT_TXFIFO_REMOVE) { 620 stats->tx_bytes += can_get_echo_skb(ndev, 0); 621 stats->tx_packets++; 622 can_led_event(ndev, CAN_LED_EVENT_TX); 623 } 624 625 if (isr & tx_irq_mask) 626 netif_wake_queue(ndev); 627 628 return IRQ_HANDLED; 629 } 630 631 static const struct can_bittiming_const ifi_canfd_bittiming_const = { 632 .name = KBUILD_MODNAME, 633 .tseg1_min = 1, /* Time segment 1 = prop_seg + phase_seg1 */ 634 .tseg1_max = 256, 635 .tseg2_min = 2, /* Time segment 2 = phase_seg2 */ 636 .tseg2_max = 256, 637 .sjw_max = 128, 638 .brp_min = 2, 639 .brp_max = 512, 640 .brp_inc = 1, 641 }; 642 643 static void ifi_canfd_set_bittiming(struct net_device *ndev) 644 { 645 struct ifi_canfd_priv *priv = netdev_priv(ndev); 646 const struct can_bittiming *bt = &priv->can.bittiming; 647 const struct can_bittiming *dbt = &priv->can.data_bittiming; 648 u16 brp, sjw, tseg1, tseg2, tdc; 649 650 /* Configure bit timing */ 651 brp = bt->brp - 2; 652 sjw = bt->sjw - 1; 653 tseg1 = bt->prop_seg + bt->phase_seg1 - 1; 654 tseg2 = bt->phase_seg2 - 2; 655 writel((tseg2 << IFI_CANFD_TIME_TIMEB_OFF) | 656 (tseg1 << IFI_CANFD_TIME_TIMEA_OFF) | 657 (brp << IFI_CANFD_TIME_PRESCALE_OFF) | 658 (sjw << IFI_CANFD_TIME_SJW_OFF_7_9_8_8), 659 priv->base + IFI_CANFD_TIME); 660 661 /* Configure data bit timing */ 662 brp = dbt->brp - 2; 663 sjw = dbt->sjw - 1; 664 tseg1 = dbt->prop_seg + dbt->phase_seg1 - 1; 665 tseg2 = dbt->phase_seg2 - 2; 666 writel((tseg2 << IFI_CANFD_TIME_TIMEB_OFF) | 667 (tseg1 << IFI_CANFD_TIME_TIMEA_OFF) | 668 (brp << IFI_CANFD_TIME_PRESCALE_OFF) | 669 (sjw << IFI_CANFD_TIME_SJW_OFF_7_9_8_8), 670 priv->base + IFI_CANFD_FTIME); 671 672 /* Configure transmitter delay */ 673 tdc = (dbt->brp * (dbt->phase_seg1 + 1)) & IFI_CANFD_TDELAY_MASK; 674 writel(IFI_CANFD_TDELAY_EN | IFI_CANFD_TDELAY_ABS | tdc, 675 priv->base + IFI_CANFD_TDELAY); 676 } 677 678 static void ifi_canfd_set_filter(struct net_device *ndev, const u32 id, 679 const u32 mask, const u32 ident) 680 { 681 struct ifi_canfd_priv *priv = netdev_priv(ndev); 682 683 writel(mask, priv->base + IFI_CANFD_FILTER_MASK(id)); 684 writel(ident, priv->base + IFI_CANFD_FILTER_IDENT(id)); 685 } 686 687 static void ifi_canfd_set_filters(struct net_device *ndev) 688 { 689 /* Receive all CAN frames (standard ID) */ 690 ifi_canfd_set_filter(ndev, 0, 691 IFI_CANFD_FILTER_MASK_VALID | 692 IFI_CANFD_FILTER_MASK_EXT, 693 IFI_CANFD_FILTER_IDENT_VALID); 694 695 /* Receive all CAN frames (extended ID) */ 696 ifi_canfd_set_filter(ndev, 1, 697 IFI_CANFD_FILTER_MASK_VALID | 698 IFI_CANFD_FILTER_MASK_EXT, 699 IFI_CANFD_FILTER_IDENT_VALID | 700 IFI_CANFD_FILTER_IDENT_IDE); 701 702 /* Receive all CANFD frames */ 703 ifi_canfd_set_filter(ndev, 2, 704 IFI_CANFD_FILTER_MASK_VALID | 705 IFI_CANFD_FILTER_MASK_EDL | 706 IFI_CANFD_FILTER_MASK_EXT, 707 IFI_CANFD_FILTER_IDENT_VALID | 708 IFI_CANFD_FILTER_IDENT_CANFD | 709 IFI_CANFD_FILTER_IDENT_IDE); 710 } 711 712 static void ifi_canfd_start(struct net_device *ndev) 713 { 714 struct ifi_canfd_priv *priv = netdev_priv(ndev); 715 u32 stcmd; 716 717 /* Reset the IP */ 718 writel(IFI_CANFD_STCMD_HARDRESET, priv->base + IFI_CANFD_STCMD); 719 writel(IFI_CANFD_STCMD_ENABLE_7_9_8_8_TIMING, 720 priv->base + IFI_CANFD_STCMD); 721 722 ifi_canfd_set_bittiming(ndev); 723 ifi_canfd_set_filters(ndev); 724 725 /* Reset FIFOs */ 726 writel(IFI_CANFD_RXSTCMD_RESET, priv->base + IFI_CANFD_RXSTCMD); 727 writel(0, priv->base + IFI_CANFD_RXSTCMD); 728 writel(IFI_CANFD_TXSTCMD_RESET, priv->base + IFI_CANFD_TXSTCMD); 729 writel(0, priv->base + IFI_CANFD_TXSTCMD); 730 731 /* Repeat transmission until successful */ 732 writel(0, priv->base + IFI_CANFD_REPEAT); 733 writel(0, priv->base + IFI_CANFD_SUSPEND); 734 735 /* Clear all pending interrupts */ 736 writel((u32)(~IFI_CANFD_INTERRUPT_SET_IRQ), 737 priv->base + IFI_CANFD_INTERRUPT); 738 739 stcmd = IFI_CANFD_STCMD_ENABLE | IFI_CANFD_STCMD_NORMAL_MODE | 740 IFI_CANFD_STCMD_ENABLE_7_9_8_8_TIMING; 741 742 if (priv->can.ctrlmode & CAN_CTRLMODE_LISTENONLY) 743 stcmd |= IFI_CANFD_STCMD_BUSMONITOR; 744 745 if (priv->can.ctrlmode & CAN_CTRLMODE_LOOPBACK) 746 stcmd |= IFI_CANFD_STCMD_LOOPBACK; 747 748 if ((priv->can.ctrlmode & CAN_CTRLMODE_FD) && 749 !(priv->can.ctrlmode & CAN_CTRLMODE_FD_NON_ISO)) 750 stcmd |= IFI_CANFD_STCMD_ENABLE_ISO; 751 752 if (!(priv->can.ctrlmode & CAN_CTRLMODE_FD)) 753 stcmd |= IFI_CANFD_STCMD_DISABLE_CANFD; 754 755 priv->can.state = CAN_STATE_ERROR_ACTIVE; 756 757 ifi_canfd_irq_enable(ndev, 1); 758 759 /* Unlock, reset and enable the error counter. */ 760 writel(IFI_CANFD_ERROR_CTR_UNLOCK_MAGIC, 761 priv->base + IFI_CANFD_ERROR_CTR); 762 writel(IFI_CANFD_ERROR_CTR_ER_RESET, priv->base + IFI_CANFD_ERROR_CTR); 763 writel(IFI_CANFD_ERROR_CTR_ER_ENABLE, priv->base + IFI_CANFD_ERROR_CTR); 764 765 /* Enable controller */ 766 writel(stcmd, priv->base + IFI_CANFD_STCMD); 767 } 768 769 static void ifi_canfd_stop(struct net_device *ndev) 770 { 771 struct ifi_canfd_priv *priv = netdev_priv(ndev); 772 773 /* Reset and disable the error counter. */ 774 writel(IFI_CANFD_ERROR_CTR_ER_RESET, priv->base + IFI_CANFD_ERROR_CTR); 775 writel(0, priv->base + IFI_CANFD_ERROR_CTR); 776 777 /* Reset the IP */ 778 writel(IFI_CANFD_STCMD_HARDRESET, priv->base + IFI_CANFD_STCMD); 779 780 /* Mask all interrupts */ 781 writel(~0, priv->base + IFI_CANFD_IRQMASK); 782 783 /* Clear all pending interrupts */ 784 writel((u32)(~IFI_CANFD_INTERRUPT_SET_IRQ), 785 priv->base + IFI_CANFD_INTERRUPT); 786 787 /* Set the state as STOPPED */ 788 priv->can.state = CAN_STATE_STOPPED; 789 } 790 791 static int ifi_canfd_set_mode(struct net_device *ndev, enum can_mode mode) 792 { 793 switch (mode) { 794 case CAN_MODE_START: 795 ifi_canfd_start(ndev); 796 netif_wake_queue(ndev); 797 break; 798 default: 799 return -EOPNOTSUPP; 800 } 801 802 return 0; 803 } 804 805 static int ifi_canfd_open(struct net_device *ndev) 806 { 807 struct ifi_canfd_priv *priv = netdev_priv(ndev); 808 int ret; 809 810 ret = open_candev(ndev); 811 if (ret) { 812 netdev_err(ndev, "Failed to open CAN device\n"); 813 return ret; 814 } 815 816 /* Register interrupt handler */ 817 ret = request_irq(ndev->irq, ifi_canfd_isr, IRQF_SHARED, 818 ndev->name, ndev); 819 if (ret < 0) { 820 netdev_err(ndev, "Failed to request interrupt\n"); 821 goto err_irq; 822 } 823 824 ifi_canfd_start(ndev); 825 826 can_led_event(ndev, CAN_LED_EVENT_OPEN); 827 napi_enable(&priv->napi); 828 netif_start_queue(ndev); 829 830 return 0; 831 err_irq: 832 close_candev(ndev); 833 return ret; 834 } 835 836 static int ifi_canfd_close(struct net_device *ndev) 837 { 838 struct ifi_canfd_priv *priv = netdev_priv(ndev); 839 840 netif_stop_queue(ndev); 841 napi_disable(&priv->napi); 842 843 ifi_canfd_stop(ndev); 844 845 free_irq(ndev->irq, ndev); 846 847 close_candev(ndev); 848 849 can_led_event(ndev, CAN_LED_EVENT_STOP); 850 851 return 0; 852 } 853 854 static netdev_tx_t ifi_canfd_start_xmit(struct sk_buff *skb, 855 struct net_device *ndev) 856 { 857 struct ifi_canfd_priv *priv = netdev_priv(ndev); 858 struct canfd_frame *cf = (struct canfd_frame *)skb->data; 859 u32 txst, txid, txdlc; 860 int i; 861 862 if (can_dropped_invalid_skb(ndev, skb)) 863 return NETDEV_TX_OK; 864 865 /* Check if the TX buffer is full */ 866 txst = readl(priv->base + IFI_CANFD_TXSTCMD); 867 if (txst & IFI_CANFD_TXSTCMD_FULL) { 868 netif_stop_queue(ndev); 869 netdev_err(ndev, "BUG! TX FIFO full when queue awake!\n"); 870 return NETDEV_TX_BUSY; 871 } 872 873 netif_stop_queue(ndev); 874 875 if (cf->can_id & CAN_EFF_FLAG) { 876 txid = cf->can_id & CAN_EFF_MASK; 877 /* 878 * In case the Extended ID frame is transmitted, the 879 * standard and extended part of the ID are swapped 880 * in the register, so swap them back to send the 881 * correct ID. 882 */ 883 txid = (txid >> IFI_CANFD_TXFIFO_ID_ID_XTD_WIDTH) | 884 ((txid & IFI_CANFD_TXFIFO_ID_ID_XTD_MASK) << 885 IFI_CANFD_TXFIFO_ID_ID_XTD_OFFSET); 886 txid |= IFI_CANFD_TXFIFO_ID_IDE; 887 } else { 888 txid = cf->can_id & CAN_SFF_MASK; 889 } 890 891 txdlc = can_len2dlc(cf->len); 892 if ((priv->can.ctrlmode & CAN_CTRLMODE_FD) && can_is_canfd_skb(skb)) { 893 txdlc |= IFI_CANFD_TXFIFO_DLC_EDL; 894 if (cf->flags & CANFD_BRS) 895 txdlc |= IFI_CANFD_TXFIFO_DLC_BRS; 896 } 897 898 if (cf->can_id & CAN_RTR_FLAG) 899 txdlc |= IFI_CANFD_TXFIFO_DLC_RTR; 900 901 /* message ram configuration */ 902 writel(txid, priv->base + IFI_CANFD_TXFIFO_ID); 903 writel(txdlc, priv->base + IFI_CANFD_TXFIFO_DLC); 904 905 for (i = 0; i < cf->len; i += 4) { 906 writel(*(u32 *)(cf->data + i), 907 priv->base + IFI_CANFD_TXFIFO_DATA + i); 908 } 909 910 writel(0, priv->base + IFI_CANFD_TXFIFO_REPEATCOUNT); 911 writel(0, priv->base + IFI_CANFD_TXFIFO_SUSPEND_US); 912 913 can_put_echo_skb(skb, ndev, 0); 914 915 /* Start the transmission */ 916 writel(IFI_CANFD_TXSTCMD_ADD_MSG, priv->base + IFI_CANFD_TXSTCMD); 917 918 return NETDEV_TX_OK; 919 } 920 921 static const struct net_device_ops ifi_canfd_netdev_ops = { 922 .ndo_open = ifi_canfd_open, 923 .ndo_stop = ifi_canfd_close, 924 .ndo_start_xmit = ifi_canfd_start_xmit, 925 .ndo_change_mtu = can_change_mtu, 926 }; 927 928 static int ifi_canfd_plat_probe(struct platform_device *pdev) 929 { 930 struct device *dev = &pdev->dev; 931 struct net_device *ndev; 932 struct ifi_canfd_priv *priv; 933 struct resource *res; 934 void __iomem *addr; 935 int irq, ret; 936 u32 id; 937 938 res = platform_get_resource(pdev, IORESOURCE_MEM, 0); 939 addr = devm_ioremap_resource(dev, res); 940 irq = platform_get_irq(pdev, 0); 941 if (IS_ERR(addr) || irq < 0) 942 return -EINVAL; 943 944 id = readl(addr + IFI_CANFD_IP_ID); 945 if (id != IFI_CANFD_IP_ID_VALUE) { 946 dev_err(dev, "This block is not IFI CANFD, id=%08x\n", id); 947 return -EINVAL; 948 } 949 950 ndev = alloc_candev(sizeof(*priv), 1); 951 if (!ndev) 952 return -ENOMEM; 953 954 ndev->irq = irq; 955 ndev->flags |= IFF_ECHO; /* we support local echo */ 956 ndev->netdev_ops = &ifi_canfd_netdev_ops; 957 958 priv = netdev_priv(ndev); 959 priv->ndev = ndev; 960 priv->base = addr; 961 962 netif_napi_add(ndev, &priv->napi, ifi_canfd_poll, 64); 963 964 priv->can.state = CAN_STATE_STOPPED; 965 966 priv->can.clock.freq = readl(addr + IFI_CANFD_CANCLOCK); 967 968 priv->can.bittiming_const = &ifi_canfd_bittiming_const; 969 priv->can.data_bittiming_const = &ifi_canfd_bittiming_const; 970 priv->can.do_set_mode = ifi_canfd_set_mode; 971 priv->can.do_get_berr_counter = ifi_canfd_get_berr_counter; 972 973 /* IFI CANFD can do both Bosch FD and ISO FD */ 974 priv->can.ctrlmode = CAN_CTRLMODE_FD; 975 976 /* IFI CANFD can do both Bosch FD and ISO FD */ 977 priv->can.ctrlmode_supported = CAN_CTRLMODE_LOOPBACK | 978 CAN_CTRLMODE_LISTENONLY | 979 CAN_CTRLMODE_FD | 980 CAN_CTRLMODE_FD_NON_ISO | 981 CAN_CTRLMODE_BERR_REPORTING; 982 983 platform_set_drvdata(pdev, ndev); 984 SET_NETDEV_DEV(ndev, dev); 985 986 ret = register_candev(ndev); 987 if (ret) { 988 dev_err(dev, "Failed to register (ret=%d)\n", ret); 989 goto err_reg; 990 } 991 992 devm_can_led_init(ndev); 993 994 dev_info(dev, "Driver registered: regs=%p, irq=%d, clock=%d\n", 995 priv->base, ndev->irq, priv->can.clock.freq); 996 997 return 0; 998 999 err_reg: 1000 free_candev(ndev); 1001 return ret; 1002 } 1003 1004 static int ifi_canfd_plat_remove(struct platform_device *pdev) 1005 { 1006 struct net_device *ndev = platform_get_drvdata(pdev); 1007 1008 unregister_candev(ndev); 1009 platform_set_drvdata(pdev, NULL); 1010 free_candev(ndev); 1011 1012 return 0; 1013 } 1014 1015 static const struct of_device_id ifi_canfd_of_table[] = { 1016 { .compatible = "ifi,canfd-1.0", .data = NULL }, 1017 { /* sentinel */ }, 1018 }; 1019 MODULE_DEVICE_TABLE(of, ifi_canfd_of_table); 1020 1021 static struct platform_driver ifi_canfd_plat_driver = { 1022 .driver = { 1023 .name = KBUILD_MODNAME, 1024 .of_match_table = ifi_canfd_of_table, 1025 }, 1026 .probe = ifi_canfd_plat_probe, 1027 .remove = ifi_canfd_plat_remove, 1028 }; 1029 1030 module_platform_driver(ifi_canfd_plat_driver); 1031 1032 MODULE_AUTHOR("Marek Vasut <marex@denx.de>"); 1033 MODULE_LICENSE("GPL v2"); 1034 MODULE_DESCRIPTION("CAN bus driver for IFI CANFD controller"); 1035