linux-nv-oot/drivers/net/ethernet/nvidia/nvethernet/ioctl.c

// SPDX-License-Identifier: GPL-2.0-only
/*
 * Copyright (c) 2019-2023, NVIDIA CORPORATION & AFFILIATES. All rights reserved.
 */

#include "ether_linux.h"

/**
 * @brief Function to handle private ioctl - EQOS_AVB_ALGORITHM
 *
 * Algorithm: Call osi_set_avb with user passed data
 *
 * @param[in] ndev: network device structure
 * @param[in] ifdata: interface private data structure
 *
 * @note Ethernet interface need to be up.
 *
 * @retval 0 on Success
 * @retval "nagative value" on Failure
 */
static int ether_set_avb_algo(struct net_device *ndev,
			      struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
#ifndef OSI_STRIPPED_LIB
	struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
	struct osi_tx_ring *tx_ring = NULL;
#endif /* !OSI_STRIPPED_LIB */
	struct osi_ioctl ioctl_data = {};
	int ret = -1;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.avb,
			   (void __user *)ifdata->ptr,
			   sizeof(struct osi_core_avb_algorithm)) != 0U) {
		dev_err(pdata->dev,
			"Failed to fetch AVB Struct info from user\n");
		return ret;
	}

	if (ioctl_data.avb.qindex >= OSI_MGBE_MAX_NUM_QUEUES) {
		dev_err(pdata->dev, "Invalid queue index from user\n");
		return -EINVAL;
	}

#ifndef OSI_STRIPPED_LIB
	/* Check AVB mode disable on slot function enable */
	tx_ring = osi_dma->tx_ring[ioctl_data.avb.qindex];
	if (tx_ring && tx_ring->slot_check == OSI_ENABLE &&
	    ioctl_data.avb.oper_mode == OSI_MTL_QUEUE_ENABLE) {
		dev_err(pdata->dev,
			"Can't disable queue:%d AVB mode when slot is enabled",
			ioctl_data.avb.qindex);
		return -EINVAL;
	}
#endif /* !OSI_STRIPPED_LIB */

	ioctl_data.cmd = OSI_CMD_SET_AVB;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}

/**
 * @brief Function to handle private ioctl - EQOS_M2M_TSYNC
 *
 * Algorithm: Call osi_m2m_tsync with user passed data
 *
 * @param[in] ndev: network device structure
 * @param[in] ifdata: interface private data structure
 *
 * @note Ethernet interface need to be up.
 *
 * @retval 0 on Success
 * @retval "nagative value" on Failure
 */
static int ether_m2m_tsync(struct net_device *ndev,
			   struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	int ret = -1;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.arg1_u32,
			   (void __user *)ifdata->ptr,
			   sizeof(unsigned int)) != 0U) {
		dev_err(pdata->dev,
			"Failed to fetch input info from user\n");
		return ret;
	}

	ioctl_data.cmd = OSI_CMD_CONF_M2M_TS;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}
