41 lines
1.3 KiB
Diff
41 lines
1.3 KiB
Diff
|
From 4c26434ac773e37f30ee5a8fa6f7275fe7dabac2 Mon Sep 17 00:00:00 2001
|
||
|
|
From: Joakim Zhang <qiangqing.zhang@nxp.com>
|
||
|
|
Date: Fri, 12 Jul 2019 08:02:47 +0000
|
||
|
|
Subject: [PATCH] can: flexcan: add CAN FD BRS support
|
||
|
|
|
||
|
|
This patch adds CAN FD BitRate Switch (BRS) support to driver.
|
||
|
|
|
||
|
|
Signed-off-by: Joakim Zhang <qiangqing.zhang@nxp.com>
|
||
|
|
Signed-off-by: Marc Kleine-Budde <mkl@pengutronix.de>
|
||
|
|
---
|
||
|
|
drivers/net/can/flexcan.c | 9 ++++++++-
|
||
|
|
1 file changed, 8 insertions(+), 1 deletion(-)
|
||
|
|
|
||
|
|
--- a/drivers/net/can/flexcan.c
|
||
|
|
+++ b/drivers/net/can/flexcan.c
|
||
|
|
@@ -703,9 +703,13 @@ static netdev_tx_t flexcan_start_xmit(st
|
||
|
|
if (cfd->can_id & CAN_RTR_FLAG)
|
||
|
|
ctrl |= FLEXCAN_MB_CNT_RTR;
|
||
|
|
|
||
|
|
- if (can_is_canfd_skb(skb))
|
||
|
|
+ if (can_is_canfd_skb(skb)) {
|
||
|
|
ctrl |= FLEXCAN_MB_CNT_EDL;
|
||
|
|
|
||
|
|
+ if (cfd->flags & CANFD_BRS)
|
||
|
|
+ ctrl |= FLEXCAN_MB_CNT_BRS;
|
||
|
|
+ }
|
||
|
|
+
|
||
|
|
for (i = 0; i < cfd->len; i += sizeof(u32)) {
|
||
|
|
data = be32_to_cpup((__be32 *)&cfd->data[i]);
|
||
|
|
priv->write(data, &priv->tx_mb->data[i / sizeof(u32)]);
|
||
|
|
@@ -936,6 +940,9 @@ static struct sk_buff *flexcan_mailbox_r
|
||
|
|
|
||
|
|
if (reg_ctrl & FLEXCAN_MB_CNT_EDL) {
|
||
|
|
cfd->len = can_dlc2len(get_canfd_dlc((reg_ctrl >> 16) & 0xf));
|
||
|
|
+
|
||
|
|
+ if (reg_ctrl & FLEXCAN_MB_CNT_BRS)
|
||
|
|
+ cfd->flags |= CANFD_BRS;
|
||
|
|
} else {
|
||
|
|
cfd->len = get_can_dlc((reg_ctrl >> 16) & 0xf);
|
||
|
|
|