// SPDX-License-Identifier: GPL-2.0
/* Copyright(c) 2013 - 2019 Intel Corporation. */

#include <linux/bitfield.h>
#include "fm10k_vf.h"

/**
 *  fm10k_stop_hw_vf - Stop Tx/Rx units
 *  @hw: pointer to hardware structure
 *
 **/
static s32 fm10k_stop_hw_vf(struct fm10k_hw *hw)
{
        u8 *perm_addr = hw->mac.perm_addr;
        u32 bal = 0, bah = 0, tdlen;
        s32 err;
        u16 i;

        /* we need to disable the queues before taking further steps */
        err = fm10k_stop_hw_generic(hw);
        if (err && err != FM10K_ERR_REQUESTS_PENDING)
                return err;

        /* If permanent address is set then we need to restore it */
        if (is_valid_ether_addr(perm_addr)) {
                bal = (((u32)perm_addr[3]) << 24) |
                      (((u32)perm_addr[4]) << 16) |
                      (((u32)perm_addr[5]) << 8);
                bah = (((u32)0xFF)         << 24) |
                      (((u32)perm_addr[0]) << 16) |
                      (((u32)perm_addr[1]) << 8) |
                       ((u32)perm_addr[2]);
        }

        /* restore default itr_scale for next VF initialization */
        tdlen = hw->mac.itr_scale << FM10K_TDLEN_ITR_SCALE_SHIFT;

        /* The queues have already been disabled so we just need to
         * update their base address registers
         */
        for (i = 0; i < hw->mac.max_queues; i++) {
                fm10k_write_reg(hw, FM10K_TDBAL(i), bal);
                fm10k_write_reg(hw, FM10K_TDBAH(i), bah);
                fm10k_write_reg(hw, FM10K_RDBAL(i), bal);
                fm10k_write_reg(hw, FM10K_RDBAH(i), bah);
                /* Restore ITR scale in software-defined mechanism in TDLEN
                 * for next VF initialization. See definition of
                 * FM10K_TDLEN_ITR_SCALE_SHIFT for more details on the use of
                 * TDLEN here.
                 */
                fm10k_write_reg(hw, FM10K_TDLEN(i), tdlen);
        }

        return err;
}

/**
 *  fm10k_reset_hw_vf - VF hardware reset
 *  @hw: pointer to hardware structure
 *
 *  This function should return the hardware to a state similar to the
 *  one it is in after just being initialized.
 **/
static s32 fm10k_reset_hw_vf(struct fm10k_hw *hw)
{
        s32 err;

        /* shut down queues we own and reset DMA configuration */
        err = fm10k_stop_hw_vf(hw);
        if (err == FM10K_ERR_REQUESTS_PENDING)
                hw->mac.reset_while_pending++;
        else if (err)
                return err;

        /* Inititate VF reset */
        fm10k_write_reg(hw, FM10K_VFCTRL, FM10K_VFCTRL_RST);

        /* Flush write and allow 100us for reset to complete */
        fm10k_write_flush(hw);
        udelay(FM10K_RESET_TIMEOUT);

        /* Clear reset bit and verify it was cleared */
        fm10k_write_reg(hw, FM10K_VFCTRL, 0);
        if (fm10k_read_reg(hw, FM10K_VFCTRL) & FM10K_VFCTRL_RST)
                return FM10K_ERR_RESET_FAILED;

        return 0;
}

/**
 *  fm10k_init_hw_vf - VF hardware initialization
 *  @hw: pointer to hardware structure
 *
 **/