/**
 * @brief Function to get TSC and PTP time capture. This function is called for
 * ETHER_CAP_TSC_PTP
 *
 * Algorithm: Call OSI_CMD_CAP_TSC_PTP with user passed data
 *
 * @param[in] ndev: network device structure
 * @param[in] ifdata: interface private data structure
 *
 * @note Ethernet interface need to be up. Caller should check for return
 * value before using return value.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_get_tsc_ptp_cap(struct net_device *ndev,
				 struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	int ret;

	if (!ifdata->ptr) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return -EINVAL;
	}

	if (copy_from_user(&ioctl_data.ptp_tsc,
			   (void __user *)ifdata->ptr,
			   sizeof(struct osi_core_ptp_tsc_data)) != 0U) {
		dev_err(pdata->dev,
			"Failed to fetch TSC Struct info from user\n");
		return -EFAULT;
	}

	ioctl_data.cmd = OSI_CMD_CAP_TSC_PTP;
	ret = osi_handle_ioctl(osi_core, &ioctl_data);
	if (ret != 0) {
		dev_err(pdata->dev,
			"Failed to get TSC Struct info from registers\n");
		return ret;
	}
	if (copy_to_user(ifdata->ptr, &ioctl_data.ptp_tsc,
			 sizeof(struct osi_core_ptp_tsc_data)) != 0U) {
		dev_err(pdata->dev, "%s: copy_to_user failed\n", __func__);
		return -EFAULT;
	}

	return ret;
}
/**
 * @brief Function to get avb data from registers. This function is called for
 * EQOS_GET_AVB_ALGORITHM
 *
 * Algorithm: Call osi_get_avb with user passed data(qindex)
 *
 * @param[in] ndev: network device structure
 * @param[in] ifdata: interface private data structure
 *
 * @note Ethernet interface need to be up. Caller should check for return
 * value before using return value.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_get_avb_algo(struct net_device *ndev,
			      struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	int ret;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return -EINVAL;
	}

	if (copy_from_user(&ioctl_data.avb,
			   (void __user *)ifdata->ptr,
			   sizeof(struct osi_core_avb_algorithm)) != 0U) {
		dev_err(pdata->dev,
			"Failed to fetch AVB Struct info from user\n");
		return -EFAULT;
	}

	ioctl_data.cmd = OSI_CMD_GET_AVB;
	ret = osi_handle_ioctl(osi_core, &ioctl_data);
	if (ret != 0) {
		dev_err(pdata->dev,
			"Failed to get AVB Struct info from registers\n");
		return ret;
	}
	if (copy_to_user(ifdata->ptr, &ioctl_data.avb,
			 sizeof(struct osi_core_avb_algorithm)) != 0U) {
		dev_err(pdata->dev, "%s: copy_to_user failed\n", __func__);
		return -EFAULT;
	}

	return ret;
}

#ifndef OSI_STRIPPED_LIB
/**
 * @brief Handle ioctl to enable/disable PTP offload
 *
 * @param[in] pdata: OS dependent private data structure.
 * @param[in] ifrd_p: Interface request private data pointer.
 *
 * @note Interface should be running (enforced by caller).
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_ptp_offload(struct ether_priv_data *pdata,
				    struct ether_exported_ifr_data *ifrd_p)
{
	int ret = -EINVAL;
	struct ptp_offload_param param;
	unsigned int snap_type = 0x0;
	unsigned int master = 0x0;
	struct osi_ioctl ioctl_data = {};
	struct timespec64 now;

	if (!ifrd_p->ptr) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifrd_p->ifcmd);
		return ret;
	}

	if (copy_from_user(&param, (void __user *)ifrd_p->ptr,
			   sizeof(struct ptp_offload_param))) {
		dev_err(pdata->dev, "%s: copy_from_user failed\n", __func__);
		return ret;
	}

	pdata->osi_core->ptp_config.ptp_clock = pdata->ptp_ref_clock_speed;
	/* initialize system time */
	ktime_get_real_ts64(&now);
	/* Store sec and nsec */
	pdata->osi_core->ptp_config.sec = now.tv_sec;
	pdata->osi_core->ptp_config.nsec = now.tv_nsec;
	/* one nsec accuracy */
	pdata->osi_core->ptp_config.one_nsec_accuracy = OSI_ENABLE;

	switch (param.mode) {
	case ETHER_PTP_ORDINARY_MASTER:
		master = OSI_ENABLE;
		snap_type = OSI_PTP_SNAP_ORDINARY;
		break;
	case ETHER_PTP_ORDINARY_SLAVE:
		master = OSI_ENABLE;
		snap_type = OSI_PTP_SNAP_ORDINARY;
		break;
	case ETHER_PTP_TRASPARENT_MASTER:
		master = OSI_ENABLE;
		snap_type = OSI_PTP_SNAP_TRANSPORT;
		break;
	case ETHER_PTP_TRASPARENT_SLAVE:
		master = OSI_ENABLE;
		snap_type = OSI_PTP_SNAP_TRANSPORT;
		break;
	case ETHER_PTP_PEER_TO_PEER_TRANSPARENT:
		snap_type = OSI_PTP_SNAP_P2P;
		master = OSI_ENABLE;
		break;
	default:
		dev_err(pdata->dev, "%s: Invalid mode value, set default\n",
			__func__);
		snap_type = OSI_PTP_SNAP_ORDINARY;
		master = OSI_DISABLE;
	}

	ioctl_data.pto_config.en_dis = param.en_dis;
	ioctl_data.pto_config.snap_type = snap_type;
	ioctl_data.pto_config.master = master;
	ioctl_data.pto_config.domain_num = param.domain_num;
	ioctl_data.pto_config.mc_uc = param.mc_uc;
	/* PTP port ID hard code to port 1 for POC */
	ioctl_data.pto_config.portid = 0x1U;
	ioctl_data.cmd = OSI_CMD_CONFIG_PTP_OFFLOAD;
	ret = osi_handle_ioctl(pdata->osi_core, &ioctl_data);
	if (ret < 0) {
		dev_err(pdata->dev, "%s: OSI function failed\n", __func__);
	}

	return ret;
}

/**
 * @brief Function to check valid ip4 address
 *
 * Algorithm:
 * 1) Check if IP4 address provided is valid.
 *
 * @param[in] ip_addr: Pointer to ip4 addr buffer.
 *
 * @retval true If valid ip4 address
 * @retval false Otherwise
 */
