can/flexcan/flexcan-ethtool.c

0001 // SPDX-License-Identifier: GPL-2.0+
0002 /* Copyright (c) 2022 Amarula Solutions, Dario Binacchi <dario.binacchi@amarulasolutions.com>
0003  * Copyright (c) 2022 Pengutronix, Marc Kleine-Budde <kernel@pengutronix.de>
0004  *
0005  */
0006
0007 #include <linux/can/dev.h>
0008 #include <linux/ethtool.h>
0009 #include <linux/kernel.h>
0010 #include <linux/netdevice.h>
0011 #include <linux/platform_device.h>
0012
0013 #include "flexcan.h"
0014
0015 static const char flexcan_priv_flags_strings[][ETH_GSTRING_LEN] = {
0016 #define FLEXCAN_PRIV_FLAGS_RX_RTR BIT(0)
0017     "rx-rtr",
0018 };
0019
0020 static void
0021 flexcan_get_ringparam(struct net_device *ndev, struct ethtool_ringparam *ring,
0022               struct kernel_ethtool_ringparam *kernel_ring,
0023               struct netlink_ext_ack *ext_ack)
0024 {
0025     const struct flexcan_priv *priv = netdev_priv(ndev);
0026
0027     ring->rx_max_pending = priv->mb_count;
0028     ring->tx_max_pending = priv->mb_count;
0029
0030     if (priv->devtype_data.quirks & FLEXCAN_QUIRK_USE_RX_MAILBOX)
0031         ring->rx_pending = priv->offload.mb_last -
0032             priv->offload.mb_first + 1;
0033     else
0034         ring->rx_pending = 6;   /* RX-FIFO depth is fixed */
0035
0036     /* the drive currently supports only on TX buffer */
0037     ring->tx_pending = 1;
0038 }
0039
0040 static void
0041 flexcan_get_strings(struct net_device *ndev, u32 stringset, u8 *data)
0042 {
0043     switch (stringset) {
0044     case ETH_SS_PRIV_FLAGS:
0045         memcpy(data, flexcan_priv_flags_strings,
0046                sizeof(flexcan_priv_flags_strings));
0047     }
0048 }
0049
0050 static u32 flexcan_get_priv_flags(struct net_device *ndev)
0051 {
0052     const struct flexcan_priv *priv = netdev_priv(ndev);
0053     u32 priv_flags = 0;
0054
0055     if (flexcan_active_rx_rtr(priv))
0056         priv_flags |= FLEXCAN_PRIV_FLAGS_RX_RTR;
0057
0058     return priv_flags;
0059 }
0060
0061 static int flexcan_set_priv_flags(struct net_device *ndev, u32 priv_flags)
0062 {
0063     struct flexcan_priv *priv = netdev_priv(ndev);
0064     u32 quirks = priv->devtype_data.quirks;
0065
0066     if (priv_flags & FLEXCAN_PRIV_FLAGS_RX_RTR) {
0067         if (flexcan_supports_rx_mailbox_rtr(priv))
0068             quirks |= FLEXCAN_QUIRK_USE_RX_MAILBOX;
0069         else if (flexcan_supports_rx_fifo(priv))
0070             quirks &= ~FLEXCAN_QUIRK_USE_RX_MAILBOX;
0071         else
0072             quirks |= FLEXCAN_QUIRK_USE_RX_MAILBOX;
0073     } else {
0074         if (flexcan_supports_rx_mailbox(priv))
0075             quirks |= FLEXCAN_QUIRK_USE_RX_MAILBOX;
0076         else
0077             quirks &= ~FLEXCAN_QUIRK_USE_RX_MAILBOX;
0078     }
0079
0080     if (quirks != priv->devtype_data.quirks && netif_running(ndev))
0081         return -EBUSY;
0082
0083     priv->devtype_data.quirks = quirks;
0084
0085     if (!(priv_flags & FLEXCAN_PRIV_FLAGS_RX_RTR) &&
0086         !flexcan_active_rx_rtr(priv))
0087         netdev_info(ndev,
0088                 "Activating RX mailbox mode, cannot receive RTR frames.\n");
0089
0090     return 0;
0091 }
0092
0093 static int flexcan_get_sset_count(struct net_device *netdev, int sset)
0094 {
0095     switch (sset) {
0096     case ETH_SS_PRIV_FLAGS:
0097         return ARRAY_SIZE(flexcan_priv_flags_strings);
0098     default:
0099         return -EOPNOTSUPP;
0100     }
0101 }
0102
0103 const struct ethtool_ops flexcan_ethtool_ops = {
0104     .get_ringparam = flexcan_get_ringparam,
0105     .get_strings = flexcan_get_strings,
0106     .get_priv_flags = flexcan_get_priv_flags,
0107     .set_priv_flags = flexcan_set_priv_flags,
0108     .get_sset_count = flexcan_get_sset_count,
0109     .get_ts_info = ethtool_op_get_ts_info,
0110 };