static s32 fm10k_init_hw_vf(struct fm10k_hw *hw)
{
        u32 tqdloc, tqdloc0 = ~fm10k_read_reg(hw, FM10K_TQDLOC(0));
        s32 err;
        u16 i;

        /* verify we have at least 1 queue */
        if (!~fm10k_read_reg(hw, FM10K_TXQCTL(0)) ||
            !~fm10k_read_reg(hw, FM10K_RXQCTL(0))) {
                err = FM10K_ERR_NO_RESOURCES;
                goto reset_max_queues;
        }

        /* determine how many queues we have */
        for (i = 1; tqdloc0 && (i < FM10K_MAX_QUEUES_POOL); i++) {
                /* verify the Descriptor cache offsets are increasing */
                tqdloc = ~fm10k_read_reg(hw, FM10K_TQDLOC(i));
                if (!tqdloc || (tqdloc == tqdloc0))
                        break;

                /* check to verify the PF doesn't own any of our queues */
                if (!~fm10k_read_reg(hw, FM10K_TXQCTL(i)) ||
                    !~fm10k_read_reg(hw, FM10K_RXQCTL(i)))
                        break;
        }

        /* shut down queues we own and reset DMA configuration */
        err = fm10k_disable_queues_generic(hw, i);
        if (err)
                goto reset_max_queues;

        /* record maximum queue count */
        hw->mac.max_queues = i;

        /* fetch default VLAN and ITR scale */
        hw->mac.default_vid = FIELD_GET(FM10K_TXQCTL_VID_MASK,
                                        fm10k_read_reg(hw, FM10K_TXQCTL(0)));
        /* Read the ITR scale from TDLEN. See the definition of
         * FM10K_TDLEN_ITR_SCALE_SHIFT for more information about how TDLEN is
         * used here.
         */
        hw->mac.itr_scale = FIELD_GET(FM10K_TDLEN_ITR_SCALE_MASK,
                                      fm10k_read_reg(hw, FM10K_TDLEN(0)));

        return 0;

reset_max_queues:
        hw->mac.max_queues = 0;

        return err;
}

/* This structure defines the attibutes to be parsed below */
const struct fm10k_tlv_attr fm10k_mac_vlan_msg_attr[] = {
        FM10K_TLV_ATTR_U32(FM10K_MAC_VLAN_MSG_VLAN),
        FM10K_TLV_ATTR_BOOL(FM10K_MAC_VLAN_MSG_SET),
        FM10K_TLV_ATTR_MAC_ADDR(FM10K_MAC_VLAN_MSG_MAC),
        FM10K_TLV_ATTR_MAC_ADDR(FM10K_MAC_VLAN_MSG_DEFAULT_MAC),
        FM10K_TLV_ATTR_MAC_ADDR(FM10K_MAC_VLAN_MSG_MULTICAST),
        FM10K_TLV_ATTR_LAST
};

/**
 *  fm10k_update_vlan_vf - Update status of VLAN ID in VLAN filter table
 *  @hw: pointer to hardware structure
 *  @vid: VLAN ID to add to table
 *  @vsi: Reserved, should always be 0
 *  @set: Indicates if this is a set or clear operation
 *
 *  This function adds or removes the corresponding VLAN ID from the VLAN
 *  filter table for this VF.
 **/
static s32 fm10k_update_vlan_vf(struct fm10k_hw *hw, u32 vid, u8 vsi, bool set)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[4];

        /* verify the index is not set */
        if (vsi)
                return FM10K_ERR_PARAM;

        /* clever trick to verify reserved bits in both vid and length */
        if ((vid << 16 | vid) >> 28)
                return FM10K_ERR_PARAM;

        /* encode set bit into the VLAN ID */
        if (!set)
                vid |= FM10K_VLAN_CLEAR;

        /* generate VLAN request */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_MAC_VLAN);
        fm10k_tlv_attr_put_u32(msg, FM10K_MAC_VLAN_MSG_VLAN, vid);

        /* load onto outgoing mailbox */
        return mbx->ops.enqueue_tx(hw, mbx, msg);
}

/**
 *  fm10k_msg_mac_vlan_vf - Read device MAC address from mailbox message
 *  @hw: pointer to the HW structure
 *  @results: Attributes for message
 *  @mbx: unused mailbox data
 *
 *  This function should determine the MAC address for the VF
 **/
s32 fm10k_msg_mac_vlan_vf(struct fm10k_hw *hw, u32 **results,
                          struct fm10k_mbx_info __always_unused *mbx)
{
        u8 perm_addr[ETH_ALEN];
        u16 vid;
        s32 err;

        /* record MAC address requested */
        err = fm10k_tlv_attr_get_mac_vlan(
                                        results[FM10K_MAC_VLAN_MSG_DEFAULT_MAC],
                                        perm_addr, &vid);
        if (err)
                return err;