static bool ether_is_ip4_addr(unsigned char *ip_addr)
{
	unsigned char addr;
	bool is_ip4_addr = false;

	if (ip_addr == NULL) {
		return is_ip4_addr;
	}
	addr = (ip_addr[0] & MAX_IP_ADDR_BYTE);
	/* class E ip address reserved for future use
	 */
	if (addr >= CLASS_E_IP4_ADDR_RANGE_START) {
		is_ip4_addr = false;
	} else {
		is_ip4_addr = true;
	}
	return is_ip4_addr;
}

/**
 * @brief Function to check valid multicast address
 *
 * Algorithm:
 * 1) Check if multicast address provided is valid.
 *
 * @param[in] ip_addr: Pointer to multicast addr buffer.
 *
 * @retval true If valid multicast address
 * @retval false Otherwise
 */
static bool ether_is_mc_addr(unsigned char *mc_addr)
{
	unsigned char addr;
	bool is_mc_addr = false;

	if (mc_addr == NULL) {
		return is_mc_addr;
	}
	addr = (mc_addr[0] & MAX_IP_ADDR_BYTE);
	/* class D ip address reserved for multicast address
	 */
	if (addr >= MIN_MC_ADDR_RANGE &&  addr <= MAX_MC_ADDR_RANGE) {
		is_mc_addr = true;
	} else {
		is_mc_addr = false;
	}
	return is_mc_addr;
}

/**
 * @brief Function to check valid broadcast address
 *
 * Algorithm:
 * 1) Check if broadcast address provided is valid.
 *
 * @param[in] bc_addr: Pointer to broadcast addr buffer.
 *
 * @retval true If valid broadcast address
 * @retval false Otherwise
 */
static bool ether_is_bc_addr(unsigned char *bc_addr)
{
	bool is_bc_addr = true;
	int i;

	if (bc_addr == NULL) {
		return false;
	}
	for (i = 0; i < NUM_BYTES_IN_IPADDR; i++) {
		if (bc_addr[i] != MAX_IP_ADDR_BYTE) {
			is_bc_addr = false;
			break;
		}
	}
	return is_bc_addr;
}

/**
 * @brief Handle ioctl to enable/disable ARP offload
 *
 * Algorithm:
 * 1) Copy the priv data from user space. This includes the IP address
 * to be updated in HW.
 * 2) Check if IP address provided in priv data is valid.
 * 3) If IP address is valid, invoke OSI API to update HW registers.
 *
 * @param[in] pdata: OS dependent private data structure.
 * @param[in] ifrd_p: Interface request private data pointer.
 * 
 * @note Interface should be running (enforced by caller).
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_arp_offload(struct ether_priv_data *pdata,
				    struct ether_exported_ifr_data *ifrd_p)
{
	int ret = -EINVAL;
	struct arp_offload_param param;
	struct osi_ioctl ioctl_data = {};

	/* TODO: Need Spin lock to prevent multiple apps from
	 * requesting same ioctls to the same MAC instance
	 */
	if (!ifrd_p->ptr) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifrd_p->ifcmd);
		return ret;
	}

	if (copy_from_user(&param, (void __user *)ifrd_p->ptr,
			   sizeof(struct arp_offload_param))) {
		dev_err(pdata->dev, "%s: copy_from_user failed\n", __func__);
		return ret;
	}
	if (!ether_is_ip4_addr(param.ip_addr) ||
	   ether_is_mc_addr(param.ip_addr) ||
	   ether_is_bc_addr(param.ip_addr)) {
		dev_err(pdata->dev, "%s: Invalid IP addr\n", __func__);
		return ret;
	}
	ioctl_data.cmd = OSI_CMD_ARP_OFFLOAD;
	ioctl_data.arg1_u32 = ifrd_p->if_flags;
	ioctl_data.arg7_u8_p = param.ip_addr;
	ret = osi_handle_ioctl(pdata->osi_core, &ioctl_data);
	dev_err(pdata->dev, "ARP offload: %s : %s\n",
		ifrd_p->if_flags ? "Enable" : "Disable",
		ret ? "Failed" : "Success");
	return ret;
}
#endif /* !OSI_STRIPPED_LIB */

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure Flexible Receive Parser table entry add, delete, and
 * update commands.
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_frp_cmd(struct net_device *dev,
				struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	int ret = -EINVAL;

	if (pdata->hw_feat.frp_sel == OSI_DISABLE) {
		dev_err(pdata->dev, "MAC doen't support FRP\n");
		return ret;
	}

	if (!ifdata->ptr) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.frp_cmd,
			   (void __user *)ifdata->ptr,
			   sizeof(struct osi_core_frp_cmd)) != 0U) {
		dev_err(pdata->dev, "%s copy from user failed\n", __func__);
		return -EFAULT;
	}

	ioctl_data.cmd = OSI_CMD_CONFIG_FRP;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}

