[PATCH] net: can: xilinx_can: fix extended frame handling

[PATCH] net: can: xilinx_can: fix extended frame handling

[Jeppe Ledet-Pedersen]

Using IDR_SRR in RXFIFO_ID to test for the presence of data is only
valid for standard frames. For extended frames the bit is always 1 and
IDR_RTR should be used instead. This patch switches the check to use
CAN_RTR_FLAG which is correctly set when reading the ID.

The patch also changes the DW1/DW2 to be read unconditionally, since
this is necessary to remove the frame from the RXFIFO.

Signed-off-by: Jeppe Ledet-Pedersen <jlp@gomspace.com>
Acked-by: Kedareswara rao Appana <appanad@xilinx.com>
---
 drivers/net/can/xilinx_can.c | 7 ++++---
 1 file changed, 4 insertions(+), 3 deletions(-)

diff --git a/drivers/net/can/xilinx_can.c b/drivers/net/can/xilinx_can.c
index 6c67643..0b27769 100644
--- a/drivers/net/can/xilinx_can.c
+++ b/drivers/net/can/xilinx_can.c
@@ -509,10 +509,11 @@ static int xcan_rx(struct net_device *ndev)
 			cf->can_id |= CAN_RTR_FLAG;
 	}
 
-	if (!(id_xcan & XCAN_IDR_SRR_MASK)) {
-		data[0] = priv->read_reg(priv, XCAN_RXFIFO_DW1_OFFSET);
-		data[1] = priv->read_reg(priv, XCAN_RXFIFO_DW2_OFFSET);
+	/* DW1/DW2 must always be read to remove message from RXFIFO */
+	data[0] = priv->read_reg(priv, XCAN_RXFIFO_DW1_OFFSET);
+	data[1] = priv->read_reg(priv, XCAN_RXFIFO_DW2_OFFSET);
 
+	if (!(cf->can_id & CAN_RTR_FLAG)) {
 		/* Change Xilinx CAN data format to socketCAN data format */
 		if (cf->can_dlc > 0)
 			*(__be32 *)(cf->data) = cpu_to_be32(data[0]);
-- 
2.1.0

Re: [PATCH] net: can: xilinx_can: fix extended frame handling

[Marc Kleine-Budde]

[-- Attachment #1: Type: text/plain, Size: 916 bytes --]

On 04/29/2015 05:05 PM, Jeppe Ledet-Pedersen wrote:
> Using IDR_SRR in RXFIFO_ID to test for the presence of data is only
> valid for standard frames. For extended frames the bit is always 1 and
> IDR_RTR should be used instead. This patch switches the check to use
> CAN_RTR_FLAG which is correctly set when reading the ID.
> 
> The patch also changes the DW1/DW2 to be read unconditionally, since
> this is necessary to remove the frame from the RXFIFO.
> 
> Signed-off-by: Jeppe Ledet-Pedersen <jlp@gomspace.com>
> Acked-by: Kedareswara rao Appana <appanad@xilinx.com>

Applied to can. Added stable on Cc.

Thanks,
Marc

-- 
Pengutronix e.K.                  | Marc Kleine-Budde           |
Industrial Linux Solutions        | Phone: +49-231-2826-924     |
Vertretung West/Dortmund          | Fax:   +49-5121-206917-5555 |
Amtsgericht Hildesheim, HRA 2686  | http://www.pengutronix.de   |


[-- Attachment #2: OpenPGP digital signature --]
[-- Type: application/pgp-signature, Size: 801 bytes --]