        ether_addr_copy(hw->mac.perm_addr, perm_addr);
        hw->mac.default_vid = vid & (FM10K_VLAN_TABLE_VID_MAX - 1);
        hw->mac.vlan_override = !!(vid & FM10K_VLAN_OVERRIDE);

        return 0;
}

/**
 *  fm10k_read_mac_addr_vf - Read device MAC address
 *  @hw: pointer to the HW structure
 *
 *  This function should determine the MAC address for the VF
 **/
static s32 fm10k_read_mac_addr_vf(struct fm10k_hw *hw)
{
        u8 perm_addr[ETH_ALEN];
        u32 base_addr;

        base_addr = fm10k_read_reg(hw, FM10K_TDBAL(0));

        /* last byte should be 0 */
        if (base_addr << 24)
                return  FM10K_ERR_INVALID_MAC_ADDR;

        perm_addr[3] = (u8)(base_addr >> 24);
        perm_addr[4] = (u8)(base_addr >> 16);
        perm_addr[5] = (u8)(base_addr >> 8);

        base_addr = fm10k_read_reg(hw, FM10K_TDBAH(0));

        /* first byte should be all 1's */
        if ((~base_addr) >> 24)
                return  FM10K_ERR_INVALID_MAC_ADDR;

        perm_addr[0] = (u8)(base_addr >> 16);
        perm_addr[1] = (u8)(base_addr >> 8);
        perm_addr[2] = (u8)(base_addr);

        ether_addr_copy(hw->mac.perm_addr, perm_addr);
        ether_addr_copy(hw->mac.addr, perm_addr);

        return 0;
}

/**
 *  fm10k_update_uc_addr_vf - Update device unicast addresses
 *  @hw: pointer to the HW structure
 *  @glort: unused
 *  @mac: MAC address to add/remove from table
 *  @vid: VLAN ID to add/remove from table
 *  @add: Indicates if this is an add or remove operation
 *  @flags: flags field to indicate add and secure - unused
 *
 *  This function is used to add or remove unicast MAC addresses for
 *  the VF.
 **/
static s32 fm10k_update_uc_addr_vf(struct fm10k_hw *hw,
                                   u16 __always_unused glort,
                                   const u8 *mac, u16 vid, bool add,
                                   u8 __always_unused flags)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[7];

        /* verify VLAN ID is valid */
        if (vid >= FM10K_VLAN_TABLE_VID_MAX)
                return FM10K_ERR_PARAM;

        /* verify MAC address is valid */
        if (!is_valid_ether_addr(mac))
                return FM10K_ERR_PARAM;

        /* verify we are not locked down on the MAC address */
        if (is_valid_ether_addr(hw->mac.perm_addr) &&
            !ether_addr_equal(hw->mac.perm_addr, mac))
                return FM10K_ERR_PARAM;

        /* add bit to notify us if this is a set or clear operation */
        if (!add)
                vid |= FM10K_VLAN_CLEAR;

        /* generate VLAN request */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_MAC_VLAN);
        fm10k_tlv_attr_put_mac_vlan(msg, FM10K_MAC_VLAN_MSG_MAC, mac, vid);

        /* load onto outgoing mailbox */
        return mbx->ops.enqueue_tx(hw, mbx, msg);
}

/**
 *  fm10k_update_mc_addr_vf - Update device multicast addresses
 *  @hw: pointer to the HW structure
 *  @glort: unused
 *  @mac: MAC address to add/remove from table
 *  @vid: VLAN ID to add/remove from table
 *  @add: Indicates if this is an add or remove operation
 *
 *  This function is used to add or remove multicast MAC addresses for
 *  the VF.
 **/
static s32 fm10k_update_mc_addr_vf(struct fm10k_hw *hw,
                                   u16 __always_unused glort,
                                   const u8 *mac, u16 vid, bool add)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[7];

        /* verify VLAN ID is valid */
        if (vid >= FM10K_VLAN_TABLE_VID_MAX)
                return FM10K_ERR_PARAM;

        /* verify multicast address is valid */
        if (!is_multicast_ether_addr(mac))
                return FM10K_ERR_PARAM;

        /* add bit to notify us if this is a set or clear operation */
        if (!add)
                vid |= FM10K_VLAN_CLEAR;

        /* generate VLAN request */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_MAC_VLAN);
        fm10k_tlv_attr_put_mac_vlan(msg, FM10K_MAC_VLAN_MSG_MULTICAST,
                                    mac, vid);

        /* load onto outgoing mailbox */
        return mbx->ops.enqueue_tx(hw, mbx, msg);
}