/**
 * @brief This function is invoked by ioctl when user issues an ioctl command
 * to enable/disable L3/L4 filtering.
 *
 * Algorithm:
 * 1) check if filter enalbed/disable already and return success.
 * 2) OSI call to update register
 *
 * @param[in] dev: pointer to net device structure.
 * @param[in] ifdata: pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 *
 */
static int ether_config_l3_l4_filtering(struct net_device *dev,
					struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_l3_l4_filter *u_l3_filter;
	struct osi_ioctl ioctl_data = { 0 };
	int ret = -EINVAL;

	if (pdata->hw_feat.l3l4_filter_num == OSI_DISABLE) {
		dev_err(pdata->dev, "ip4 filter is not supported\n");
		return ret;
	}

	if (!ifdata->ptr) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	u_l3_filter = (struct osi_l3_l4_filter *)ifdata->ptr;

	if (copy_from_user(&ioctl_data.l3l4_filter, (void __user *)u_l3_filter,
			   sizeof(struct osi_l3_l4_filter)) != 0U) {
		dev_err(pdata->dev, "%s copy from user failed\n", __func__);
		return -EFAULT;
	}

	ioctl_data.cmd = OSI_CMD_L3L4_FILTER;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure L2 filtering.
 *
 * Algorithm:
 * 1) Return error if Ethrmet virtualization is not enabled.
 * 2) Select source/destination address matching.
 * 3) Select perfect/inverse matching.
 * 4) Update the L2 MAC address into MAC register.
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized. Only
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_l2_filters(struct net_device *dev,
				   struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
	struct ether_l2_filter u_l2_filter;
	struct osi_ioctl ioctl_data = {};
	int ret = -1;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (osi_core->use_virtualization == OSI_DISABLE) {
		dev_err(pdata->dev, "%s Ethernet virualization is not enabled\n", __func__);
		return ret;
	}
	if (copy_from_user(&u_l2_filter, (void __user *)ifdata->ptr,
			   sizeof(struct ether_l2_filter)) != 0U) {
		dev_err(pdata->dev, "%s copy from user failed\n", __func__);
		return ret;
	}

	ioctl_data.l2_filter.index = u_l2_filter.index;
	ioctl_data.l2_filter.src_dest = OSI_DA_MATCH;

	ioctl_data.l2_filter.oper_mode = (OSI_OPER_EN_PERFECT |
			OSI_OPER_DIS_PROMISC |
			OSI_OPER_DIS_ALLMULTI);

	if (u_l2_filter.en_dis == OSI_ENABLE) {
		ioctl_data.l2_filter.oper_mode |= OSI_OPER_ADDR_UPDATE;
	} else {
		ioctl_data.l2_filter.oper_mode |= OSI_OPER_ADDR_DEL;
	}

	memcpy(ioctl_data.l2_filter.mac_address,
	       u_l2_filter.mac_address, ETH_ALEN);
	ioctl_data.l2_filter.dma_routing = OSI_ENABLE;
	ioctl_data.l2_filter.addr_mask = OSI_DISABLE;
	ioctl_data.l2_filter.dma_chan = osi_dma->dma_chans[0];
	ioctl_data.l2_filter.dma_chansel = OSI_BIT(osi_dma->dma_chans[0]);
	ioctl_data.cmd = OSI_CMD_L2_FILTER;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}

