ethtool/lib/rte_ethtool.c

/*-
 *   BSD LICENSE
 *
 *   Copyright(c) 2010-2015 Intel Corporation. All rights reserved.
 *   All rights reserved.
 *
 *   Redistribution and use in source and binary forms, with or without
 *   modification, are permitted provided that the following conditions
 *   are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above copyright
 *       notice, this list of conditions and the following disclaimer in
 *       the documentation and/or other materials provided with the
 *       distribution.
 *     * Neither the name of Intel Corporation nor the names of its
 *       contributors may be used to endorse or promote products derived
 *       from this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
 *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */
#include <stdio.h>
#include <string.h>
#include <stdint.h>
#include <rte_version.h>
#include <rte_ethdev.h>
#include <rte_ether.h>
#include "rte_ethtool.h"

#define PKTPOOL_SIZE 512
#define PKTPOOL_CACHE 32


int
rte_ethtool_get_drvinfo(uint8_t port_id, struct ethtool_drvinfo *drvinfo)
{
        struct rte_eth_dev_info dev_info;
        int n;

        if (drvinfo == NULL)
                return -EINVAL;

        if (!rte_eth_dev_is_valid_port(port_id))
                return -ENODEV;

        memset(&dev_info, 0, sizeof(dev_info));
        rte_eth_dev_info_get(port_id, &dev_info);

        snprintf(drvinfo->driver, sizeof(drvinfo->driver), "%s",
                dev_info.driver_name);
        snprintf(drvinfo->version, sizeof(drvinfo->version), "%s",
                rte_version());
        snprintf(drvinfo->bus_info, sizeof(drvinfo->bus_info),
                "%04x:%02x:%02x.%x",
                dev_info.pci_dev->addr.domain, dev_info.pci_dev->addr.bus,
                dev_info.pci_dev->addr.devid, dev_info.pci_dev->addr.function);

        n = rte_eth_dev_get_reg_length(port_id);
        if (n > 0)
                drvinfo->regdump_len = n;
        else
                drvinfo->regdump_len = 0;

        n = rte_eth_dev_get_eeprom_length(port_id);
        if (n > 0)
                drvinfo->eedump_len = n;
        else
                drvinfo->eedump_len = 0;

        drvinfo->n_stats = sizeof(struct rte_eth_stats) / sizeof(uint64_t);
        drvinfo->testinfo_len = 0;

        return 0;
}

int
rte_ethtool_get_regs_len(uint8_t port_id)
{
        int count_regs;

        count_regs = rte_eth_dev_get_reg_length(port_id);
        if (count_regs > 0)
                return count_regs * sizeof(uint32_t);
        return count_regs;
}

int
rte_ethtool_get_regs(uint8_t port_id, struct ethtool_regs *regs, void *data)
{
        struct rte_dev_reg_info reg_info;
        int status;

        if (regs == NULL || data == NULL)
                return -EINVAL;

        reg_info.data = data;
        reg_info.length = 0;

        status = rte_eth_dev_get_reg_info(port_id, &reg_info);
        if (status)
                return status;
        regs->version = reg_info.version;

        return 0;
}

int
rte_ethtool_get_link(uint8_t port_id)
{
        struct rte_eth_link link;

        if (!rte_eth_dev_is_valid_port(port_id))
                return -ENODEV;
        rte_eth_link_get(port_id, &link);
        return link.link_status;
}

int
rte_ethtool_get_eeprom_len(uint8_t port_id)
{
        return rte_eth_dev_get_eeprom_length(port_id);
}

int
rte_ethtool_get_eeprom(uint8_t port_id, struct ethtool_eeprom *eeprom,
        void *words)
{
        struct rte_dev_eeprom_info eeprom_info;
        int status;

        if (eeprom == NULL || words == NULL)
                return -EINVAL;

        eeprom_info.offset = eeprom->offset;
        eeprom_info.length = eeprom->len;
        eeprom_info.data = words;

        status = rte_eth_dev_get_eeprom(port_id, &eeprom_info);
        if (status)
                return status;

        eeprom->magic = eeprom_info.magic;

        return 0;
}