/**
 *  fm10k_update_int_moderator_vf - Request update of interrupt moderator list
 *  @hw: pointer to hardware structure
 *
 *  This function will issue a request to the PF to rescan our MSI-X table
 *  and to update the interrupt moderator linked list.
 **/
static void fm10k_update_int_moderator_vf(struct fm10k_hw *hw)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[1];

        /* generate MSI-X request */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_MSIX);

        /* load onto outgoing mailbox */
        mbx->ops.enqueue_tx(hw, mbx, msg);
}

/* This structure defines the attibutes to be parsed below */
const struct fm10k_tlv_attr fm10k_lport_state_msg_attr[] = {
        FM10K_TLV_ATTR_BOOL(FM10K_LPORT_STATE_MSG_DISABLE),
        FM10K_TLV_ATTR_U8(FM10K_LPORT_STATE_MSG_XCAST_MODE),
        FM10K_TLV_ATTR_BOOL(FM10K_LPORT_STATE_MSG_READY),
        FM10K_TLV_ATTR_LAST
};

/**
 *  fm10k_msg_lport_state_vf - Message handler for lport_state message from PF
 *  @hw: Pointer to hardware structure
 *  @results: pointer array containing parsed data
 *  @mbx: Pointer to mailbox information structure
 *
 *  This handler is meant to capture the indication from the PF that we
 *  are ready to bring up the interface.
 **/
s32 fm10k_msg_lport_state_vf(struct fm10k_hw *hw, u32 **results,
                             struct fm10k_mbx_info __always_unused *mbx)
{
        hw->mac.dglort_map = !results[FM10K_LPORT_STATE_MSG_READY] ?
                             FM10K_DGLORTMAP_NONE : FM10K_DGLORTMAP_ZERO;

        return 0;
}

/**
 *  fm10k_update_lport_state_vf - Update device state in lower device
 *  @hw: pointer to the HW structure
 *  @glort: unused
 *  @count: number of logical ports to enable - unused (always 1)
 *  @enable: boolean value indicating if this is an enable or disable request
 *
 *  Notify the lower device of a state change.  If the lower device is
 *  enabled we can add filters, if it is disabled all filters for this
 *  logical port are flushed.
 **/
static s32 fm10k_update_lport_state_vf(struct fm10k_hw *hw,
                                       u16 __always_unused glort,
                                       u16 __always_unused count, bool enable)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[2];

        /* reset glort mask 0 as we have to wait to be enabled */
        hw->mac.dglort_map = FM10K_DGLORTMAP_NONE;

        /* generate port state request */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_LPORT_STATE);
        if (!enable)
                fm10k_tlv_attr_put_bool(msg, FM10K_LPORT_STATE_MSG_DISABLE);

        /* load onto outgoing mailbox */
        return mbx->ops.enqueue_tx(hw, mbx, msg);
}

/**
 *  fm10k_update_xcast_mode_vf - Request update of multicast mode
 *  @hw: pointer to hardware structure
 *  @glort: unused
 *  @mode: integer value indicating mode being requested
 *
 *  This function will attempt to request a higher mode for the port
 *  so that it can enable either multicast, multicast promiscuous, or
 *  promiscuous mode of operation.
 **/
static s32 fm10k_update_xcast_mode_vf(struct fm10k_hw *hw,
                                      u16 __always_unused glort, u8 mode)
{
        struct fm10k_mbx_info *mbx = &hw->mbx;
        u32 msg[3];

        if (mode > FM10K_XCAST_MODE_NONE)
                return FM10K_ERR_PARAM;

        /* generate message requesting to change xcast mode */
        fm10k_tlv_msg_init(msg, FM10K_VF_MSG_ID_LPORT_STATE);
        fm10k_tlv_attr_put_u8(msg, FM10K_LPORT_STATE_MSG_XCAST_MODE, mode);

        /* load onto outgoing mailbox */
        return mbx->ops.enqueue_tx(hw, mbx, msg);
}