#ifndef OSI_STRIPPED_LIB
/**
 * @brief This function is invoked by ioctl functio when user issues an ioctl
 * command to configure VALN filtering.
 *
 * Algorithm:
 * 1) enable/disable VLAN filtering.
 * 2) select perfect/hash filtering.
 *
 * @param[in] dev: pointer to net device structure.
 * @param[in] ifdata: pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_vlan_filter(struct net_device *dev,
				    struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_vlan_filter *u_vlan_filter =
		(struct osi_vlan_filter *)ifdata->ptr;
	struct osi_ioctl ioctl_data = {};
	int ret = -EINVAL;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.vlan_filter, (void __user *)u_vlan_filter,
			   sizeof(struct osi_vlan_filter)) != 0U) {
		dev_err(pdata->dev, "%s copy from user failed", __func__);
		return -EFAULT;
	}

	/*0 - perfect and 1 - hash filtering */
	if (ioctl_data.vlan_filter.perfect_hash == OSI_HASH_FILTER_MODE) {
		dev_err(pdata->dev, "VLAN HASH filtering is not supported\n");
		return ret;
	}

	ioctl_data.cmd = OSI_CMD_VLAN_FILTER;
	ret = osi_handle_ioctl(osi_core, &ioctl_data);
	if (ret == 0) {
		pdata->vlan_hash_filtering =
					    ioctl_data.vlan_filter.perfect_hash;
	}

	return ret;
}

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure multiple DMA routing for MC packets.
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: Pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_mc_dmasel(struct net_device *dev,
				  unsigned int flags)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
	unsigned int bitmap = 0U, i = 0U, chan = 0U;

	/* Validate MC DMA channel selection flags */
	bitmap = flags;
	while (bitmap != 0U) {
		chan = __builtin_ctz(bitmap);
		for (i = 0; i < osi_dma->num_dma_chans; i++) {
			if (osi_dma->dma_chans[i] == chan) {
				/* channel is enabled */
				break;
			}
		}
		if (i == osi_dma->num_dma_chans) {
			/* Invalid MC DMA selection */
			dev_err(pdata->dev, "Invalid %d MC DMA selection\n", chan);
			return -EINVAL;
		}
		bitmap &= ~OSI_BIT(chan);
	}

	/* Store flags into OSI core data */
	osi_core->mc_dmasel = flags;
	/* Set RX mode with latest flags */
	ether_set_rx_mode(dev);

	return 0;
}

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure L2 destination addressing filtering mode.
 *
 * Algorithm:
 * 1) Selects perfect/hash filtering.
 * 2) Selects perfect/inverse matching.
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: Pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_l2_da_filter(struct net_device *dev,
				     struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_l2_da_filter *u_l2_da_filter =
		(struct osi_l2_da_filter *)ifdata->ptr;
	struct osi_l2_da_filter l_l2_da_filter;
	struct osi_ioctl ioctl_data = {};
	int ret = -EINVAL;

	memset(&ioctl_data.l2_filter, 0x0, sizeof(struct osi_filter));

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&l_l2_da_filter, (void __user *)u_l2_da_filter,
			   sizeof(struct osi_l2_da_filter)) != 0U) {
		return -EFAULT;
	}

	if (l_l2_da_filter.perfect_hash == OSI_HASH_FILTER_MODE) {
		dev_err(pdata->dev,
			"select HASH FILTERING for L2 DA is not Supported in SW\n");
		return ret;
	} else {
		/* FIXME: Need to understand if filtering will work on addr0.
		 * Do we need to have pdata->num_mac_addr_regs > 1 check?
		 */
		pdata->l2_filtering_mode = OSI_PERFECT_FILTER_MODE;
	}

	/* configure L2 DA perfect/inverse_matching */
	if (l_l2_da_filter.perfect_inverse_match == OSI_ENABLE) {
		ioctl_data.l2_filter.oper_mode |= OSI_OPER_EN_L2_DA_INV;
	} else {
		ioctl_data.l2_filter.oper_mode |= OSI_OPER_DIS_L2_DA_INV;
	}

	ioctl_data.cmd = OSI_CMD_L2_FILTER;
	ret = osi_handle_ioctl(osi_core, &ioctl_data);
	if (ret != 0) {
		dev_err(pdata->dev, "setting L2_DA_INV failed\n");
	}

	return ret;
}

