Quelle  fm10k_vf.c   Sprache: C

// 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,
};