/**
 *  fm10k_update_hw_stats_vf - Updates hardware related statistics of VF
 *  @hw: pointer to hardware structure
 *  @stats: pointer to statistics structure
 *
 *  This function collects and aggregates per queue hardware statistics.
 **/
static void fm10k_update_hw_stats_vf(struct fm10k_hw *hw,
                                     struct fm10k_hw_stats *stats)
{
        fm10k_update_hw_stats_q(hw, stats->q, 0, hw->mac.max_queues);
}

/**
 *  fm10k_rebind_hw_stats_vf - Resets base for hardware statistics of VF
 *  @hw: pointer to hardware structure
 *  @stats: pointer to the stats structure to update
 *
 *  This function resets the base for queue hardware statistics.
 **/
static void fm10k_rebind_hw_stats_vf(struct fm10k_hw *hw,
                                     struct fm10k_hw_stats *stats)
{
        /* Unbind Queue Statistics */
        fm10k_unbind_hw_stats_q(stats->q, hw->mac.max_queues);

        /* Reinitialize bases for all stats */
        fm10k_update_hw_stats_vf(hw, stats);
}

/**
 *  fm10k_configure_dglort_map_vf - Configures GLORT entry and queues
 *  @hw: pointer to hardware structure
 *  @dglort: pointer to dglort configuration structure
 *
 *  Reads the configuration structure contained in dglort_cfg and uses
 *  that information to then populate a DGLORTMAP/DEC entry and the queues
 *  to which it has been assigned.
 **/
static s32 fm10k_configure_dglort_map_vf(struct fm10k_hw __always_unused *hw,
                                         struct fm10k_dglort_cfg *dglort)
{
        /* verify the dglort pointer */
        if (!dglort)
                return FM10K_ERR_PARAM;

        /* stub for now until we determine correct message for this */

        return 0;
}

static const struct fm10k_msg_data fm10k_msg_data_vf[] = {
        FM10K_TLV_MSG_TEST_HANDLER(fm10k_tlv_msg_test),
        FM10K_VF_MSG_MAC_VLAN_HANDLER(fm10k_msg_mac_vlan_vf),
        FM10K_VF_MSG_LPORT_STATE_HANDLER(fm10k_msg_lport_state_vf),
        FM10K_TLV_MSG_ERROR_HANDLER(fm10k_tlv_msg_error),
};

static const struct fm10k_mac_ops mac_ops_vf = {
        .get_bus_info           = fm10k_get_bus_info_generic,
        .reset_hw               = fm10k_reset_hw_vf,
        .init_hw                = fm10k_init_hw_vf,
        .start_hw               = fm10k_start_hw_generic,
        .stop_hw                = fm10k_stop_hw_vf,
        .update_vlan            = fm10k_update_vlan_vf,
        .read_mac_addr          = fm10k_read_mac_addr_vf,
        .update_uc_addr         = fm10k_update_uc_addr_vf,
        .update_mc_addr         = fm10k_update_mc_addr_vf,
        .update_xcast_mode      = fm10k_update_xcast_mode_vf,
        .update_int_moderator   = fm10k_update_int_moderator_vf,
        .update_lport_state     = fm10k_update_lport_state_vf,
        .update_hw_stats        = fm10k_update_hw_stats_vf,
        .rebind_hw_stats        = fm10k_rebind_hw_stats_vf,
        .configure_dglort_map   = fm10k_configure_dglort_map_vf,
        .get_host_state         = fm10k_get_host_state_generic,
};

static s32 fm10k_get_invariants_vf(struct fm10k_hw *hw)
{
        fm10k_get_invariants_generic(hw);

        return fm10k_pfvf_mbx_init(hw, &hw->mbx, fm10k_msg_data_vf, 0);
}

const struct fm10k_info fm10k_vf_info = {
        .mac            = fm10k_mac_vf,
        .get_invariants = fm10k_get_invariants_vf,
        .mac_ops        = &mac_ops_vf,
};