/**
 * @brief This function is invoked by ioctl when user issues an ioctl command
 * to enable/disable pad calibration at run time.
 *
 * Algorithm: set/reset the priv data structure flag to control involking pad
 * pad calibration function
 *
 * @param[in] ndev: network device structure
 * @param[in] flags: flags to indicate whether to disable/enable pad
 *		     calirabration
 *
 * @note Ethernet interface need to be up.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_pad_calibration(struct net_device *ndev,
				 unsigned int flags)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;

	if (flags == OSI_ENABLE) {
		osi_core->padctrl.pad_calibration_enable = OSI_ENABLE;
	} else if (flags == OSI_DISABLE) {
		osi_core->padctrl.pad_calibration_enable = OSI_DISABLE;
	} else {
		dev_err(pdata->dev, "Invalid flag values:%d\n", flags);
		return -EINVAL;
	}

	return 0;
}

/**
 * @brief This function is invoked by ioctl when user issues an ioctl command
 * to enable/disable MAC loopback mode.
 *
 * Algorithm:
 * 1) check if loopback mode enalbed/disable already and return success.
 * 2) OSI call to configure loopback mode in HW.
 *
 * @param[in] ndev: pointer to net device structure.
 * @param[in] flags: flag to indicate whether MAC loopback mode to be enabled or
 *	disabled.
 *
 * @note MAC and PHY need to be initialized.
 * 
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_loopback_mode(struct net_device *ndev,
				      unsigned int flags)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct phy_device *phydev = ndev->phydev;
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	int ret = 0;

	if ((flags && (pdata->mac_loopback_mode == OSI_ENABLE)) ||
	    (!flags && (pdata->mac_loopback_mode == OSI_DISABLE))) {
		dev_info(pdata->dev, "Loopback mode is already configured\n");
		return ret;
	}

	if (flags) {
		if (!phydev->link) {
			/* If no phy link, then turn on carrier explicitly so
			 * that nw stack can send packets. If PHY link is
			 * present, PHY framework would have already taken care
			 * of netif_carrier_* status.
			 */
			netif_carrier_on(ndev);
		}

		ioctl_data.arg1_u32 = OSI_ENABLE;
		ioctl_data.cmd = OSI_CMD_MAC_LB;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
		if (ret < 0) {
			dev_err(pdata->dev,
				"Failed to enable MAC Loopback\n");
		} else {
			pdata->mac_loopback_mode = OSI_ENABLE;
			dev_info(pdata->dev, "MAC loopback enabled\n");
		}
	} else {
		if (!phydev->link) {
			/* If no phy link, then turn off carrier explicitly so
			 * that nw stack doesn't send packets. If PHY link is
			 * present, PHY framework would have already taken care
			 * of netif_carrier_* status.
			 */
			netif_carrier_off(ndev);
		}

		ioctl_data.arg1_u32 = OSI_DISABLE;
		ioctl_data.cmd = OSI_CMD_MAC_LB;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
		if (ret < 0) {
			dev_err(pdata->dev,
				"Failed to disable MAC Loopback\n");
		} else {
			pdata->mac_loopback_mode = OSI_DISABLE;
			dev_info(pdata->dev, "MAC loopback disabled\n");
		}
	}

	return ret;
}

/**
 * @brief This function is invoked by ioctl when user issues an ioctl command
 * to change PTP RX Packets routing
 *
 * Algorithm:
 * 1) OSI call to configure PTP RX queue in HW.
 *
 * @param[in] ndev: pointer to net device structure.
 * @param[in] flags: flag to indicate PTP RX queue index.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_ptp_rxq(struct net_device *ndev,
				unsigned int flags)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};

	/* Fill PTP RX queue route values and call osi_rxq_route */
	ioctl_data.rxq_route.route_type = OSI_RXQ_ROUTE_PTP;
	ioctl_data.rxq_route.enable = OSI_ENABLE;
	ioctl_data.rxq_route.idx = flags;
	ioctl_data.cmd = OSI_CMD_PTP_RXQ_ROUTE;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}
#endif /* !OSI_STRIPPED_LIB */

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure EST GCL.
 *
 * Algorithm: If HW support EST, call interface function with
 * configuration passed
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: Pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_est(struct net_device *dev,
			    struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_est_config  *u_est_cfg =
				(struct osi_est_config *)ifdata->ptr;
	struct osi_ioctl ioctl_data = {};
	int ret = -EINVAL;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.est, (void __user *)u_est_cfg,
			   sizeof(struct osi_est_config)) != 0U) {
		return -EFAULT;
	}

	if (pdata->hw_feat.est_sel == OSI_DISABLE) {
		dev_err(pdata->dev,
			"HW doesn't support EST\n");
	} else {
		ioctl_data.cmd = OSI_CMD_CONFIG_EST;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
	}

	return ret;
}

/**
 * @brief This function is invoked by ioctl function when user issues an ioctl
 * command to configure FPE.
 *
 * Algorithm: If HW support Frame preemption, call interface function with
 * configuration passed
 *
 * @param[in] dev: Pointer to net device structure.
 * @param[in] ifdata: Pointer to IOCTL specific structure.
 *
 * @note MAC and PHY need to be initialized.
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
static int ether_config_fpe(struct net_device *dev,
			    struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(dev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_fpe_config  *u_fpe_cfg =
				(struct osi_fpe_config *)ifdata->ptr;
	struct osi_ioctl ioctl_data = {};
	int ret = -EINVAL;

	if (ifdata->ptr == NULL) {
		dev_err(pdata->dev, "%s: Invalid data for priv ioctl %d\n",
			__func__, ifdata->ifcmd);
		return ret;
	}

	if (copy_from_user(&ioctl_data.fpe, (void __user *)u_fpe_cfg,
			   sizeof(struct osi_fpe_config)) != 0U) {
		dev_err(pdata->dev, "%s: copy_from_user error\n", __func__);
		return -EFAULT;
	}

	if (pdata->hw_feat.fpe_sel == OSI_DISABLE) {
		dev_err(pdata->dev,
			"HW doesn't support FPE\n");
	} else {
		ioctl_data.cmd = OSI_CMD_CONFIG_FPE;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
	}

	return ret;
}

#ifdef OSI_DEBUG
/**
 * @brief handle ETHER_DEBUG_INTR_CONFIG ioctl
 *
 * Algorithm:
 * - Call OSI_DMA_DEBUG_INTR_CONFIG to enable/disable debug interrupt
 * - Call OSI_CMD_DEBUG_INTR_CONFIG to enable/disable debug interrupt
 *
 * @param[in] ndev: network device structure
 * @param[in] ifdata: interface private data structure
 *
 * @note Ethernet interface need to be up.
 *
 * @retval 0 on Success
 * @retval "nagative value" on Failure
 */