int
rte_ethtool_set_eeprom(uint8_t port_id, struct ethtool_eeprom *eeprom,
        void *words)
{
        struct rte_dev_eeprom_info eeprom_info;
        int status;

        if (eeprom == NULL || words == NULL || eeprom->offset >= eeprom->len)
                return -EINVAL;

        eeprom_info.offset = eeprom->offset;
        eeprom_info.length = eeprom->len;
        eeprom_info.data = words;

        status = rte_eth_dev_set_eeprom(port_id, &eeprom_info);
        if (status)
                return status;

        eeprom->magic = eeprom_info.magic;

        return 0;
}

int
rte_ethtool_get_pauseparam(uint8_t port_id,
        struct ethtool_pauseparam *pause_param)
{
        struct rte_eth_fc_conf fc_conf;
        int status;

        if (pause_param == NULL)
                return -EINVAL;

        status = rte_eth_dev_flow_ctrl_get(port_id, &fc_conf);
        if (status)
                return status;

        pause_param->tx_pause = 0;
        pause_param->rx_pause = 0;
        switch (fc_conf.mode) {
        case RTE_FC_RX_PAUSE:
                pause_param->rx_pause = 1;
                break;
        case RTE_FC_TX_PAUSE:
                pause_param->tx_pause = 1;
                break;
        case RTE_FC_FULL:
                pause_param->rx_pause = 1;
                pause_param->tx_pause = 1;
        default:
                /* dummy block to avoid compiler warning */
                break;
        }
        pause_param->autoneg = (uint32_t)fc_conf.autoneg;

        return 0;
}

int
rte_ethtool_set_pauseparam(uint8_t port_id,
        struct ethtool_pauseparam *pause_param)
{
        struct rte_eth_fc_conf fc_conf;
        int status;

        if (pause_param == NULL)
                return -EINVAL;

        /*
         * Read device flow control parameter first since
         * ethtool set_pauseparam op doesn't have all the information.
         * as defined in struct rte_eth_fc_conf.
         * This API requires the device to support both
         * rte_eth_dev_flow_ctrl_get and rte_eth_dev_flow_ctrl_set, otherwise
         * return -ENOTSUP
         */
        status = rte_eth_dev_flow_ctrl_get(port_id, &fc_conf);
        if (status)
                return status;

        fc_conf.autoneg = (uint8_t)pause_param->autoneg;

        if (pause_param->tx_pause) {
                if (pause_param->rx_pause)
                        fc_conf.mode = RTE_FC_FULL;
                else
                        fc_conf.mode = RTE_FC_TX_PAUSE;
        } else {
                if (pause_param->rx_pause)
                        fc_conf.mode = RTE_FC_RX_PAUSE;
                else
                        fc_conf.mode = RTE_FC_NONE;
        }

        status = rte_eth_dev_flow_ctrl_set(port_id, &fc_conf);
        if (status)
                return status;

        return 0;
}

int
rte_ethtool_net_open(uint8_t port_id)
{
        rte_eth_dev_stop(port_id);

        return rte_eth_dev_start(port_id);
}

int
rte_ethtool_net_stop(uint8_t port_id)
{
        if (!rte_eth_dev_is_valid_port(port_id))
                return -ENODEV;
        rte_eth_dev_stop(port_id);

        return 0;
}

int
rte_ethtool_net_get_mac_addr(uint8_t port_id, struct ether_addr *addr)
{
        if (!rte_eth_dev_is_valid_port(port_id))
                return -ENODEV;
        if (addr == NULL)
                return -EINVAL;
        rte_eth_macaddr_get(port_id, addr);

        return 0;
}

int
rte_ethtool_net_set_mac_addr(uint8_t port_id, struct ether_addr *addr)
{
        if (addr == NULL)
                return -EINVAL;
        return rte_eth_dev_default_mac_addr_set(port_id, addr);
}

