mirror of
git://nv-tegra.nvidia.com/linux-nv-oot.git
synced 2025-12-22 09:11:26 +03:00
In Linux v6.11, the structure 'kernel_ethtool_ts_info' was added as a
copy of the existing 'ethtool_ts_info' for the kernel and the various
kernel functions were updated to use the new structure. This broke the
build for the nvethernet driver, so add a test to the conftest script to
detect the presence of this new strucutue and update the nvethernet
driver accordingly.
Bug 4749580
Change-Id: I2c5daa0132edee8c98eec3a66e19144484325ab0
Signed-off-by: Jon Hunter <jonathanh@nvidia.com>
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/3176868
(cherry picked from commit 9d6283ca4f)
Reviewed-on: https://git-master.nvidia.com/r/c/linux-nv-oot/+/3178809
GVS: buildbot_gerritrpt <buildbot_gerritrpt@nvidia.com>
Reviewed-by: Revanth Kumar Uppala <ruppala@nvidia.com>
1711 lines
50 KiB
C
1711 lines
50 KiB
C
// SPDX-License-Identifier: GPL-2.0-only
|
||
// SPDX-FileCopyrightText: Copyright (c) 2019-2024 NVIDIA CORPORATION & AFFILIATES. All rights reserved.
|
||
|
||
#include <nvidia/conftest.h>
|
||
|
||
#include <linux/version.h>
|
||
#include "ether_linux.h"
|
||
|
||
/**
|
||
* @addtogroup MMC Stats array length.
|
||
*
|
||
* @brief Helper macro to find MMC stats array length.
|
||
* @{
|
||
*/
|
||
#define OSI_ARRAY_SIZE(x) ((int)sizeof((x)) / (int)sizeof((x)[0]))
|
||
#define ETHER_MMC_STATS_LEN OSI_ARRAY_SIZE(ether_mmc)
|
||
/** @} */
|
||
|
||
/**
|
||
* @brief Ethernet stats
|
||
*/
|
||
struct ether_stats {
|
||
/** Name of the stat */
|
||
char stat_string[ETH_GSTRING_LEN];
|
||
/** size of the stat */
|
||
size_t sizeof_stat;
|
||
/** stat offset */
|
||
size_t stat_offset;
|
||
};
|
||
|
||
#ifndef OSI_STRIPPED_LIB
|
||
/**
|
||
* @brief Name of FRP statistics, with length of name not more than
|
||
* ETH_GSTRING_LEN
|
||
*/
|
||
#define ETHER_PKT_FRP_STAT(y) \
|
||
{ (#y), sizeof_field(struct osi_pkt_err_stats, y), \
|
||
offsetof(struct osi_dma_priv_data, pkt_err_stats.y)}
|
||
|
||
/**
|
||
* @brief FRP statistics
|
||
*/
|
||
static const struct ether_stats ether_frpstrings_stats[] = {
|
||
ETHER_PKT_FRP_STAT(frp_parsed),
|
||
ETHER_PKT_FRP_STAT(frp_dropped),
|
||
ETHER_PKT_FRP_STAT(frp_err),
|
||
ETHER_PKT_FRP_STAT(frp_incomplete),
|
||
};
|
||
|
||
/**
|
||
* @brief Ethernet FRP statistics array length
|
||
*/
|
||
#define ETHER_FRP_STAT_LEN OSI_ARRAY_SIZE(ether_frpstrings_stats)
|
||
|
||
/**
|
||
* @brief Name of pkt_err statistics, with length of name not more than
|
||
* ETH_GSTRING_LEN
|
||
*/
|
||
#define ETHER_PKT_ERR_STAT(y) \
|
||
{ (#y), sizeof_field(struct osi_pkt_err_stats, y), \
|
||
offsetof(struct osi_dma_priv_data, pkt_err_stats.y)}
|
||
|
||
/**
|
||
* @brief ETHER pkt_err statistics
|
||
*/
|
||
static const struct ether_stats ether_cstrings_stats[] = {
|
||
ETHER_PKT_ERR_STAT(ip_header_error),
|
||
ETHER_PKT_ERR_STAT(jabber_timeout_error),
|
||
ETHER_PKT_ERR_STAT(pkt_flush_error),
|
||
ETHER_PKT_ERR_STAT(payload_cs_error),
|
||
ETHER_PKT_ERR_STAT(loss_of_carrier_error),
|
||
ETHER_PKT_ERR_STAT(no_carrier_error),
|
||
ETHER_PKT_ERR_STAT(late_collision_error),
|
||
ETHER_PKT_ERR_STAT(excessive_collision_error),
|
||
ETHER_PKT_ERR_STAT(excessive_deferal_error),
|
||
ETHER_PKT_ERR_STAT(underflow_error),
|
||
ETHER_PKT_ERR_STAT(rx_crc_error),
|
||
ETHER_PKT_ERR_STAT(rx_frame_error),
|
||
ETHER_PKT_ERR_STAT(clear_tx_err),
|
||
ETHER_PKT_ERR_STAT(clear_rx_err),
|
||
};
|
||
|
||
/**
|
||
* @brief pkt_err statistics array length
|
||
*/
|
||
#define ETHER_PKT_ERR_STAT_LEN OSI_ARRAY_SIZE(ether_cstrings_stats)
|
||
|
||
/**
|
||
* @brief Name of extra DMA stat, with length of name not more than ETH_GSTRING_LEN
|
||
*/
|
||
#define ETHER_DMA_EXTRA_STAT(a) \
|
||
{ (#a), sizeof_field(struct osi_xtra_dma_stat_counters, a), \
|
||
offsetof(struct osi_dma_priv_data, dstats.a)}
|
||
/**
|
||
* @brief Ethernet DMA extra statistics
|
||
*/
|
||
static const struct ether_stats ether_dstrings_stats[] = {
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[0]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[1]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[2]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[3]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[4]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[5]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[6]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[7]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[8]),
|
||
ETHER_DMA_EXTRA_STAT(tx_clean_n[9]),
|
||
|
||
/* Tx/Rx frames */
|
||
ETHER_DMA_EXTRA_STAT(tx_pkt_n),
|
||
ETHER_DMA_EXTRA_STAT(rx_pkt_n),
|
||
ETHER_DMA_EXTRA_STAT(tx_vlan_pkt_n),
|
||
ETHER_DMA_EXTRA_STAT(rx_vlan_pkt_n),
|
||
ETHER_DMA_EXTRA_STAT(tx_tso_pkt_n),
|
||
|
||
/* Tx/Rx frames per channels/queues */
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[0]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[1]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[2]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[3]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[4]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[5]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[6]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[7]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[8]),
|
||
ETHER_DMA_EXTRA_STAT(q_tx_pkt_n[9]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[0]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[1]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[2]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[3]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[4]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[5]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[6]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[7]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[8]),
|
||
ETHER_DMA_EXTRA_STAT(q_rx_pkt_n[9]),
|
||
};
|
||
|
||
/**
|
||
* @brief Ethernet extra DMA statistics array length
|
||
*/
|
||
#define ETHER_EXTRA_DMA_STAT_LEN OSI_ARRAY_SIZE(ether_dstrings_stats)
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
|
||
/**
|
||
* @brief Name of extra Ethernet stats, with length of name not more than
|
||
* ETH_GSTRING_LEN MAC
|
||
*/
|
||
#define ETHER_EXTRA_STAT(b) \
|
||
{ #b, sizeof_field(struct ether_xtra_stat_counters, b), \
|
||
offsetof(struct ether_priv_data, xstats.b)}
|
||
/**
|
||
* @brief Ethernet extra statistics
|
||
*/
|
||
static const struct ether_stats ether_gstrings_stats[] = {
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[0]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[1]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[2]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[3]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[4]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[5]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[6]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[7]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[8]),
|
||
ETHER_EXTRA_STAT(re_alloc_rxbuf_failed[9]),
|
||
|
||
|
||
/* Tx/Rx IRQ Events */
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[0]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[1]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[2]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[3]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[4]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[5]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[6]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[7]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[8]),
|
||
ETHER_EXTRA_STAT(tx_normal_irq_n[9]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[0]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[1]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[2]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[3]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[4]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[5]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[6]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[7]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[8]),
|
||
ETHER_EXTRA_STAT(tx_usecs_swtimer_n[9]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[0]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[1]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[2]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[3]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[4]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[5]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[6]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[7]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[8]),
|
||
ETHER_EXTRA_STAT(rx_normal_irq_n[9]),
|
||
ETHER_EXTRA_STAT(link_disconnect_count),
|
||
ETHER_EXTRA_STAT(link_connect_count),
|
||
};
|
||
|
||
/**
|
||
* @brief Ethernet extra statistics array length
|
||
*/
|
||
#define ETHER_EXTRA_STAT_LEN OSI_ARRAY_SIZE(ether_gstrings_stats)
|
||
|
||
/**
|
||
* @brief HW MAC Management counters
|
||
* Structure variable name MUST up to MAX length of ETH_GSTRING_LEN
|
||
*/
|
||
#define ETHER_MMC_STAT(c) \
|
||
{ #c, sizeof_field(struct osi_mmc_counters, c), \
|
||
offsetof(struct osi_core_priv_data, mmc.c)}
|
||
|
||
/**
|
||
* @brief MMC statistics
|
||
*/
|
||
static const struct ether_stats ether_mmc[] = {
|
||
/* MMC TX counters */
|
||
ETHER_MMC_STAT(mmc_tx_octetcount_gb),
|
||
ETHER_MMC_STAT(mmc_tx_framecount_gb),
|
||
ETHER_MMC_STAT(mmc_tx_broadcastframe_g),
|
||
ETHER_MMC_STAT(mmc_tx_multicastframe_g),
|
||
ETHER_MMC_STAT(mmc_tx_64_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_65_to_127_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_128_to_255_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_256_to_511_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_512_to_1023_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_1024_to_max_octets_gb),
|
||
ETHER_MMC_STAT(mmc_tx_unicast_gb),
|
||
ETHER_MMC_STAT(mmc_tx_multicast_gb),
|
||
ETHER_MMC_STAT(mmc_tx_broadcast_gb),
|
||
ETHER_MMC_STAT(mmc_tx_underflow_error),
|
||
ETHER_MMC_STAT(mmc_tx_singlecol_g),
|
||
ETHER_MMC_STAT(mmc_tx_multicol_g),
|
||
ETHER_MMC_STAT(mmc_tx_deferred),
|
||
ETHER_MMC_STAT(mmc_tx_latecol),
|
||
ETHER_MMC_STAT(mmc_tx_exesscol),
|
||
ETHER_MMC_STAT(mmc_tx_carrier_error),
|
||
ETHER_MMC_STAT(mmc_tx_octetcount_g),
|
||
ETHER_MMC_STAT(mmc_tx_framecount_g),
|
||
ETHER_MMC_STAT(mmc_tx_excessdef),
|
||
ETHER_MMC_STAT(mmc_tx_pause_frame),
|
||
ETHER_MMC_STAT(mmc_tx_vlan_frame_g),
|
||
|
||
/* MMC RX counters */
|
||
ETHER_MMC_STAT(mmc_rx_framecount_gb),
|
||
ETHER_MMC_STAT(mmc_rx_octetcount_gb),
|
||
ETHER_MMC_STAT(mmc_rx_octetcount_g),
|
||
ETHER_MMC_STAT(mmc_rx_broadcastframe_g),
|
||
ETHER_MMC_STAT(mmc_rx_multicastframe_g),
|
||
ETHER_MMC_STAT(mmc_rx_crc_error),
|
||
ETHER_MMC_STAT(mmc_rx_align_error),
|
||
ETHER_MMC_STAT(mmc_rx_runt_error),
|
||
ETHER_MMC_STAT(mmc_rx_jabber_error),
|
||
ETHER_MMC_STAT(mmc_rx_undersize_g),
|
||
ETHER_MMC_STAT(mmc_rx_oversize_g),
|
||
ETHER_MMC_STAT(mmc_rx_64_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_65_to_127_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_128_to_255_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_256_to_511_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_512_to_1023_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_1024_to_max_octets_gb),
|
||
ETHER_MMC_STAT(mmc_rx_unicast_g),
|
||
ETHER_MMC_STAT(mmc_rx_length_error),
|
||
ETHER_MMC_STAT(mmc_rx_outofrangetype),
|
||
ETHER_MMC_STAT(mmc_rx_pause_frames),
|
||
ETHER_MMC_STAT(mmc_rx_fifo_overflow),
|
||
ETHER_MMC_STAT(mmc_rx_vlan_frames_gb),
|
||
ETHER_MMC_STAT(mmc_rx_watchdog_error),
|
||
ETHER_MMC_STAT(mmc_rx_receive_error),
|
||
ETHER_MMC_STAT(mmc_rx_ctrl_frames_g),
|
||
|
||
/* LPI */
|
||
ETHER_MMC_STAT(mmc_tx_lpi_usec_cntr),
|
||
ETHER_MMC_STAT(mmc_tx_lpi_tran_cntr),
|
||
ETHER_MMC_STAT(mmc_rx_lpi_usec_cntr),
|
||
ETHER_MMC_STAT(mmc_rx_lpi_tran_cntr),
|
||
|
||
/* IPv4 */
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_gd),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_hderr),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_nopay),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_frag),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_udsbl),
|
||
|
||
/* IPV6 */
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_gd_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_hderr_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_nopay_octets),
|
||
|
||
/* Protocols */
|
||
ETHER_MMC_STAT(mmc_rx_udp_gd),
|
||
ETHER_MMC_STAT(mmc_rx_udp_err),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_gd),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_err),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_gd),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_err),
|
||
|
||
/* IPv4 */
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_gd_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_hderr_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_nopay_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_frag_octets),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_udsbl_octets),
|
||
|
||
/* IPV6 */
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_gd),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_hderr),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_nopay),
|
||
|
||
/* Protocols */
|
||
ETHER_MMC_STAT(mmc_rx_udp_gd_octets),
|
||
ETHER_MMC_STAT(mmc_rx_udp_err_octets),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_gd_octets),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_err_octets),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_gd_octets),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_err_octets),
|
||
|
||
/* MGBE stats */
|
||
ETHER_MMC_STAT(mmc_tx_octetcount_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_framecount_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_broadcastframe_g_h),
|
||
ETHER_MMC_STAT(mmc_tx_multicastframe_g_h),
|
||
ETHER_MMC_STAT(mmc_tx_64_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_65_to_127_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_128_to_255_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_256_to_511_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_512_to_1023_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_1024_to_max_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_unicast_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_multicast_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_broadcast_gb_h),
|
||
ETHER_MMC_STAT(mmc_tx_underflow_error_h),
|
||
ETHER_MMC_STAT(mmc_tx_octetcount_g_h),
|
||
ETHER_MMC_STAT(mmc_tx_framecount_g_h),
|
||
ETHER_MMC_STAT(mmc_tx_pause_frame_h),
|
||
ETHER_MMC_STAT(mmc_tx_vlan_frame_g_h),
|
||
ETHER_MMC_STAT(mmc_rx_framecount_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_octetcount_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_octetcount_g_h),
|
||
ETHER_MMC_STAT(mmc_rx_broadcastframe_g_h),
|
||
ETHER_MMC_STAT(mmc_rx_multicastframe_g_h),
|
||
ETHER_MMC_STAT(mmc_rx_crc_error_h),
|
||
ETHER_MMC_STAT(mmc_rx_64_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_65_to_127_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_128_to_255_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_256_to_511_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_512_to_1023_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_1024_to_max_octets_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_unicast_g_h),
|
||
ETHER_MMC_STAT(mmc_rx_length_error_h),
|
||
ETHER_MMC_STAT(mmc_rx_outofrangetype_h),
|
||
ETHER_MMC_STAT(mmc_rx_pause_frames_h),
|
||
ETHER_MMC_STAT(mmc_rx_fifo_overflow_h),
|
||
ETHER_MMC_STAT(mmc_rx_vlan_frames_gb_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_gd_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_hderr_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_nopay_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_frag_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_udsbl_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_gd_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_hderr_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_nopay_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_udp_gd_h),
|
||
ETHER_MMC_STAT(mmc_rx_udp_err_h),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_gd_h),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_err_h),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_gd_h),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_err_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_gd_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_hderr_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_nopay_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_frag_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv4_udsbl_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_gd_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_hderr_h),
|
||
ETHER_MMC_STAT(mmc_rx_ipv6_nopay_h),
|
||
ETHER_MMC_STAT(mmc_rx_udp_gd_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_udp_err_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_gd_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_tcp_err_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_gd_octets_h),
|
||
ETHER_MMC_STAT(mmc_rx_icmp_err_octets_h),
|
||
/* FPE */
|
||
ETHER_MMC_STAT(mmc_tx_fpe_frag_cnt),
|
||
ETHER_MMC_STAT(mmc_tx_fpe_hold_req_cnt),
|
||
ETHER_MMC_STAT(mmc_rx_packet_reass_err_cnt),
|
||
ETHER_MMC_STAT(mmc_rx_packet_smd_err_cnt),
|
||
ETHER_MMC_STAT(mmc_rx_packet_asm_ok_cnt),
|
||
ETHER_MMC_STAT(mmc_rx_fpe_fragment_cnt),
|
||
};
|
||
|
||
/**
|
||
* @brief Ethernet extra statistics array length
|
||
*/
|
||
#define ETHER_CORE_STAT_LEN OSI_ARRAY_SIZE(ether_tstrings_stats)
|
||
|
||
/**
|
||
* @brief Name of extra Ethernet stats, with length of name not more than
|
||
* ETH_GSTRING_LEN MAC
|
||
*/
|
||
#define ETHER_CORE_STATS(r) \
|
||
{ (#r), sizeof_field(struct osi_stats, r), \
|
||
offsetof(struct osi_core_priv_data, stats.r)}
|
||
|
||
/**
|
||
* @brief Ethernet extra statistics
|
||
*/
|
||
static const struct ether_stats ether_tstrings_stats[] = {
|
||
ETHER_CORE_STATS(const_gate_ctr_err),
|
||
ETHER_CORE_STATS(head_of_line_blk_sch),
|
||
ETHER_CORE_STATS(hlbs_q[0]),
|
||
ETHER_CORE_STATS(hlbs_q[1]),
|
||
ETHER_CORE_STATS(hlbs_q[2]),
|
||
ETHER_CORE_STATS(hlbs_q[3]),
|
||
ETHER_CORE_STATS(hlbs_q[4]),
|
||
ETHER_CORE_STATS(hlbs_q[5]),
|
||
ETHER_CORE_STATS(hlbs_q[6]),
|
||
ETHER_CORE_STATS(hlbs_q[7]),
|
||
ETHER_CORE_STATS(head_of_line_blk_frm),
|
||
ETHER_CORE_STATS(hlbf_q[0]),
|
||
ETHER_CORE_STATS(hlbf_q[1]),
|
||
ETHER_CORE_STATS(hlbf_q[2]),
|
||
ETHER_CORE_STATS(hlbf_q[3]),
|
||
ETHER_CORE_STATS(hlbf_q[4]),
|
||
ETHER_CORE_STATS(hlbf_q[5]),
|
||
ETHER_CORE_STATS(hlbf_q[6]),
|
||
ETHER_CORE_STATS(hlbf_q[7]),
|
||
ETHER_CORE_STATS(base_time_reg_err),
|
||
ETHER_CORE_STATS(sw_own_list_complete),
|
||
|
||
#ifndef OSI_STRIPPED_LIB
|
||
/* Tx/Rx IRQ error info */
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[0]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[1]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[2]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[3]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[4]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[5]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[6]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[7]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[8]),
|
||
ETHER_CORE_STATS(tx_proc_stopped_irq_n[9]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[0]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[1]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[2]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[3]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[4]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[5]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[6]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[7]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[8]),
|
||
ETHER_CORE_STATS(rx_proc_stopped_irq_n[9]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[0]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[1]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[2]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[3]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[4]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[5]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[6]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[7]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[8]),
|
||
ETHER_CORE_STATS(tx_buf_unavail_irq_n[9]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[0]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[1]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[2]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[3]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[4]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[5]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[6]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[7]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[8]),
|
||
ETHER_CORE_STATS(rx_buf_unavail_irq_n[9]),
|
||
ETHER_CORE_STATS(rx_watchdog_irq_n),
|
||
ETHER_CORE_STATS(fatal_bus_error_irq_n),
|
||
ETHER_CORE_STATS(ts_lock_add_fail),
|
||
ETHER_CORE_STATS(ts_lock_del_fail),
|
||
|
||
/* Packet error stats */
|
||
ETHER_CORE_STATS(mgbe_ip_header_err),
|
||
ETHER_CORE_STATS(mgbe_jabber_timeout_err),
|
||
ETHER_CORE_STATS(mgbe_payload_cs_err),
|
||
ETHER_CORE_STATS(mgbe_tx_underflow_err),
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
};
|
||
|
||
/**
|
||
* @brief This function is invoked by kernel when user requests to get the
|
||
* extended statistics about the device.
|
||
*
|
||
* Algorithm: read mmc register and create strings
|
||
*
|
||
* @param[in] dev: pointer to net device structure.
|
||
* @param[in] dummy: dummy parameter of ethtool_stats type.
|
||
* @param[in] data: Pointer in which MMC statistics should be put.
|
||
*
|
||
* @note Network device needs to created.
|
||
*/
|
||
static void ether_get_ethtool_stats(struct net_device *dev,
|
||
struct ethtool_stats *dummy,
|
||
u64 *data)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(dev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
#ifndef OSI_STRIPPED_LIB
|
||
struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
struct osi_ioctl ioctl_data = {};
|
||
int i, j = 0;
|
||
int ret;
|
||
|
||
if (!netif_running(dev)) {
|
||
netdev_err(pdata->ndev, "%s: iface not up\n", __func__);
|
||
return;
|
||
}
|
||
|
||
if (pdata->hw_feat.mmc_sel == 1U) {
|
||
ioctl_data.cmd = OSI_CMD_READ_MMC;
|
||
ret = osi_handle_ioctl(osi_core, &ioctl_data);
|
||
if (ret == -1) {
|
||
dev_err(pdata->dev, "Error in reading MMC counter\n");
|
||
return;
|
||
}
|
||
|
||
if (osi_core->use_virtualization == OSI_ENABLE) {
|
||
ioctl_data.cmd = OSI_CMD_READ_STATS;
|
||
ret = osi_handle_ioctl(osi_core, &ioctl_data);
|
||
if (ret == -1) {
|
||
dev_err(pdata->dev,
|
||
"Fail to read core stats\n");
|
||
return;
|
||
}
|
||
}
|
||
|
||
for (i = 0; i < ETHER_MMC_STATS_LEN; i++) {
|
||
char *p = (char *)osi_core + ether_mmc[i].stat_offset;
|
||
|
||
data[j++] = (ether_mmc[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) :
|
||
(*(u32 *)p);
|
||
}
|
||
|
||
for (i = 0; i < ETHER_EXTRA_STAT_LEN; i++) {
|
||
char *p = (char *)pdata +
|
||
ether_gstrings_stats[i].stat_offset;
|
||
|
||
data[j++] = (ether_gstrings_stats[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
|
||
}
|
||
|
||
#ifndef OSI_STRIPPED_LIB
|
||
for (i = 0; i < ETHER_EXTRA_DMA_STAT_LEN; i++) {
|
||
char *p = (char *)osi_dma +
|
||
ether_dstrings_stats[i].stat_offset;
|
||
|
||
data[j++] = (ether_dstrings_stats[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
|
||
}
|
||
|
||
for (i = 0; i < ETHER_PKT_ERR_STAT_LEN; i++) {
|
||
char *p = (char *)osi_dma +
|
||
ether_cstrings_stats[i].stat_offset;
|
||
|
||
data[j++] = (ether_cstrings_stats[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
|
||
}
|
||
|
||
for (i = 0; ((i < ETHER_FRP_STAT_LEN) &&
|
||
(pdata->hw_feat.frp_sel == OSI_ENABLE)); i++) {
|
||
char *p = (char *)osi_dma +
|
||
ether_frpstrings_stats[i].stat_offset;
|
||
|
||
data[j++] = (ether_frpstrings_stats[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
|
||
}
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
|
||
for (i = 0; i < ETHER_CORE_STAT_LEN; i++) {
|
||
char *p = (char *)osi_core +
|
||
ether_tstrings_stats[i].stat_offset;
|
||
|
||
data[j++] = (ether_tstrings_stats[i].sizeof_stat ==
|
||
sizeof(u64)) ? (*(u64 *)p) : (*(u32 *)p);
|
||
}
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief This function gets number of strings
|
||
*
|
||
* Algorithm: return number of strings.
|
||
*
|
||
* @param[in] dev: Pointer to net device structure.
|
||
* @param[in] sset: String set value.
|
||
*
|
||
* @note Network device needs to created.
|
||
*
|
||
* @return Numbers of strings(total length)
|
||
*/
|
||
static int ether_get_sset_count(struct net_device *dev, int sset)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(dev);
|
||
int len = 0;
|
||
|
||
if (sset == ETH_SS_STATS) {
|
||
if (pdata->hw_feat.mmc_sel == OSI_ENABLE) {
|
||
if (INT_MAX < ETHER_MMC_STATS_LEN) {
|
||
/* do nothing*/
|
||
} else {
|
||
len = ETHER_MMC_STATS_LEN;
|
||
}
|
||
}
|
||
if (INT_MAX - ETHER_EXTRA_STAT_LEN < len) {
|
||
/* do nothing */
|
||
} else {
|
||
len += ETHER_EXTRA_STAT_LEN;
|
||
}
|
||
#ifndef OSI_STRIPPED_LIB
|
||
if (INT_MAX - ETHER_EXTRA_DMA_STAT_LEN < len) {
|
||
/* do nothing */
|
||
} else {
|
||
len += ETHER_EXTRA_DMA_STAT_LEN;
|
||
}
|
||
if (INT_MAX - ETHER_PKT_ERR_STAT_LEN < len) {
|
||
/* do nothing */
|
||
} else {
|
||
len += ETHER_PKT_ERR_STAT_LEN;
|
||
}
|
||
if (INT_MAX - ETHER_FRP_STAT_LEN < len) {
|
||
/* do nothing */
|
||
} else {
|
||
if (pdata->hw_feat.frp_sel == OSI_ENABLE) {
|
||
len += ETHER_FRP_STAT_LEN;
|
||
}
|
||
}
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
if (INT_MAX - ETHER_CORE_STAT_LEN < len) {
|
||
/* do nothing */
|
||
} else {
|
||
len += ETHER_CORE_STAT_LEN;
|
||
}
|
||
} else if (sset == ETH_SS_TEST) {
|
||
len = ether_selftest_get_count(pdata);
|
||
} else {
|
||
len = -EOPNOTSUPP;
|
||
}
|
||
|
||
return len;
|
||
}
|
||
|
||
/**
|
||
* @brief This function returns a set of strings that describe
|
||
* the requested objects.
|
||
*
|
||
* Algorithm: return number of strings.
|
||
*
|
||
* @param[in] dev: Pointer to net device structure.
|
||
* @param[in] stringset: String set value.
|
||
* @param[in] data: Pointer in which requested string should be put.
|
||
*
|
||
* @note Network device needs to created.
|
||
*/
|
||
static void ether_get_strings(struct net_device *dev, u32 stringset, u8 *data)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(dev);
|
||
u8 *p = data;
|
||
u8 *str;
|
||
int i;
|
||
|
||
if (stringset == (u32)ETH_SS_STATS) {
|
||
if (pdata->hw_feat.mmc_sel == OSI_ENABLE) {
|
||
for (i = 0; i < ETHER_MMC_STATS_LEN; i++) {
|
||
str = (u8 *)ether_mmc[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
|
||
for (i = 0; i < ETHER_EXTRA_STAT_LEN; i++) {
|
||
str = (u8 *)ether_gstrings_stats[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
#ifndef OSI_STRIPPED_LIB
|
||
for (i = 0; i < ETHER_EXTRA_DMA_STAT_LEN; i++) {
|
||
str = (u8 *)ether_dstrings_stats[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
for (i = 0; i < ETHER_PKT_ERR_STAT_LEN; i++) {
|
||
str = (u8 *)ether_cstrings_stats[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
for (i = 0; ((i < ETHER_FRP_STAT_LEN) &&
|
||
(pdata->hw_feat.frp_sel == OSI_ENABLE));
|
||
i++) {
|
||
str = (u8 *)
|
||
ether_frpstrings_stats[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
for (i = 0; i < ETHER_CORE_STAT_LEN; i++) {
|
||
str = (u8 *)ether_tstrings_stats[i].stat_string;
|
||
if (memcpy(p, str, ETH_GSTRING_LEN) ==
|
||
OSI_NULL) {
|
||
return;
|
||
}
|
||
p += ETH_GSTRING_LEN;
|
||
}
|
||
}
|
||
} else if (stringset == (u32)ETH_SS_TEST) {
|
||
ether_selftest_get_strings(pdata, p);
|
||
} else {
|
||
dev_err(pdata->dev, "%s() Unsupported stringset\n", __func__);
|
||
}
|
||
}
|
||
|
||
#ifndef OSI_STRIPPED_LIB
|
||
/**
|
||
* @brief Get pause frame settings
|
||
*
|
||
* Algorithm: Gets pause frame configuration
|
||
*
|
||
* @param[in] ndev: network device instance
|
||
* @param[out] pause: Pause parameters that are set currently
|
||
*
|
||
* @note Network device needs to created.
|
||
*/
|
||
static void ether_get_pauseparam(struct net_device *ndev,
|
||
struct ethtool_pauseparam *pause)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct phy_device *phydev = pdata->phydev;
|
||
|
||
if (!netif_running(ndev)) {
|
||
netdev_err(pdata->ndev, "interface must be up\n");
|
||
return;
|
||
}
|
||
|
||
/* return if pause frame is not supported */
|
||
if ((pdata->osi_core->pause_frames == OSI_PAUSE_FRAMES_DISABLE) ||
|
||
(!linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported) ||
|
||
!linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported))) {
|
||
dev_err(pdata->dev, "FLOW control not supported\n");
|
||
return;
|
||
}
|
||
|
||
/* update auto negotiation */
|
||
pause->autoneg = phydev->autoneg;
|
||
|
||
/* update rx pause parameter */
|
||
if ((pdata->osi_core->flow_ctrl & OSI_FLOW_CTRL_RX) ==
|
||
OSI_FLOW_CTRL_RX) {
|
||
pause->rx_pause = 1;
|
||
}
|
||
|
||
/* update tx pause parameter */
|
||
if ((pdata->osi_core->flow_ctrl & OSI_FLOW_CTRL_TX) ==
|
||
OSI_FLOW_CTRL_TX) {
|
||
pause->tx_pause = 1;
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief Set pause frame settings
|
||
*
|
||
* Algorithm: Sets pause frame settings
|
||
*
|
||
* @param[in] ndev: network device instance
|
||
* @param[in] pause: Pause frame settings
|
||
*
|
||
* @note Network device needs to created.
|
||
*
|
||
* @retval 0 on Sucess
|
||
* @retval "negative value" on failure.
|
||
*/
|
||
static int ether_set_pauseparam(struct net_device *ndev,
|
||
struct ethtool_pauseparam *pause)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_ioctl ioctl_data = {};
|
||
struct phy_device *phydev = pdata->phydev;
|
||
int curflow_ctrl = OSI_FLOW_CTRL_DISABLE;
|
||
int ret;
|
||
|
||
if (!netif_running(ndev)) {
|
||
netdev_err(pdata->ndev, "interface must be up\n");
|
||
return -EINVAL;
|
||
}
|
||
|
||
/* return if pause frame is not supported */
|
||
if ((pdata->osi_core->pause_frames == OSI_PAUSE_FRAMES_DISABLE) ||
|
||
(!linkmode_test_bit(ETHTOOL_LINK_MODE_Pause_BIT, phydev->supported) ||
|
||
!linkmode_test_bit(ETHTOOL_LINK_MODE_Asym_Pause_BIT, phydev->supported))) {
|
||
dev_err(pdata->dev, "FLOW control not supported\n");
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
dev_err(pdata->dev, "autoneg = %d tx_pause = %d rx_pause = %d\n",
|
||
pause->autoneg, pause->tx_pause, pause->rx_pause);
|
||
|
||
if (pause->tx_pause)
|
||
curflow_ctrl |= OSI_FLOW_CTRL_TX;
|
||
|
||
if (pause->rx_pause)
|
||
curflow_ctrl |= OSI_FLOW_CTRL_RX;
|
||
|
||
/* update flow control setting */
|
||
pdata->osi_core->flow_ctrl = curflow_ctrl;
|
||
/* update autonegotiation */
|
||
phydev->autoneg = pause->autoneg;
|
||
|
||
/*If autonegotiation is enabled,start auto-negotiation
|
||
* for this PHY device and return, so that flow control
|
||
* settings will be done once we receive the link changed
|
||
* event i.e in ether_adjust_link
|
||
*/
|
||
if (phydev->autoneg && netif_running(ndev)) {
|
||
return phy_start_aneg(phydev);
|
||
}
|
||
|
||
/* Configure current flow control settings */
|
||
ioctl_data.cmd = OSI_CMD_FLOW_CTRL;
|
||
ioctl_data.arg1_u32 = pdata->osi_core->flow_ctrl;
|
||
ret = osi_handle_ioctl(pdata->osi_core, &ioctl_data);
|
||
if (ret < 0) {
|
||
dev_err(pdata->dev, "Setting flow control failed\n");
|
||
return -EFAULT;
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
|
||
/**
|
||
* @brief Get HW supported time stamping.
|
||
*
|
||
* Algorithm: Function used to query the PTP capabilities for given netdev.
|
||
*
|
||
* @param[in] ndev: Net device data.
|
||
* @param[in] info: Holds device supported timestamping types
|
||
*
|
||
* @note HW need to support PTP functionality.
|
||
*
|
||
* @return zero on success
|
||
*/
|
||
static int ether_get_ts_info(struct net_device *ndev,
|
||
#if defined(NV_ETHTOOL_KERNEL_ETHTOOL_TS_INFO_STRUCT_PRESENT) /* Linux v6.11 */
|
||
struct kernel_ethtool_ts_info *info)
|
||
#else
|
||
struct ethtool_ts_info *info)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
|
||
info->so_timestamping = SOF_TIMESTAMPING_TX_HARDWARE |
|
||
SOF_TIMESTAMPING_RX_HARDWARE |
|
||
SOF_TIMESTAMPING_TX_SOFTWARE |
|
||
SOF_TIMESTAMPING_RX_SOFTWARE |
|
||
SOF_TIMESTAMPING_RAW_HARDWARE |
|
||
SOF_TIMESTAMPING_SOFTWARE;
|
||
|
||
if (pdata->ptp_clock) {
|
||
info->phc_index = ptp_clock_index(pdata->ptp_clock);
|
||
}
|
||
|
||
info->tx_types = ((1 << HWTSTAMP_TX_OFF) |
|
||
(1 << HWTSTAMP_TX_ON) |
|
||
(1 << HWTSTAMP_TX_ONESTEP_SYNC));
|
||
|
||
info->rx_filters |= ((1 << HWTSTAMP_FILTER_PTP_V1_L4_SYNC) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V2_L2_SYNC) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V2_L4_SYNC) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V1_L4_DELAY_REQ) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V2_L2_DELAY_REQ) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V2_L4_DELAY_REQ) |
|
||
(1 << HWTSTAMP_FILTER_PTP_V2_EVENT) |
|
||
(1 << HWTSTAMP_FILTER_NONE));
|
||
|
||
return 0;
|
||
}
|
||
|
||
/**
|
||
* @brief Set interrupt coalescing parameters.
|
||
*
|
||
* Algorithm: This function is invoked by kernel when user request to set
|
||
* interrupt coalescing parameters. This driver maintains same coalescing
|
||
* parameters for all the channels, hence same changes will be applied to
|
||
* all the channels.
|
||
*
|
||
* @param[in] dev: Net device data.
|
||
* @param[in] ec: pointer to ethtool_coalesce structure
|
||
*
|
||
* @note Interface need to be bring down for setting these parameters
|
||
*
|
||
* @retval 0 on Sucess
|
||
* @retval "negative value" on failure.
|
||
*/
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_COALESCE_HAS_COAL_AND_EXTACT_ARGS) /* Linux v5.15 */
|
||
static int ether_set_coalesce(struct net_device *dev,
|
||
struct ethtool_coalesce *ec,
|
||
struct kernel_ethtool_coalesce *kernel_coal,
|
||
struct netlink_ext_ack *extack)
|
||
#else
|
||
static int ether_set_coalesce(struct net_device *dev,
|
||
struct ethtool_coalesce *ec)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(dev);
|
||
struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
|
||
|
||
if (netif_running(dev)) {
|
||
netdev_err(dev, "Coalesce parameters can be changed"
|
||
" only if interface is down\n");
|
||
return -EINVAL;
|
||
}
|
||
|
||
/* Check for not supported parameters */
|
||
if ((ec->rx_coalesce_usecs_irq) ||
|
||
(ec->rx_max_coalesced_frames_irq) || (ec->tx_coalesce_usecs_irq) ||
|
||
(ec->use_adaptive_rx_coalesce) || (ec->use_adaptive_tx_coalesce) ||
|
||
(ec->pkt_rate_low) || (ec->rx_coalesce_usecs_low) ||
|
||
(ec->rx_max_coalesced_frames_low) || (ec->tx_coalesce_usecs_high) ||
|
||
(ec->tx_max_coalesced_frames_low) || (ec->pkt_rate_high) ||
|
||
(ec->tx_coalesce_usecs_low) || (ec->rx_coalesce_usecs_high) ||
|
||
(ec->rx_max_coalesced_frames_high) ||
|
||
(ec->tx_max_coalesced_frames_irq) ||
|
||
(ec->stats_block_coalesce_usecs) ||
|
||
(ec->tx_max_coalesced_frames_high) || (ec->rate_sample_interval)) {
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
if (ec->tx_max_coalesced_frames == OSI_DISABLE) {
|
||
osi_dma->use_tx_frames = OSI_DISABLE;
|
||
} else if ((ec->tx_max_coalesced_frames > ETHER_TX_MAX_FRAME(osi_dma->tx_ring_sz)) ||
|
||
(ec->tx_max_coalesced_frames < ETHER_MIN_TX_COALESCE_FRAMES)) {
|
||
netdev_err(dev,
|
||
"invalid tx-frames, must be in the range of"
|
||
#ifdef CONFIG_MAX_SKB_FRAGS
|
||
" %d to %d frames\n", ETHER_MIN_TX_COALESCE_FRAMES,
|
||
#else
|
||
" %d to %ld frames\n", ETHER_MIN_TX_COALESCE_FRAMES,
|
||
#endif
|
||
ETHER_TX_MAX_FRAME(osi_dma->tx_ring_sz));
|
||
return -EINVAL;
|
||
} else {
|
||
osi_dma->use_tx_frames = OSI_ENABLE;
|
||
}
|
||
|
||
if (ec->tx_coalesce_usecs == OSI_DISABLE) {
|
||
osi_dma->use_tx_usecs = OSI_DISABLE;
|
||
} else if ((ec->tx_coalesce_usecs > ETHER_MAX_TX_COALESCE_USEC) ||
|
||
(ec->tx_coalesce_usecs < ETHER_MIN_TX_COALESCE_USEC)) {
|
||
netdev_err(dev,
|
||
"invalid tx_usecs, must be in a range of"
|
||
" %d to %d usec\n", ETHER_MIN_TX_COALESCE_USEC,
|
||
ETHER_MAX_TX_COALESCE_USEC);
|
||
return -EINVAL;
|
||
} else {
|
||
osi_dma->use_tx_usecs = OSI_ENABLE;
|
||
}
|
||
|
||
netdev_err(dev, "TX COALESCING USECS is %s\n", osi_dma->use_tx_usecs ?
|
||
"ENABLED" : "DISABLED");
|
||
|
||
netdev_err(dev, "TX COALESCING FRAMES is %s\n", osi_dma->use_tx_frames ?
|
||
"ENABLED" : "DISABLED");
|
||
|
||
if (ec->rx_max_coalesced_frames == OSI_DISABLE) {
|
||
osi_dma->use_rx_frames = OSI_DISABLE;
|
||
} else if ((ec->rx_max_coalesced_frames > osi_dma->rx_ring_sz) ||
|
||
(ec->rx_max_coalesced_frames < ETHER_MIN_RX_COALESCE_FRAMES)) {
|
||
netdev_err(dev,
|
||
"invalid rx-frames, must be in the range of"
|
||
" %d to %d frames\n", ETHER_MIN_RX_COALESCE_FRAMES,
|
||
osi_dma->rx_ring_sz);
|
||
return -EINVAL;
|
||
} else {
|
||
osi_dma->use_rx_frames = OSI_ENABLE;
|
||
}
|
||
|
||
if (ec->rx_coalesce_usecs == OSI_DISABLE) {
|
||
osi_dma->use_riwt = OSI_DISABLE;
|
||
} else if (osi_dma->mac == OSI_MAC_HW_EQOS &&
|
||
(ec->rx_coalesce_usecs > ETHER_MAX_RX_COALESCE_USEC ||
|
||
ec->rx_coalesce_usecs < ETHER_EQOS_MIN_RX_COALESCE_USEC)) {
|
||
netdev_err(dev, "invalid rx_usecs, must be in a range of %d to %d usec\n",
|
||
ETHER_EQOS_MIN_RX_COALESCE_USEC,
|
||
ETHER_MAX_RX_COALESCE_USEC);
|
||
return -EINVAL;
|
||
|
||
} else if (osi_dma->mac == OSI_MAC_HW_MGBE &&
|
||
(ec->rx_coalesce_usecs > ETHER_MAX_RX_COALESCE_USEC ||
|
||
ec->rx_coalesce_usecs < ETHER_MGBE_MIN_RX_COALESCE_USEC)) {
|
||
netdev_err(dev,
|
||
"invalid rx_usecs, must be in a range of %d to %d usec\n",
|
||
ETHER_MGBE_MIN_RX_COALESCE_USEC,
|
||
ETHER_MAX_RX_COALESCE_USEC);
|
||
return -EINVAL;
|
||
} else {
|
||
osi_dma->use_riwt = OSI_ENABLE;
|
||
}
|
||
|
||
if (osi_dma->use_tx_usecs == OSI_DISABLE &&
|
||
osi_dma->use_tx_frames == OSI_ENABLE) {
|
||
netdev_err(dev, "invalid settings : tx-frames must be enabled"
|
||
" along with tx-usecs\n");
|
||
return -EINVAL;
|
||
}
|
||
if (osi_dma->use_riwt == OSI_DISABLE &&
|
||
osi_dma->use_rx_frames == OSI_ENABLE) {
|
||
netdev_err(dev, "invalid settings : rx-frames must be enabled"
|
||
" along with rx-usecs\n");
|
||
return -EINVAL;
|
||
}
|
||
netdev_err(dev, "RX COALESCING USECS is %s\n", osi_dma->use_riwt ?
|
||
"ENABLED" : "DISABLED");
|
||
|
||
netdev_err(dev, "RX COALESCING FRAMES is %s\n", osi_dma->use_rx_frames ?
|
||
"ENABLED" : "DISABLED");
|
||
|
||
osi_dma->rx_riwt = ec->rx_coalesce_usecs;
|
||
osi_dma->rx_frames = ec->rx_max_coalesced_frames;
|
||
osi_dma->tx_usecs = ec->tx_coalesce_usecs;
|
||
osi_dma->tx_frames = ec->tx_max_coalesced_frames;
|
||
return 0;
|
||
}
|
||
|
||
/**
|
||
* @brief Set interrupt coalescing parameters.
|
||
*
|
||
* Algorithm: This function is invoked by kernel when user request to get
|
||
* interrupt coalescing parameters. As coalescing parameters are same
|
||
* for all the channels, so this function will get coalescing
|
||
* details from channel zero and return.
|
||
*
|
||
* @param[in] dev: Net device data.
|
||
* @param[in] ec: pointer to ethtool_coalesce structure
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval 0 on Success.
|
||
*/
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_COALESCE_HAS_COAL_AND_EXTACT_ARGS) /* Linux v5.15 */
|
||
static int ether_get_coalesce(struct net_device *dev,
|
||
struct ethtool_coalesce *ec,
|
||
struct kernel_ethtool_coalesce *kernel_coal,
|
||
struct netlink_ext_ack *extack)
|
||
#else
|
||
static int ether_get_coalesce(struct net_device *dev,
|
||
struct ethtool_coalesce *ec)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(dev);
|
||
struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
|
||
|
||
memset(ec, 0, sizeof(struct ethtool_coalesce));
|
||
ec->rx_coalesce_usecs = osi_dma->rx_riwt;
|
||
ec->rx_max_coalesced_frames = osi_dma->rx_frames;
|
||
ec->tx_coalesce_usecs = osi_dma->tx_usecs;
|
||
ec->tx_max_coalesced_frames = osi_dma->tx_frames;
|
||
|
||
return 0;
|
||
}
|
||
|
||
#ifndef OSI_STRIPPED_LIB
|
||
/*
|
||
* @brief Get current EEE configuration in MAC/PHY
|
||
*
|
||
* Algorithm: This function is invoked by kernel when user request to get
|
||
* current EEE parameters. The function invokes the PHY framework to fill
|
||
* the supported & advertised EEE modes, as well as link partner EEE modes
|
||
* if it is available.
|
||
*
|
||
* @param[in] ndev: Net device data.
|
||
* @param[in] cur_eee: Pointer to struct ethtool_eee
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval 0 on Success.
|
||
* @retval -ve on Failure
|
||
*/
|
||
static int ether_get_eee(struct net_device *ndev,
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
struct ethtool_keee *cur_eee)
|
||
#else
|
||
struct ethtool_eee *cur_eee)
|
||
#endif
|
||
{
|
||
int ret;
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct phy_device *phydev = pdata->phydev;
|
||
|
||
if (!pdata->hw_feat.eee_sel) {
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
if (!netif_running(ndev)) {
|
||
netdev_err(pdata->ndev, "interface not up\n");
|
||
return -EINVAL;
|
||
}
|
||
|
||
ret = phy_ethtool_get_eee(phydev, cur_eee);
|
||
if (ret) {
|
||
netdev_warn(pdata->ndev, "Cannot get PHY EEE config\n");
|
||
return ret;
|
||
}
|
||
|
||
cur_eee->eee_enabled = pdata->eee_enabled;
|
||
cur_eee->tx_lpi_enabled = pdata->tx_lpi_enabled;
|
||
cur_eee->eee_active = pdata->eee_active;
|
||
cur_eee->tx_lpi_timer = pdata->tx_lpi_timer;
|
||
|
||
return ret;
|
||
}
|
||
|
||
/**
|
||
* @brief Helper routing to validate EEE configuration requested via ethtool
|
||
*
|
||
* Algorithm: Check for invalid combinations of ethtool_eee fields. If any
|
||
* invalid combination found, override it.
|
||
*
|
||
* @param[in] ndev: Net device data.
|
||
* @param[in] eee_req: Pointer to struct ethtool_eee configuration requested
|
||
*
|
||
* @retval none
|
||
*/
|
||
static inline void validate_eee_conf(struct net_device *ndev,
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
struct ethtool_keee *eee_req,
|
||
struct ethtool_keee cur_eee)
|
||
#else
|
||
struct ethtool_eee *eee_req,
|
||
struct ethtool_eee cur_eee)
|
||
#endif
|
||
{
|
||
/* These are the invalid combinations that can be requested.
|
||
* EEE | Tx LPI | Rx LPI
|
||
*----------------------
|
||
* 0 | 0 | 1
|
||
* 0 | 1 | 0
|
||
* 0 | 1 | 1
|
||
* 1 | 0 | 0
|
||
*
|
||
* These combinations can be entered from a state where either EEE was
|
||
* enabled or disabled originally. Hence decide next valid state based
|
||
* on whether EEE has toggled or not.
|
||
*/
|
||
if (!eee_req->eee_enabled && !eee_req->tx_lpi_enabled &&
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
!linkmode_empty(eee_req->advertised)) {
|
||
#else
|
||
eee_req->advertised) {
|
||
#endif
|
||
if (eee_req->eee_enabled != cur_eee.eee_enabled) {
|
||
netdev_warn(ndev, "EEE off. Set Rx LPI off\n");
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_zero(eee_req->advertised);
|
||
#else
|
||
eee_req->advertised = OSI_DISABLE;
|
||
#endif
|
||
} else {
|
||
netdev_warn(ndev, "Rx LPI on. Set EEE on\n");
|
||
eee_req->eee_enabled = OSI_ENABLE;
|
||
}
|
||
}
|
||
|
||
if (!eee_req->eee_enabled && eee_req->tx_lpi_enabled &&
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_empty(eee_req->advertised)) {
|
||
#else
|
||
!eee_req->advertised) {
|
||
#endif
|
||
if (eee_req->eee_enabled != cur_eee.eee_enabled) {
|
||
netdev_warn(ndev, "EEE off. Set Tx LPI off\n");
|
||
eee_req->tx_lpi_enabled = OSI_DISABLE;
|
||
} else {
|
||
/* phy_init_eee will fail if Rx LPI advertisement is
|
||
* disabled. Hence change the adv back to enable,
|
||
* so that Tx LPI will be set.
|
||
*/
|
||
netdev_warn(ndev, "Tx LPI on. Set EEE & Rx LPI on\n");
|
||
eee_req->eee_enabled = OSI_ENABLE;
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_copy(eee_req->advertised, eee_req->supported);
|
||
#else
|
||
eee_req->advertised = eee_req->supported;
|
||
#endif
|
||
}
|
||
}
|
||
|
||
if (!eee_req->eee_enabled && eee_req->tx_lpi_enabled &&
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
!linkmode_empty(eee_req->advertised)) {
|
||
#else
|
||
eee_req->advertised) {
|
||
#endif
|
||
if (eee_req->eee_enabled != cur_eee.eee_enabled) {
|
||
netdev_warn(ndev, "EEE off. Set Tx & Rx LPI off\n");
|
||
eee_req->tx_lpi_enabled = OSI_DISABLE;
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_zero(eee_req->advertised);
|
||
#else
|
||
eee_req->advertised = OSI_DISABLE;
|
||
#endif
|
||
} else {
|
||
netdev_warn(ndev, "Tx & Rx LPI on. Set EEE on\n");
|
||
eee_req->eee_enabled = OSI_ENABLE;
|
||
}
|
||
}
|
||
|
||
if (eee_req->eee_enabled && !eee_req->tx_lpi_enabled &&
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_empty(eee_req->advertised)) {
|
||
#else
|
||
!eee_req->advertised) {
|
||
#endif
|
||
if (eee_req->eee_enabled != cur_eee.eee_enabled) {
|
||
netdev_warn(ndev, "EEE on. Set Tx & Rx LPI on\n");
|
||
eee_req->tx_lpi_enabled = OSI_ENABLE;
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
linkmode_copy(eee_req->advertised, eee_req->supported);
|
||
#else
|
||
eee_req->advertised = eee_req->supported;
|
||
#endif
|
||
} else {
|
||
netdev_warn(ndev, "Tx,Rx LPI off. Set EEE off\n");
|
||
eee_req->eee_enabled = OSI_DISABLE;
|
||
}
|
||
}
|
||
}
|
||
|
||
/**
|
||
* @brief Set current EEE configuration
|
||
*
|
||
* Algorithm: This function is invoked by kernel when user request to Set
|
||
* current EEE parameters.
|
||
*
|
||
* @param[in] ndev: Net device data.
|
||
* @param[in] eee_req: Pointer to struct ethtool_eee
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval 0 on Success.
|
||
* @retval -ve on Failure
|
||
*/
|
||
static int ether_set_eee(struct net_device *ndev,
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
struct ethtool_keee *eee_req)
|
||
#else
|
||
struct ethtool_eee *eee_req)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct phy_device *phydev = pdata->phydev;
|
||
#if defined(NV_ETHTOOL_KEEE_STRUCT_PRESENT) /* Linux v6.9 */
|
||
struct ethtool_keee cur_eee;
|
||
#else
|
||
struct ethtool_eee cur_eee;
|
||
#endif
|
||
|
||
if (!pdata->hw_feat.eee_sel) {
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
if (!netif_running(ndev)) {
|
||
netdev_err(pdata->ndev, "interface not up\n");
|
||
return -EINVAL;
|
||
}
|
||
|
||
if (ether_get_eee(ndev, &cur_eee)) {
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
/* Validate args
|
||
* 1. Validate the tx lpi timer for acceptable range */
|
||
if (cur_eee.tx_lpi_timer != eee_req->tx_lpi_timer) {
|
||
if (eee_req->tx_lpi_timer == 0) {
|
||
pdata->tx_lpi_timer = OSI_DEFAULT_TX_LPI_TIMER;
|
||
} else if (eee_req->tx_lpi_timer <= OSI_MAX_TX_LPI_TIMER &&
|
||
eee_req->tx_lpi_timer >= OSI_MIN_TX_LPI_TIMER &&
|
||
!(eee_req->tx_lpi_timer % OSI_MIN_TX_LPI_TIMER)) {
|
||
pdata->tx_lpi_timer = eee_req->tx_lpi_timer;
|
||
} else {
|
||
netdev_err(ndev, "Tx LPI timer has to be < %u usec "
|
||
"in %u usec steps\n", OSI_MAX_TX_LPI_TIMER,
|
||
OSI_MIN_TX_LPI_TIMER);
|
||
return -EINVAL;
|
||
}
|
||
}
|
||
|
||
/* 2. Override invalid combinations of requested configuration */
|
||
validate_eee_conf(ndev, eee_req, cur_eee);
|
||
|
||
/* First store the requested & validated EEE configuration */
|
||
pdata->eee_enabled = eee_req->eee_enabled;
|
||
pdata->tx_lpi_enabled = eee_req->tx_lpi_enabled;
|
||
pdata->tx_lpi_timer = eee_req->tx_lpi_timer;
|
||
pdata->eee_active = eee_req->eee_active;
|
||
|
||
/* If EEE adv has changed, inform PHY framework. PHY will
|
||
* restart ANEG and the ether_adjust_link callback will take care of
|
||
* enabling Tx LPI as needed.
|
||
*/
|
||
if (cur_eee.advertised != eee_req->advertised) {
|
||
return phy_ethtool_set_eee(phydev, eee_req);
|
||
}
|
||
|
||
/* If no advertisement change, and only local Tx LPI changed, then
|
||
* configure the MAC right away.
|
||
*/
|
||
if (cur_eee.tx_lpi_enabled != eee_req->tx_lpi_enabled) {
|
||
eee_req->eee_active = ether_conf_eee(pdata,
|
||
eee_req->tx_lpi_enabled);
|
||
pdata->eee_active = eee_req->eee_active;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
/**
|
||
* @brief This function is invoked by kernel when user request to set
|
||
* pmt parameters for remote wakeup or magic wakeup
|
||
*
|
||
* Algorithm: Enable or Disable Wake On Lan status based on wol param
|
||
*
|
||
* @param[in] ndev – pointer to net device structure.
|
||
* @param[in] wol – pointer to ethtool_wolinfo structure.
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval zero on success and -ve number on failure.
|
||
*/
|
||
static int ether_set_wol(struct net_device *ndev, struct ethtool_wolinfo *wol)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
int ret;
|
||
|
||
if (!wol)
|
||
return -EINVAL;
|
||
|
||
if (!pdata->phydev) {
|
||
netdev_err(pdata->ndev,
|
||
"%s: phydev is null check iface up status\n",
|
||
__func__);
|
||
return -ENOTSUPP;
|
||
}
|
||
|
||
if (!phy_interrupt_is_valid(pdata->phydev))
|
||
return -ENOTSUPP;
|
||
|
||
ret = phy_ethtool_set_wol(pdata->phydev, wol);
|
||
if (ret < 0)
|
||
return ret;
|
||
|
||
if (wol->wolopts) {
|
||
ret = enable_irq_wake(pdata->phydev->irq);
|
||
if (ret) {
|
||
dev_err(pdata->dev, "PHY enable irq wake failed, %d\n",
|
||
ret);
|
||
return ret;
|
||
}
|
||
/* enable device wake on WoL set */
|
||
device_init_wakeup(&ndev->dev, true);
|
||
} else {
|
||
ret = disable_irq_wake(pdata->phydev->irq);
|
||
if (ret) {
|
||
dev_info(pdata->dev,
|
||
"PHY disable irq wake failed, %d\n",
|
||
ret);
|
||
}
|
||
/* disable device wake on WoL reset */
|
||
device_init_wakeup(&ndev->dev, false);
|
||
}
|
||
|
||
return ret;
|
||
}
|
||
|
||
/**
|
||
* @brief This function is invoked by kernel when user request to get report
|
||
* whether wake-on-lan is enable or not.
|
||
*
|
||
* Algorithm: Return Wake On Lan status in wol param
|
||
*
|
||
* param[in] ndev – pointer to net device structure.
|
||
* param[in] wol – pointer to ethtool_wolinfo structure.
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval none
|
||
*/
|
||
|
||
static void ether_get_wol(struct net_device *ndev, struct ethtool_wolinfo *wol)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
|
||
if (!wol)
|
||
return;
|
||
|
||
if (!pdata->phydev) {
|
||
netdev_err(pdata->ndev,
|
||
"%s: phydev is null check iface up status\n",
|
||
__func__);
|
||
return;
|
||
}
|
||
|
||
wol->supported = 0;
|
||
wol->wolopts = 0;
|
||
|
||
if (!phy_interrupt_is_valid(pdata->phydev))
|
||
return;
|
||
|
||
phy_ethtool_get_wol(pdata->phydev, wol);
|
||
}
|
||
|
||
/**
|
||
* @brief Get RX flow classification rules
|
||
*
|
||
* Algorithm: Returns RX flow classification rules.
|
||
*
|
||
* param[in] ndev: Pointer to net device structure.
|
||
* param[in] rxnfc: Pointer to rxflow data
|
||
* param[in] rule_locs: TBD
|
||
*
|
||
* @note MAC and PHY need to be initialized.
|
||
*
|
||
* @retval 0 on success
|
||
* @retval negative on failure
|
||
*/
|
||
static int ether_get_rxnfc(struct net_device *ndev,
|
||
struct ethtool_rxnfc *rxnfc,
|
||
u32 *rule_locs)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
|
||
switch (rxnfc->cmd) {
|
||
case ETHTOOL_GRXRINGS:
|
||
rxnfc->data = osi_core->num_mtl_queues;
|
||
break;
|
||
default:
|
||
return -EOPNOTSUPP;
|
||
}
|
||
|
||
return 0;
|
||
}
|
||
|
||
/**
|
||
* @brief Get the size of the RX flow hash key
|
||
*
|
||
* Algorithm: Returns size of RSS hash key
|
||
*
|
||
* param[in] ndev: Pointer to net device structure.
|
||
*
|
||
* @retval size of RSS Hash key
|
||
*/
|
||
static u32 ether_get_rxfh_key_size(struct net_device *ndev)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
|
||
return sizeof(osi_core->rss.key);
|
||
}
|
||
|
||
/**
|
||
* @brief Get the size of the RX flow hash indirection table
|
||
*
|
||
* Algorithm: Returns size of the RX flow hash indirection table
|
||
*
|
||
* param[in] ndev: Pointer to net device structure.
|
||
*
|
||
* @retval size of RSS Hash table
|
||
*/
|
||
static u32 ether_get_rxfh_indir_size(struct net_device *ndev)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
|
||
return ARRAY_SIZE(osi_core->rss.table);
|
||
}
|
||
|
||
/**
|
||
* @brief Get the contents of the RX flow hash indirection table, hash key
|
||
* and/or hash function
|
||
*
|
||
* param[in] ndev: Pointer to net device structure.
|
||
* param[out] indir: Pointer to indirection table
|
||
* param[out] key: Pointer to Hash key
|
||
* param[out] hfunc: Pointer to Hash function
|
||
*
|
||
* @retval 0 on success
|
||
*/
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RXFH_HAS_RXFH_PARAM_ARGS)
|
||
static int ether_get_rxfh(struct net_device *ndev,
|
||
struct ethtool_rxfh_param *rxfh)
|
||
#else
|
||
static int ether_get_rxfh(struct net_device *ndev, u32 *indir, u8 *key,
|
||
u8 *hfunc)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RXFH_HAS_RXFH_PARAM_ARGS)
|
||
u32 *indir = rxfh->indir;
|
||
u8 *hfunc = &rxfh->hfunc;
|
||
u8 *key = rxfh->key;
|
||
#endif
|
||
int i;
|
||
|
||
if (indir) {
|
||
for (i = 0; i < ARRAY_SIZE(osi_core->rss.table); i++)
|
||
indir[i] = osi_core->rss.table[i];
|
||
}
|
||
|
||
if (key)
|
||
memcpy(key, osi_core->rss.key, sizeof(osi_core->rss.key));
|
||
if (hfunc)
|
||
*hfunc = ETH_RSS_HASH_TOP;
|
||
|
||
return 0;
|
||
}
|
||
|
||
/**
|
||
* @brief Set the contents of the RX flow hash indirection table, hash key
|
||
* and/or hash function
|
||
*
|
||
* param[in] ndev: Pointer to net device structure.
|
||
* param[in] indir: Pointer to indirection table
|
||
* param[in] key: Pointer to Hash key
|
||
* param[hfunc] hfunc: Hash function
|
||
*
|
||
* @retval 0 on success
|
||
* @retval -1 on failure.
|
||
*/
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RXFH_HAS_RXFH_PARAM_ARGS)
|
||
static int ether_set_rxfh(struct net_device *ndev,
|
||
struct ethtool_rxfh_param *rxfh,
|
||
struct netlink_ext_ack *extack)
|
||
#else
|
||
static int ether_set_rxfh(struct net_device *ndev, const u32 *indir,
|
||
const u8 *key, const u8 hfunc)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_core_priv_data *osi_core = pdata->osi_core;
|
||
struct osi_ioctl ioctl_data = {};
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RXFH_HAS_RXFH_PARAM_ARGS)
|
||
u32 *indir = rxfh->indir;
|
||
u8 hfunc = rxfh->hfunc;
|
||
u8 *key = rxfh->key;
|
||
#endif
|
||
int i;
|
||
|
||
if (!netif_running(ndev)) {
|
||
netdev_err(pdata->ndev, "interface must be up\n");
|
||
return -ENODEV;
|
||
}
|
||
|
||
if ((hfunc != ETH_RSS_HASH_NO_CHANGE) && (hfunc != ETH_RSS_HASH_TOP))
|
||
return -EOPNOTSUPP;
|
||
|
||
if (indir) {
|
||
for (i = 0; i < ARRAY_SIZE(osi_core->rss.table); i++)
|
||
osi_core->rss.table[i] = indir[i];
|
||
}
|
||
|
||
if (key)
|
||
memcpy(osi_core->rss.key, key, sizeof(osi_core->rss.key));
|
||
|
||
ioctl_data.cmd = OSI_CMD_CONFIG_RSS;
|
||
return osi_handle_ioctl(pdata->osi_core, &ioctl_data);
|
||
|
||
}
|
||
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RINGPARAM_HAS_RINGPARAM_AND_EXTACT_ARGS) /* Linux v5.17 */
|
||
static void ether_get_ringparam(struct net_device *ndev,
|
||
struct ethtool_ringparam *ring,
|
||
struct kernel_ethtool_ringparam *kernel_ring,
|
||
struct netlink_ext_ack *extack)
|
||
#else
|
||
static void ether_get_ringparam(struct net_device *ndev,
|
||
struct ethtool_ringparam *ring)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
|
||
unsigned int max_supported_sz[] = {1024, 4096};
|
||
|
||
ring->rx_max_pending = max_supported_sz[osi_dma->mac];
|
||
ring->tx_max_pending = max_supported_sz[osi_dma->mac];
|
||
ring->rx_pending = osi_dma->rx_ring_sz;
|
||
ring->tx_pending = osi_dma->tx_ring_sz;
|
||
}
|
||
|
||
#if defined(NV_ETHTOOL_OPS_GET_SET_RINGPARAM_HAS_RINGPARAM_AND_EXTACT_ARGS) /* Linux v5.17 */
|
||
static int ether_set_ringparam(struct net_device *ndev,
|
||
struct ethtool_ringparam *ring,
|
||
struct kernel_ethtool_ringparam *kernel_ring,
|
||
struct netlink_ext_ack *extack)
|
||
#else
|
||
static int ether_set_ringparam(struct net_device *ndev,
|
||
struct ethtool_ringparam *ring)
|
||
#endif
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
|
||
unsigned int tx_ring_sz_max[] = {1024, 4096};
|
||
unsigned int rx_ring_sz_max[] = {1024, 16384};
|
||
int ret = 0;
|
||
|
||
if (ring->rx_mini_pending ||
|
||
ring->rx_jumbo_pending ||
|
||
ring->rx_pending < 64 ||
|
||
ring->rx_pending > rx_ring_sz_max[osi_dma->mac] ||
|
||
!is_power_of_2(ring->rx_pending) ||
|
||
ring->tx_pending < 64 ||
|
||
ring->tx_pending > tx_ring_sz_max[osi_dma->mac] ||
|
||
!is_power_of_2(ring->tx_pending))
|
||
return -EINVAL;
|
||
|
||
/* Stop the network device */
|
||
if (netif_running(ndev) &&
|
||
ndev->netdev_ops &&
|
||
ndev->netdev_ops->ndo_stop)
|
||
ndev->netdev_ops->ndo_stop(ndev);
|
||
|
||
osi_dma->rx_ring_sz = ring->rx_pending;
|
||
osi_dma->tx_ring_sz = ring->tx_pending;
|
||
|
||
/* Start the network device */
|
||
if (netif_running(ndev) &&
|
||
ndev->netdev_ops &&
|
||
ndev->netdev_ops->ndo_open)
|
||
ret = ndev->netdev_ops->ndo_open(ndev);
|
||
|
||
return ret;
|
||
}
|
||
|
||
static unsigned int ether_get_msglevel(struct net_device *ndev)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
|
||
return pdata->msg_enable;
|
||
}
|
||
|
||
static void ether_set_msglevel(struct net_device *ndev, u32 level)
|
||
{
|
||
struct ether_priv_data *pdata = netdev_priv(ndev);
|
||
|
||
pdata->msg_enable = level;
|
||
}
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
|
||
/**
|
||
* @brief Set of ethtool operations
|
||
*/
|
||
static const struct ethtool_ops ether_ethtool_ops = {
|
||
.get_link = ethtool_op_get_link,
|
||
.get_link_ksettings = phy_ethtool_get_link_ksettings,
|
||
.set_link_ksettings = phy_ethtool_set_link_ksettings,
|
||
.get_ts_info = ether_get_ts_info,
|
||
.get_strings = ether_get_strings,
|
||
.get_ethtool_stats = ether_get_ethtool_stats,
|
||
.get_sset_count = ether_get_sset_count,
|
||
.get_coalesce = ether_get_coalesce,
|
||
.supported_coalesce_params = (ETHTOOL_COALESCE_USECS |
|
||
ETHTOOL_COALESCE_MAX_FRAMES),
|
||
.set_coalesce = ether_set_coalesce,
|
||
#ifndef OSI_STRIPPED_LIB
|
||
.get_wol = ether_get_wol,
|
||
.set_wol = ether_set_wol,
|
||
.self_test = ether_selftest_run,
|
||
.get_rxnfc = ether_get_rxnfc,
|
||
.get_pauseparam = ether_get_pauseparam,
|
||
.set_pauseparam = ether_set_pauseparam,
|
||
.get_eee = ether_get_eee,
|
||
.set_eee = ether_set_eee,
|
||
.get_rxfh_key_size = ether_get_rxfh_key_size,
|
||
.get_rxfh_indir_size = ether_get_rxfh_indir_size,
|
||
.get_rxfh = ether_get_rxfh,
|
||
.set_rxfh = ether_set_rxfh,
|
||
.get_ringparam = ether_get_ringparam,
|
||
.set_ringparam = ether_set_ringparam,
|
||
.get_msglevel = ether_get_msglevel,
|
||
.set_msglevel = ether_set_msglevel,
|
||
#endif /* OSI_STRIPPED_LIB */
|
||
};
|
||
|
||
void ether_set_ethtool_ops(struct net_device *ndev)
|
||
{
|
||
ndev->ethtool_ops = ðer_ethtool_ops;
|
||
}
|