static int ether_debug_intr_config(struct net_device *ndev,
				   struct ether_exported_ifr_data *ifdata)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
	struct osi_core_priv_data *osi_core = pdata->osi_core;
	struct osi_ioctl ioctl_data = {};
	struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
	unsigned int enable = ifdata->if_flags;
	int ret = -1;

	osi_dma->ioctl_data.cmd = OSI_DMA_IOCTL_CMD_DEBUG_INTR_CONFIG;
	osi_dma->ioctl_data.arg_u32 = enable;
	ret = osi_dma_ioctl(osi_dma);
	if (ret < 0)
		return ret;

	ioctl_data.cmd = OSI_CMD_DEBUG_INTR_CONFIG;
	ioctl_data.arg1_u32 = enable;
	return osi_handle_ioctl(osi_core, &ioctl_data);
}
#endif

/**
 * @brief ether_priv_ioctl - Handle private IOCTLs
 *
 * Algorithm:
 * 1) Copy the priv command data from user space.
 * 2) Check the priv command cmd and invoke handler function if it is supported
 * 3) Copy result back to user space.
 *
 * @param[in] ndev: network device structure
 * @param[in] ifr: Interface request structure used for socket ioctl's.
 *
 * @note Interface should be running (enforced by caller).
 *
 * @retval 0 on Success
 * @retval "negative value" on Failure
 */
int ether_handle_priv_ioctl(struct net_device *ndev,
			    struct ifreq *ifr)
{
	struct ether_priv_data *pdata = netdev_priv(ndev);
#ifndef OSI_STRIPPED_LIB
	struct phy_device *phydev = ndev->phydev;
	struct osi_ioctl ioctl_data = {};
	struct osi_core_priv_data *osi_core = pdata->osi_core;
#endif /* !OSI_STRIPPED_LIB */
	struct ether_exported_ifr_data ifdata;
#ifdef OSI_DEBUG
	struct osi_dma_priv_data *osi_dma = pdata->osi_dma;
#endif
	int ret = -EOPNOTSUPP;

	if (copy_from_user(&ifdata, (void __user *)ifr->ifr_data,
			   sizeof(ifdata)) != 0U) {
		dev_err(pdata->dev, "%s(): copy_from_user failed %d\n"
			, __func__, __LINE__);
		return -EFAULT;
	}

	/* Enforce admin permission check */
	switch (ifdata.ifcmd) {
	case ETHER_AVB_ALGORITHM:
	case EQOS_L3L4_FILTER_CMD:
	case EQOS_VLAN_FILTERING_CMD:
	case EQOS_L2_DA_FILTERING_CMD:
	case ETHER_CONFIG_ARP_OFFLOAD:
	case ETHER_CONFIG_LOOPBACK_MODE:
	case ETHER_PAD_CALIBRATION:
		if (!capable(CAP_NET_ADMIN)) {
			ret = -EPERM;
			dev_info(pdata->dev,
				 "%s(): error: requires admin permission!\n",
				 __func__);
			goto err;
		}
		break;
	default:
		break;
	}