int
rte_ethtool_net_validate_addr(uint8_t port_id __rte_unused,
        struct ether_addr *addr)
{
        if (addr == NULL)
                return -EINVAL;
        return is_valid_assigned_ether_addr(addr);
}

int
rte_ethtool_net_change_mtu(uint8_t port_id, int mtu)
{
        if (mtu < 0 || mtu > UINT16_MAX)
                return -EINVAL;
        return rte_eth_dev_set_mtu(port_id, (uint16_t)mtu);
}

int
rte_ethtool_net_get_stats64(uint8_t port_id, struct rte_eth_stats *stats)
{
        if (stats == NULL)
                return -EINVAL;
        return rte_eth_stats_get(port_id, stats);
}

int
rte_ethtool_net_vlan_rx_add_vid(uint8_t port_id, uint16_t vid)
{
        return rte_eth_dev_vlan_filter(port_id, vid, 1);
}

int
rte_ethtool_net_vlan_rx_kill_vid(uint8_t port_id, uint16_t vid)
{
        return rte_eth_dev_vlan_filter(port_id, vid, 0);
}

/*
 * The set_rx_mode provides driver-specific rx mode setting.
 * This implementation implements rx mode setting based upon
 * ixgbe/igb drivers. Further improvement is to provide a
 * callback op field over struct rte_eth_dev::dev_ops so each
 * driver can register device-specific implementation
 */
int
rte_ethtool_net_set_rx_mode(uint8_t port_id)
{
        uint16_t num_vfs;
        struct rte_eth_dev_info dev_info;
        uint16_t vf;

        memset(&dev_info, 0, sizeof(dev_info));
        rte_eth_dev_info_get(port_id, &dev_info);
        num_vfs = dev_info.max_vfs;

        /* Set VF vf_rx_mode, VF unsupport status is discard */
        for (vf = 0; vf < num_vfs; vf++)
                rte_eth_dev_set_vf_rxmode(port_id, vf,
                        ETH_VMDQ_ACCEPT_UNTAG, 0);

        /* Enable Rx vlan filter, VF unspport status is discard */
        rte_eth_dev_set_vlan_offload(port_id, ETH_VLAN_FILTER_MASK);

        return 0;
}


int
rte_ethtool_get_ringparam(uint8_t port_id,
        struct ethtool_ringparam *ring_param)
{
        struct rte_eth_dev_info dev_info;
        struct rte_eth_rxq_info rx_qinfo;
        struct rte_eth_txq_info tx_qinfo;
        int stat;

        if (ring_param == NULL)
                return -EINVAL;

        rte_eth_dev_info_get(port_id, &dev_info);

        stat = rte_eth_rx_queue_info_get(port_id, 0, &rx_qinfo);
        if (stat != 0)
                return stat;

        stat = rte_eth_tx_queue_info_get(port_id, 0, &tx_qinfo);
        if (stat != 0)
                return stat;

        memset(ring_param, 0, sizeof(*ring_param));
        ring_param->rx_pending = rx_qinfo.nb_desc;
        ring_param->rx_max_pending = dev_info.rx_desc_lim.nb_max;
        ring_param->tx_pending = tx_qinfo.nb_desc;
        ring_param->tx_max_pending = dev_info.tx_desc_lim.nb_max;

        return 0;
}


int
rte_ethtool_set_ringparam(uint8_t port_id,
        struct ethtool_ringparam *ring_param)
{
        struct rte_eth_rxq_info rx_qinfo;
        int stat;

        if (ring_param == NULL)
                return -EINVAL;

        stat = rte_eth_rx_queue_info_get(port_id, 0, &rx_qinfo);
        if (stat != 0)
                return stat;

        rte_eth_dev_stop(port_id);

        stat = rte_eth_tx_queue_setup(port_id, 0, ring_param->tx_pending,
                rte_socket_id(), NULL);
        if (stat != 0)
                return stat;

        stat = rte_eth_rx_queue_setup(port_id, 0, ring_param->rx_pending,
                rte_socket_id(), NULL, rx_qinfo.mp);
        if (stat != 0)
                return stat;

        return rte_eth_dev_start(port_id);
}