Commit e3b5fa0f authored by Marc Kleine-Budde's avatar Marc Kleine-Budde
Browse files

can: rockchip_canfd: add support for CAN_CTRLMODE_BERR_REPORTING 



Add support for Bus Error Reporting.

Tested-by: default avatarAlibek Omarov <a1ba.omarov@gmail.com>
Acked-by: default avatarHeiko Stuebner <heiko@sntech.de>
Link: https://patch.msgid.link/20240904-rockchip-canfd-v5-20-8ae22bcb27cc@pengutronix.de


Signed-off-by: default avatarMarc Kleine-Budde <mkl@pengutronix.de>
parent edf1dd18

drivers/net/can/rockchip/rockchip_canfd-core.c

+17 −8
Original line number Diff line number Diff line
@@ -293,6 +293,12 @@ static void rkcanfd_chip_start(struct rkcanfd_priv *priv) 
		RKCANFD_REG_INT_OVERLOAD_INT |

		RKCANFD_REG_INT_TX_FINISH_INT;



	/* Do not mask the bus error interrupt if the bus error

	 * reporting is requested.

	 */

	if (!(priv->can.ctrlmode & CAN_CTRLMODE_BERR_REPORTING))

		priv->reg_int_mask_default |= RKCANFD_REG_INT_ERROR_INT;



	memset(&priv->bec, 0x0, sizeof(priv->bec));



	rkcanfd_chip_fifo_setup(priv);
@@ -533,6 +539,7 @@ static int rkcanfd_handle_error_int(struct rkcanfd_priv *priv) 
	if (!reg_ec)

		return 0;



	if (priv->can.ctrlmode & CAN_CTRLMODE_BERR_REPORTING) {

		skb = rkcanfd_alloc_can_err_skb(priv, &cf, &timestamp);

		if (cf) {

			struct can_berr_counter bec;
@@ -542,6 +549,7 @@ static int rkcanfd_handle_error_int(struct rkcanfd_priv *priv) 
			cf->data[6] = bec.txerr;

			cf->data[7] = bec.rxerr;

		}

	}



	rkcanfd_handle_error_int_reg_ec(priv, cf, reg_ec);
@@ -899,7 +907,8 @@ static int rkcanfd_probe(struct platform_device *pdev) 
	priv->can.clock.freq = clk_get_rate(priv->clks[0].clk);

	priv->can.bittiming_const = &rkcanfd_bittiming_const;

	priv->can.data_bittiming_const = &rkcanfd_data_bittiming_const;

	priv->can.ctrlmode_supported = CAN_CTRLMODE_LOOPBACK;

	priv->can.ctrlmode_supported = CAN_CTRLMODE_LOOPBACK |

		CAN_CTRLMODE_BERR_REPORTING;

	if (!(priv->devtype_data.quirks & RKCANFD_QUIRK_CANFD_BROKEN))

		priv->can.ctrlmode_supported |= CAN_CTRLMODE_FD;

	priv->can.do_set_mode = rkcanfd_set_mode;