	switch (ifdata.ifcmd) {
#ifndef OSI_STRIPPED_LIB
	case EQOS_GET_TX_QCNT:
		ifdata.qinx = osi_core->num_mtl_queues;
		ret = 0;
		break;
	case EQOS_GET_RX_QCNT:
		ifdata.qinx = osi_core->num_mtl_queues;
		ret = 0;
		break;
	case EQOS_GET_CONNECTED_SPEED:
		if (phydev != OSI_NULL) {
			/* If phydev is not NULL, return phydev Speed */
			ifdata.connected_speed =  phydev->speed;
		} else {
			/* If phydev is NULL, return pdata Speed */
			ifdata.connected_speed =  pdata->speed;
		}
		ret = 0;
		break;
#endif /* !OSI_STRIPPED_LIB */
	case ETHER_AVB_ALGORITHM:
		ret = ether_set_avb_algo(ndev, &ifdata);
		break;
	case ETHER_GET_AVB_ALGORITHM:
		ret = ether_get_avb_algo(ndev, &ifdata);
		break;
#ifndef OSI_STRIPPED_LIB
	case ETHER_CONFIG_ARP_OFFLOAD:
		ret = ether_config_arp_offload(pdata, &ifdata);
		break;
	case ETHER_PTP_RXQUEUE:
		ret = ether_config_ptp_rxq(ndev, ifdata.if_flags);
		break;
	case ETHER_CONFIG_PTP_OFFLOAD:
		if (pdata->hw_feat.tsstssel) {
			ret = ether_config_ptp_offload(pdata, &ifdata);
		} else {
			dev_err(pdata->dev, "No HW support for PTP\n");
			ret = -EOPNOTSUPP;
		}
		break;
	case ETHER_CONFIG_LOOPBACK_MODE:
		ret = ether_config_loopback_mode(ndev, ifdata.if_flags);
		break;
	case EQOS_VLAN_FILTERING_CMD:
		ret = ether_config_vlan_filter(ndev, &ifdata);
		break;
	case ETHER_PAD_CALIBRATION:
		ret = ether_pad_calibration(ndev, ifdata.if_flags);
		break;
	case EQOS_L2_DA_FILTERING_CMD:
		ret = ether_config_l2_da_filter(ndev, &ifdata);
		break;
	case ETHER_MC_DMA_ROUTE:
		ret = ether_config_mc_dmasel(ndev, ifdata.if_flags);
		break;
	case ETHER_READ_REG:
		ioctl_data.cmd = OSI_CMD_READ_REG;
		ioctl_data.arg1_u32 = ifdata.if_flags;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
		ifdata.qinx = ret;
		break;
	case ETHER_WRITE_REG:
		ioctl_data.cmd = OSI_CMD_WRITE_REG;
		ioctl_data.arg1_u32 = ifdata.qinx;
		ioctl_data.arg2_u32 = ifdata.if_flags;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
		ifdata.qinx = ret;
		break;
#endif /* !OSI_STRIPPED_LIB */
	case EQOS_L3L4_FILTER_CMD:
		/* flags should be 0x0 or 0x1, discard any other */
		if (pdata->hw_feat.l3l4_filter_num > 0U) {
			ret = ether_config_l3_l4_filtering(ndev, &ifdata);
			if (ret == 0) {
				ret = EQOS_CONFIG_SUCCESS;
			} else {
				ret = EQOS_CONFIG_FAIL;
			}
		} else {
			dev_err(pdata->dev, "L3/L4 filters are not supported\n");
			ret = -EOPNOTSUPP;
		}
		break;
	case ETHER_CONFIG_FRP_CMD:
		ret = ether_config_frp_cmd(ndev, &ifdata);
		break;
	case ETHER_CONFIG_EST:
		ret = ether_config_est(ndev, &ifdata);
		break;
	case ETHER_CONFIG_FPE:
		ret = ether_config_fpe(ndev, &ifdata);
		break;
#ifdef OSI_DEBUG
	case ETHER_REGISTER_DUMP:
		osi_dma->ioctl_data.cmd = OSI_DMA_IOCTL_CMD_REG_DUMP;
		ret = osi_dma_ioctl(osi_dma);
		if (ret < 0)
			goto err;

#ifndef OSI_STRIPPED_LIB
		ioctl_data.cmd = OSI_CMD_REG_DUMP;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
#endif /* !OSI_STRIPPED_LIB */
		break;
	case ETHER_STRUCTURE_DUMP:
		osi_dma->ioctl_data.cmd = OSI_DMA_IOCTL_CMD_STRUCTS_DUMP;
		ret = osi_dma_ioctl(osi_dma);
		if (ret < 0)
			goto err;

		ioctl_data.cmd = OSI_CMD_STRUCTS_DUMP;
		ret = osi_handle_ioctl(osi_core, &ioctl_data);
		break;
	case ETHER_DEBUG_INTR_CONFIG:
		ret = ether_debug_intr_config(ndev, &ifdata);
		break;
#endif
	case ETHER_CAP_TSC_PTP:
		ret = ether_get_tsc_ptp_cap(ndev, &ifdata);
		break;

	case ETHER_M2M_TSYNC:
		ret = ether_m2m_tsync(ndev, &ifdata);
		break;

	case ETHER_L2_ADDR:
		ret = ether_config_l2_filters(ndev, &ifdata);
		break;

	default:
		break;
	}
err:
	ifdata.command_error = ret;
	if (copy_to_user(ifr->ifr_data, &ifdata, sizeof(ifdata)) != 0U) {
		dev_err(pdata->dev, "%s: copy_to_user failed\n", __func__);
		return -EFAULT;
	}

	return ret;
}