6db4831e98
Android 14
1893 lines
56 KiB
C
1893 lines
56 KiB
C
// SPDX-License-Identifier: GPL-2.0
|
|
/* Copyright (c) 2018, Intel Corporation. */
|
|
|
|
#include "ice_switch.h"
|
|
|
|
#define ICE_ETH_DA_OFFSET 0
|
|
#define ICE_ETH_ETHTYPE_OFFSET 12
|
|
#define ICE_ETH_VLAN_TCI_OFFSET 14
|
|
#define ICE_MAX_VLAN_ID 0xFFF
|
|
|
|
/* Dummy ethernet header needed in the ice_aqc_sw_rules_elem
|
|
* struct to configure any switch filter rules.
|
|
* {DA (6 bytes), SA(6 bytes),
|
|
* Ether type (2 bytes for header without VLAN tag) OR
|
|
* VLAN tag (4 bytes for header with VLAN tag) }
|
|
*
|
|
* Word on Hardcoded values
|
|
* byte 0 = 0x2: to identify it as locally administered DA MAC
|
|
* byte 6 = 0x2: to identify it as locally administered SA MAC
|
|
* byte 12 = 0x81 & byte 13 = 0x00:
|
|
* In case of VLAN filter first two bytes defines ether type (0x8100)
|
|
* and remaining two bytes are placeholder for programming a given VLAN id
|
|
* In case of Ether type filter it is treated as header without VLAN tag
|
|
* and byte 12 and 13 is used to program a given Ether type instead
|
|
*/
|
|
#define DUMMY_ETH_HDR_LEN 16
|
|
static const u8 dummy_eth_header[DUMMY_ETH_HDR_LEN] = { 0x2, 0, 0, 0, 0, 0,
|
|
0x2, 0, 0, 0, 0, 0,
|
|
0x81, 0, 0, 0};
|
|
|
|
#define ICE_SW_RULE_RX_TX_ETH_HDR_SIZE \
|
|
(sizeof(struct ice_aqc_sw_rules_elem) - \
|
|
sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
|
|
sizeof(struct ice_sw_rule_lkup_rx_tx) + DUMMY_ETH_HDR_LEN - 1)
|
|
#define ICE_SW_RULE_RX_TX_NO_HDR_SIZE \
|
|
(sizeof(struct ice_aqc_sw_rules_elem) - \
|
|
sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
|
|
sizeof(struct ice_sw_rule_lkup_rx_tx) - 1)
|
|
#define ICE_SW_RULE_LG_ACT_SIZE(n) \
|
|
(sizeof(struct ice_aqc_sw_rules_elem) - \
|
|
sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
|
|
sizeof(struct ice_sw_rule_lg_act) - \
|
|
sizeof(((struct ice_sw_rule_lg_act *)0)->act) + \
|
|
((n) * sizeof(((struct ice_sw_rule_lg_act *)0)->act)))
|
|
#define ICE_SW_RULE_VSI_LIST_SIZE(n) \
|
|
(sizeof(struct ice_aqc_sw_rules_elem) - \
|
|
sizeof(((struct ice_aqc_sw_rules_elem *)0)->pdata) + \
|
|
sizeof(struct ice_sw_rule_vsi_list) - \
|
|
sizeof(((struct ice_sw_rule_vsi_list *)0)->vsi) + \
|
|
((n) * sizeof(((struct ice_sw_rule_vsi_list *)0)->vsi)))
|
|
|
|
/**
|
|
* ice_aq_alloc_free_res - command to allocate/free resources
|
|
* @hw: pointer to the hw struct
|
|
* @num_entries: number of resource entries in buffer
|
|
* @buf: Indirect buffer to hold data parameters and response
|
|
* @buf_size: size of buffer for indirect commands
|
|
* @opc: pass in the command opcode
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Helper function to allocate/free resources using the admin queue commands
|
|
*/
|
|
static enum ice_status
|
|
ice_aq_alloc_free_res(struct ice_hw *hw, u16 num_entries,
|
|
struct ice_aqc_alloc_free_res_elem *buf, u16 buf_size,
|
|
enum ice_adminq_opc opc, struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aqc_alloc_free_res_cmd *cmd;
|
|
struct ice_aq_desc desc;
|
|
|
|
cmd = &desc.params.sw_res_ctrl;
|
|
|
|
if (!buf)
|
|
return ICE_ERR_PARAM;
|
|
|
|
if (buf_size < (num_entries * sizeof(buf->elem[0])))
|
|
return ICE_ERR_PARAM;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, opc);
|
|
|
|
desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
|
|
|
|
cmd->num_entries = cpu_to_le16(num_entries);
|
|
|
|
return ice_aq_send_cmd(hw, &desc, buf, buf_size, cd);
|
|
}
|
|
|
|
/**
|
|
* ice_aq_get_sw_cfg - get switch configuration
|
|
* @hw: pointer to the hardware structure
|
|
* @buf: pointer to the result buffer
|
|
* @buf_size: length of the buffer available for response
|
|
* @req_desc: pointer to requested descriptor
|
|
* @num_elems: pointer to number of elements
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Get switch configuration (0x0200) to be placed in 'buff'.
|
|
* This admin command returns information such as initial VSI/port number
|
|
* and switch ID it belongs to.
|
|
*
|
|
* NOTE: *req_desc is both an input/output parameter.
|
|
* The caller of this function first calls this function with *request_desc set
|
|
* to 0. If the response from f/w has *req_desc set to 0, all the switch
|
|
* configuration information has been returned; if non-zero (meaning not all
|
|
* the information was returned), the caller should call this function again
|
|
* with *req_desc set to the previous value returned by f/w to get the
|
|
* next block of switch configuration information.
|
|
*
|
|
* *num_elems is output only parameter. This reflects the number of elements
|
|
* in response buffer. The caller of this function to use *num_elems while
|
|
* parsing the response buffer.
|
|
*/
|
|
static enum ice_status
|
|
ice_aq_get_sw_cfg(struct ice_hw *hw, struct ice_aqc_get_sw_cfg_resp *buf,
|
|
u16 buf_size, u16 *req_desc, u16 *num_elems,
|
|
struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aqc_get_sw_cfg *cmd;
|
|
enum ice_status status;
|
|
struct ice_aq_desc desc;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_get_sw_cfg);
|
|
cmd = &desc.params.get_sw_conf;
|
|
cmd->element = cpu_to_le16(*req_desc);
|
|
|
|
status = ice_aq_send_cmd(hw, &desc, buf, buf_size, cd);
|
|
if (!status) {
|
|
*req_desc = le16_to_cpu(cmd->element);
|
|
*num_elems = le16_to_cpu(cmd->num_elems);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_aq_add_vsi
|
|
* @hw: pointer to the hw struct
|
|
* @vsi_ctx: pointer to a VSI context struct
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Add a VSI context to the hardware (0x0210)
|
|
*/
|
|
enum ice_status
|
|
ice_aq_add_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
|
|
struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aqc_add_update_free_vsi_resp *res;
|
|
struct ice_aqc_add_get_update_free_vsi *cmd;
|
|
enum ice_status status;
|
|
struct ice_aq_desc desc;
|
|
|
|
cmd = &desc.params.vsi_cmd;
|
|
res = (struct ice_aqc_add_update_free_vsi_resp *)&desc.params.raw;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_add_vsi);
|
|
|
|
if (!vsi_ctx->alloc_from_pool)
|
|
cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num |
|
|
ICE_AQ_VSI_IS_VALID);
|
|
|
|
cmd->vsi_flags = cpu_to_le16(vsi_ctx->flags);
|
|
|
|
desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
|
|
|
|
status = ice_aq_send_cmd(hw, &desc, &vsi_ctx->info,
|
|
sizeof(vsi_ctx->info), cd);
|
|
|
|
if (!status) {
|
|
vsi_ctx->vsi_num = le16_to_cpu(res->vsi_num) & ICE_AQ_VSI_NUM_M;
|
|
vsi_ctx->vsis_allocd = le16_to_cpu(res->vsi_used);
|
|
vsi_ctx->vsis_unallocated = le16_to_cpu(res->vsi_free);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_aq_update_vsi
|
|
* @hw: pointer to the hw struct
|
|
* @vsi_ctx: pointer to a VSI context struct
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Update VSI context in the hardware (0x0211)
|
|
*/
|
|
enum ice_status
|
|
ice_aq_update_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
|
|
struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aqc_add_update_free_vsi_resp *resp;
|
|
struct ice_aqc_add_get_update_free_vsi *cmd;
|
|
struct ice_aq_desc desc;
|
|
enum ice_status status;
|
|
|
|
cmd = &desc.params.vsi_cmd;
|
|
resp = (struct ice_aqc_add_update_free_vsi_resp *)&desc.params.raw;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_update_vsi);
|
|
|
|
cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num | ICE_AQ_VSI_IS_VALID);
|
|
|
|
desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
|
|
|
|
status = ice_aq_send_cmd(hw, &desc, &vsi_ctx->info,
|
|
sizeof(vsi_ctx->info), cd);
|
|
|
|
if (!status) {
|
|
vsi_ctx->vsis_allocd = le16_to_cpu(resp->vsi_used);
|
|
vsi_ctx->vsis_unallocated = le16_to_cpu(resp->vsi_free);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_aq_free_vsi
|
|
* @hw: pointer to the hw struct
|
|
* @vsi_ctx: pointer to a VSI context struct
|
|
* @keep_vsi_alloc: keep VSI allocation as part of this PF's resources
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Get VSI context info from hardware (0x0213)
|
|
*/
|
|
enum ice_status
|
|
ice_aq_free_vsi(struct ice_hw *hw, struct ice_vsi_ctx *vsi_ctx,
|
|
bool keep_vsi_alloc, struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aqc_add_update_free_vsi_resp *resp;
|
|
struct ice_aqc_add_get_update_free_vsi *cmd;
|
|
struct ice_aq_desc desc;
|
|
enum ice_status status;
|
|
|
|
cmd = &desc.params.vsi_cmd;
|
|
resp = (struct ice_aqc_add_update_free_vsi_resp *)&desc.params.raw;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, ice_aqc_opc_free_vsi);
|
|
|
|
cmd->vsi_num = cpu_to_le16(vsi_ctx->vsi_num | ICE_AQ_VSI_IS_VALID);
|
|
if (keep_vsi_alloc)
|
|
cmd->cmd_flags = cpu_to_le16(ICE_AQ_VSI_KEEP_ALLOC);
|
|
|
|
status = ice_aq_send_cmd(hw, &desc, NULL, 0, cd);
|
|
if (!status) {
|
|
vsi_ctx->vsis_allocd = le16_to_cpu(resp->vsi_used);
|
|
vsi_ctx->vsis_unallocated = le16_to_cpu(resp->vsi_free);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_aq_alloc_free_vsi_list
|
|
* @hw: pointer to the hw struct
|
|
* @vsi_list_id: VSI list id returned or used for lookup
|
|
* @lkup_type: switch rule filter lookup type
|
|
* @opc: switch rules population command type - pass in the command opcode
|
|
*
|
|
* allocates or free a VSI list resource
|
|
*/
|
|
static enum ice_status
|
|
ice_aq_alloc_free_vsi_list(struct ice_hw *hw, u16 *vsi_list_id,
|
|
enum ice_sw_lkup_type lkup_type,
|
|
enum ice_adminq_opc opc)
|
|
{
|
|
struct ice_aqc_alloc_free_res_elem *sw_buf;
|
|
struct ice_aqc_res_elem *vsi_ele;
|
|
enum ice_status status;
|
|
u16 buf_len;
|
|
|
|
buf_len = sizeof(*sw_buf);
|
|
sw_buf = devm_kzalloc(ice_hw_to_dev(hw), buf_len, GFP_KERNEL);
|
|
if (!sw_buf)
|
|
return ICE_ERR_NO_MEMORY;
|
|
sw_buf->num_elems = cpu_to_le16(1);
|
|
|
|
if (lkup_type == ICE_SW_LKUP_MAC ||
|
|
lkup_type == ICE_SW_LKUP_MAC_VLAN ||
|
|
lkup_type == ICE_SW_LKUP_ETHERTYPE ||
|
|
lkup_type == ICE_SW_LKUP_ETHERTYPE_MAC ||
|
|
lkup_type == ICE_SW_LKUP_PROMISC ||
|
|
lkup_type == ICE_SW_LKUP_PROMISC_VLAN) {
|
|
sw_buf->res_type = cpu_to_le16(ICE_AQC_RES_TYPE_VSI_LIST_REP);
|
|
} else if (lkup_type == ICE_SW_LKUP_VLAN) {
|
|
sw_buf->res_type =
|
|
cpu_to_le16(ICE_AQC_RES_TYPE_VSI_LIST_PRUNE);
|
|
} else {
|
|
status = ICE_ERR_PARAM;
|
|
goto ice_aq_alloc_free_vsi_list_exit;
|
|
}
|
|
|
|
if (opc == ice_aqc_opc_free_res)
|
|
sw_buf->elem[0].e.sw_resp = cpu_to_le16(*vsi_list_id);
|
|
|
|
status = ice_aq_alloc_free_res(hw, 1, sw_buf, buf_len, opc, NULL);
|
|
if (status)
|
|
goto ice_aq_alloc_free_vsi_list_exit;
|
|
|
|
if (opc == ice_aqc_opc_alloc_res) {
|
|
vsi_ele = &sw_buf->elem[0];
|
|
*vsi_list_id = le16_to_cpu(vsi_ele->e.sw_resp);
|
|
}
|
|
|
|
ice_aq_alloc_free_vsi_list_exit:
|
|
devm_kfree(ice_hw_to_dev(hw), sw_buf);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_aq_sw_rules - add/update/remove switch rules
|
|
* @hw: pointer to the hw struct
|
|
* @rule_list: pointer to switch rule population list
|
|
* @rule_list_sz: total size of the rule list in bytes
|
|
* @num_rules: number of switch rules in the rule_list
|
|
* @opc: switch rules population command type - pass in the command opcode
|
|
* @cd: pointer to command details structure or NULL
|
|
*
|
|
* Add(0x02a0)/Update(0x02a1)/Remove(0x02a2) switch rules commands to firmware
|
|
*/
|
|
static enum ice_status
|
|
ice_aq_sw_rules(struct ice_hw *hw, void *rule_list, u16 rule_list_sz,
|
|
u8 num_rules, enum ice_adminq_opc opc, struct ice_sq_cd *cd)
|
|
{
|
|
struct ice_aq_desc desc;
|
|
|
|
if (opc != ice_aqc_opc_add_sw_rules &&
|
|
opc != ice_aqc_opc_update_sw_rules &&
|
|
opc != ice_aqc_opc_remove_sw_rules)
|
|
return ICE_ERR_PARAM;
|
|
|
|
ice_fill_dflt_direct_cmd_desc(&desc, opc);
|
|
|
|
desc.flags |= cpu_to_le16(ICE_AQ_FLAG_RD);
|
|
desc.params.sw_rules.num_rules_fltr_entry_index =
|
|
cpu_to_le16(num_rules);
|
|
return ice_aq_send_cmd(hw, &desc, rule_list, rule_list_sz, cd);
|
|
}
|
|
|
|
/* ice_init_port_info - Initialize port_info with switch configuration data
|
|
* @pi: pointer to port_info
|
|
* @vsi_port_num: VSI number or port number
|
|
* @type: Type of switch element (port or VSI)
|
|
* @swid: switch ID of the switch the element is attached to
|
|
* @pf_vf_num: PF or VF number
|
|
* @is_vf: true if the element is a VF, false otherwise
|
|
*/
|
|
static void
|
|
ice_init_port_info(struct ice_port_info *pi, u16 vsi_port_num, u8 type,
|
|
u16 swid, u16 pf_vf_num, bool is_vf)
|
|
{
|
|
switch (type) {
|
|
case ICE_AQC_GET_SW_CONF_RESP_PHYS_PORT:
|
|
pi->lport = (u8)(vsi_port_num & ICE_LPORT_MASK);
|
|
pi->sw_id = swid;
|
|
pi->pf_vf_num = pf_vf_num;
|
|
pi->is_vf = is_vf;
|
|
pi->dflt_tx_vsi_num = ICE_DFLT_VSI_INVAL;
|
|
pi->dflt_rx_vsi_num = ICE_DFLT_VSI_INVAL;
|
|
break;
|
|
default:
|
|
ice_debug(pi->hw, ICE_DBG_SW,
|
|
"incorrect VSI/port type received\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
/* ice_get_initial_sw_cfg - Get initial port and default VSI data
|
|
* @hw: pointer to the hardware structure
|
|
*/
|
|
enum ice_status ice_get_initial_sw_cfg(struct ice_hw *hw)
|
|
{
|
|
struct ice_aqc_get_sw_cfg_resp *rbuf;
|
|
enum ice_status status;
|
|
u16 req_desc = 0;
|
|
u16 num_elems;
|
|
u16 i;
|
|
|
|
rbuf = devm_kzalloc(ice_hw_to_dev(hw), ICE_SW_CFG_MAX_BUF_LEN,
|
|
GFP_KERNEL);
|
|
|
|
if (!rbuf)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
/* Multiple calls to ice_aq_get_sw_cfg may be required
|
|
* to get all the switch configuration information. The need
|
|
* for additional calls is indicated by ice_aq_get_sw_cfg
|
|
* writing a non-zero value in req_desc
|
|
*/
|
|
do {
|
|
status = ice_aq_get_sw_cfg(hw, rbuf, ICE_SW_CFG_MAX_BUF_LEN,
|
|
&req_desc, &num_elems, NULL);
|
|
|
|
if (status)
|
|
break;
|
|
|
|
for (i = 0; i < num_elems; i++) {
|
|
struct ice_aqc_get_sw_cfg_resp_elem *ele;
|
|
u16 pf_vf_num, swid, vsi_port_num;
|
|
bool is_vf = false;
|
|
u8 type;
|
|
|
|
ele = rbuf[i].elements;
|
|
vsi_port_num = le16_to_cpu(ele->vsi_port_num) &
|
|
ICE_AQC_GET_SW_CONF_RESP_VSI_PORT_NUM_M;
|
|
|
|
pf_vf_num = le16_to_cpu(ele->pf_vf_num) &
|
|
ICE_AQC_GET_SW_CONF_RESP_FUNC_NUM_M;
|
|
|
|
swid = le16_to_cpu(ele->swid);
|
|
|
|
if (le16_to_cpu(ele->pf_vf_num) &
|
|
ICE_AQC_GET_SW_CONF_RESP_IS_VF)
|
|
is_vf = true;
|
|
|
|
type = le16_to_cpu(ele->vsi_port_num) >>
|
|
ICE_AQC_GET_SW_CONF_RESP_TYPE_S;
|
|
|
|
if (type == ICE_AQC_GET_SW_CONF_RESP_VSI) {
|
|
/* FW VSI is not needed. Just continue. */
|
|
continue;
|
|
}
|
|
|
|
ice_init_port_info(hw->port_info, vsi_port_num,
|
|
type, swid, pf_vf_num, is_vf);
|
|
}
|
|
} while (req_desc && !status);
|
|
|
|
devm_kfree(ice_hw_to_dev(hw), (void *)rbuf);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_fill_sw_info - Helper function to populate lb_en and lan_en
|
|
* @hw: pointer to the hardware structure
|
|
* @f_info: filter info structure to fill/update
|
|
*
|
|
* This helper function populates the lb_en and lan_en elements of the provided
|
|
* ice_fltr_info struct using the switch's type and characteristics of the
|
|
* switch rule being configured.
|
|
*/
|
|
static void ice_fill_sw_info(struct ice_hw *hw, struct ice_fltr_info *f_info)
|
|
{
|
|
f_info->lb_en = false;
|
|
f_info->lan_en = false;
|
|
if ((f_info->flag & ICE_FLTR_TX) &&
|
|
(f_info->fltr_act == ICE_FWD_TO_VSI ||
|
|
f_info->fltr_act == ICE_FWD_TO_VSI_LIST ||
|
|
f_info->fltr_act == ICE_FWD_TO_Q ||
|
|
f_info->fltr_act == ICE_FWD_TO_QGRP)) {
|
|
f_info->lb_en = true;
|
|
if (!(hw->evb_veb && f_info->lkup_type == ICE_SW_LKUP_MAC &&
|
|
is_unicast_ether_addr(f_info->l_data.mac.mac_addr)))
|
|
f_info->lan_en = true;
|
|
}
|
|
}
|
|
|
|
/**
|
|
* ice_fill_sw_rule - Helper function to fill switch rule structure
|
|
* @hw: pointer to the hardware structure
|
|
* @f_info: entry containing packet forwarding information
|
|
* @s_rule: switch rule structure to be filled in based on mac_entry
|
|
* @opc: switch rules population command type - pass in the command opcode
|
|
*/
|
|
static void
|
|
ice_fill_sw_rule(struct ice_hw *hw, struct ice_fltr_info *f_info,
|
|
struct ice_aqc_sw_rules_elem *s_rule, enum ice_adminq_opc opc)
|
|
{
|
|
u16 vlan_id = ICE_MAX_VLAN_ID + 1;
|
|
u8 eth_hdr[DUMMY_ETH_HDR_LEN];
|
|
void *daddr = NULL;
|
|
u32 act = 0;
|
|
__be16 *off;
|
|
u8 q_rgn;
|
|
|
|
if (opc == ice_aqc_opc_remove_sw_rules) {
|
|
s_rule->pdata.lkup_tx_rx.act = 0;
|
|
s_rule->pdata.lkup_tx_rx.index =
|
|
cpu_to_le16(f_info->fltr_rule_id);
|
|
s_rule->pdata.lkup_tx_rx.hdr_len = 0;
|
|
return;
|
|
}
|
|
|
|
/* initialize the ether header with a dummy header */
|
|
memcpy(eth_hdr, dummy_eth_header, sizeof(dummy_eth_header));
|
|
ice_fill_sw_info(hw, f_info);
|
|
|
|
switch (f_info->fltr_act) {
|
|
case ICE_FWD_TO_VSI:
|
|
act |= (f_info->fwd_id.vsi_id << ICE_SINGLE_ACT_VSI_ID_S) &
|
|
ICE_SINGLE_ACT_VSI_ID_M;
|
|
if (f_info->lkup_type != ICE_SW_LKUP_VLAN)
|
|
act |= ICE_SINGLE_ACT_VSI_FORWARDING |
|
|
ICE_SINGLE_ACT_VALID_BIT;
|
|
break;
|
|
case ICE_FWD_TO_VSI_LIST:
|
|
act |= ICE_SINGLE_ACT_VSI_LIST;
|
|
act |= (f_info->fwd_id.vsi_list_id <<
|
|
ICE_SINGLE_ACT_VSI_LIST_ID_S) &
|
|
ICE_SINGLE_ACT_VSI_LIST_ID_M;
|
|
if (f_info->lkup_type != ICE_SW_LKUP_VLAN)
|
|
act |= ICE_SINGLE_ACT_VSI_FORWARDING |
|
|
ICE_SINGLE_ACT_VALID_BIT;
|
|
break;
|
|
case ICE_FWD_TO_Q:
|
|
act |= ICE_SINGLE_ACT_TO_Q;
|
|
act |= (f_info->fwd_id.q_id << ICE_SINGLE_ACT_Q_INDEX_S) &
|
|
ICE_SINGLE_ACT_Q_INDEX_M;
|
|
break;
|
|
case ICE_DROP_PACKET:
|
|
act |= ICE_SINGLE_ACT_VSI_FORWARDING | ICE_SINGLE_ACT_DROP |
|
|
ICE_SINGLE_ACT_VALID_BIT;
|
|
break;
|
|
case ICE_FWD_TO_QGRP:
|
|
q_rgn = f_info->qgrp_size > 0 ?
|
|
(u8)ilog2(f_info->qgrp_size) : 0;
|
|
act |= ICE_SINGLE_ACT_TO_Q;
|
|
act |= (f_info->fwd_id.q_id << ICE_SINGLE_ACT_Q_INDEX_S) &
|
|
ICE_SINGLE_ACT_Q_INDEX_M;
|
|
act |= (q_rgn << ICE_SINGLE_ACT_Q_REGION_S) &
|
|
ICE_SINGLE_ACT_Q_REGION_M;
|
|
break;
|
|
default:
|
|
return;
|
|
}
|
|
|
|
if (f_info->lb_en)
|
|
act |= ICE_SINGLE_ACT_LB_ENABLE;
|
|
if (f_info->lan_en)
|
|
act |= ICE_SINGLE_ACT_LAN_ENABLE;
|
|
|
|
switch (f_info->lkup_type) {
|
|
case ICE_SW_LKUP_MAC:
|
|
daddr = f_info->l_data.mac.mac_addr;
|
|
break;
|
|
case ICE_SW_LKUP_VLAN:
|
|
vlan_id = f_info->l_data.vlan.vlan_id;
|
|
if (f_info->fltr_act == ICE_FWD_TO_VSI ||
|
|
f_info->fltr_act == ICE_FWD_TO_VSI_LIST) {
|
|
act |= ICE_SINGLE_ACT_PRUNE;
|
|
act |= ICE_SINGLE_ACT_EGRESS | ICE_SINGLE_ACT_INGRESS;
|
|
}
|
|
break;
|
|
case ICE_SW_LKUP_ETHERTYPE_MAC:
|
|
daddr = f_info->l_data.ethertype_mac.mac_addr;
|
|
/* fall-through */
|
|
case ICE_SW_LKUP_ETHERTYPE:
|
|
off = (__be16 *)ð_hdr[ICE_ETH_ETHTYPE_OFFSET];
|
|
*off = cpu_to_be16(f_info->l_data.ethertype_mac.ethertype);
|
|
break;
|
|
case ICE_SW_LKUP_MAC_VLAN:
|
|
daddr = f_info->l_data.mac_vlan.mac_addr;
|
|
vlan_id = f_info->l_data.mac_vlan.vlan_id;
|
|
break;
|
|
case ICE_SW_LKUP_PROMISC_VLAN:
|
|
vlan_id = f_info->l_data.mac_vlan.vlan_id;
|
|
/* fall-through */
|
|
case ICE_SW_LKUP_PROMISC:
|
|
daddr = f_info->l_data.mac_vlan.mac_addr;
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
|
|
s_rule->type = (f_info->flag & ICE_FLTR_RX) ?
|
|
cpu_to_le16(ICE_AQC_SW_RULES_T_LKUP_RX) :
|
|
cpu_to_le16(ICE_AQC_SW_RULES_T_LKUP_TX);
|
|
|
|
/* Recipe set depending on lookup type */
|
|
s_rule->pdata.lkup_tx_rx.recipe_id = cpu_to_le16(f_info->lkup_type);
|
|
s_rule->pdata.lkup_tx_rx.src = cpu_to_le16(f_info->src);
|
|
s_rule->pdata.lkup_tx_rx.act = cpu_to_le32(act);
|
|
|
|
if (daddr)
|
|
ether_addr_copy(ð_hdr[ICE_ETH_DA_OFFSET], daddr);
|
|
|
|
if (!(vlan_id > ICE_MAX_VLAN_ID)) {
|
|
off = (__be16 *)ð_hdr[ICE_ETH_VLAN_TCI_OFFSET];
|
|
*off = cpu_to_be16(vlan_id);
|
|
}
|
|
|
|
/* Create the switch rule with the final dummy Ethernet header */
|
|
if (opc != ice_aqc_opc_update_sw_rules)
|
|
s_rule->pdata.lkup_tx_rx.hdr_len = cpu_to_le16(sizeof(eth_hdr));
|
|
|
|
memcpy(s_rule->pdata.lkup_tx_rx.hdr, eth_hdr, sizeof(eth_hdr));
|
|
}
|
|
|
|
/**
|
|
* ice_add_marker_act
|
|
* @hw: pointer to the hardware structure
|
|
* @m_ent: the management entry for which sw marker needs to be added
|
|
* @sw_marker: sw marker to tag the Rx descriptor with
|
|
* @l_id: large action resource id
|
|
*
|
|
* Create a large action to hold software marker and update the switch rule
|
|
* entry pointed by m_ent with newly created large action
|
|
*/
|
|
static enum ice_status
|
|
ice_add_marker_act(struct ice_hw *hw, struct ice_fltr_mgmt_list_entry *m_ent,
|
|
u16 sw_marker, u16 l_id)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *lg_act, *rx_tx;
|
|
/* For software marker we need 3 large actions
|
|
* 1. FWD action: FWD TO VSI or VSI LIST
|
|
* 2. GENERIC VALUE action to hold the profile id
|
|
* 3. GENERIC VALUE action to hold the software marker id
|
|
*/
|
|
const u16 num_lg_acts = 3;
|
|
enum ice_status status;
|
|
u16 lg_act_size;
|
|
u16 rules_size;
|
|
u16 vsi_info;
|
|
u32 act;
|
|
|
|
if (m_ent->fltr_info.lkup_type != ICE_SW_LKUP_MAC)
|
|
return ICE_ERR_PARAM;
|
|
|
|
/* Create two back-to-back switch rules and submit them to the HW using
|
|
* one memory buffer:
|
|
* 1. Large Action
|
|
* 2. Look up tx rx
|
|
*/
|
|
lg_act_size = (u16)ICE_SW_RULE_LG_ACT_SIZE(num_lg_acts);
|
|
rules_size = lg_act_size + ICE_SW_RULE_RX_TX_ETH_HDR_SIZE;
|
|
lg_act = devm_kzalloc(ice_hw_to_dev(hw), rules_size, GFP_KERNEL);
|
|
if (!lg_act)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
rx_tx = (struct ice_aqc_sw_rules_elem *)((u8 *)lg_act + lg_act_size);
|
|
|
|
/* Fill in the first switch rule i.e. large action */
|
|
lg_act->type = cpu_to_le16(ICE_AQC_SW_RULES_T_LG_ACT);
|
|
lg_act->pdata.lg_act.index = cpu_to_le16(l_id);
|
|
lg_act->pdata.lg_act.size = cpu_to_le16(num_lg_acts);
|
|
|
|
/* First action VSI forwarding or VSI list forwarding depending on how
|
|
* many VSIs
|
|
*/
|
|
vsi_info = (m_ent->vsi_count > 1) ?
|
|
m_ent->fltr_info.fwd_id.vsi_list_id :
|
|
m_ent->fltr_info.fwd_id.vsi_id;
|
|
|
|
act = ICE_LG_ACT_VSI_FORWARDING | ICE_LG_ACT_VALID_BIT;
|
|
act |= (vsi_info << ICE_LG_ACT_VSI_LIST_ID_S) &
|
|
ICE_LG_ACT_VSI_LIST_ID_M;
|
|
if (m_ent->vsi_count > 1)
|
|
act |= ICE_LG_ACT_VSI_LIST;
|
|
lg_act->pdata.lg_act.act[0] = cpu_to_le32(act);
|
|
|
|
/* Second action descriptor type */
|
|
act = ICE_LG_ACT_GENERIC;
|
|
|
|
act |= (1 << ICE_LG_ACT_GENERIC_VALUE_S) & ICE_LG_ACT_GENERIC_VALUE_M;
|
|
lg_act->pdata.lg_act.act[1] = cpu_to_le32(act);
|
|
|
|
act = (ICE_LG_ACT_GENERIC_OFF_RX_DESC_PROF_IDX <<
|
|
ICE_LG_ACT_GENERIC_OFFSET_S) & ICE_LG_ACT_GENERIC_OFFSET_M;
|
|
|
|
/* Third action Marker value */
|
|
act |= ICE_LG_ACT_GENERIC;
|
|
act |= (sw_marker << ICE_LG_ACT_GENERIC_VALUE_S) &
|
|
ICE_LG_ACT_GENERIC_VALUE_M;
|
|
|
|
lg_act->pdata.lg_act.act[2] = cpu_to_le32(act);
|
|
|
|
/* call the fill switch rule to fill the lookup tx rx structure */
|
|
ice_fill_sw_rule(hw, &m_ent->fltr_info, rx_tx,
|
|
ice_aqc_opc_update_sw_rules);
|
|
|
|
/* Update the action to point to the large action id */
|
|
rx_tx->pdata.lkup_tx_rx.act =
|
|
cpu_to_le32(ICE_SINGLE_ACT_PTR |
|
|
((l_id << ICE_SINGLE_ACT_PTR_VAL_S) &
|
|
ICE_SINGLE_ACT_PTR_VAL_M));
|
|
|
|
/* Use the filter rule id of the previously created rule with single
|
|
* act. Once the update happens, hardware will treat this as large
|
|
* action
|
|
*/
|
|
rx_tx->pdata.lkup_tx_rx.index =
|
|
cpu_to_le16(m_ent->fltr_info.fltr_rule_id);
|
|
|
|
status = ice_aq_sw_rules(hw, lg_act, rules_size, 2,
|
|
ice_aqc_opc_update_sw_rules, NULL);
|
|
if (!status) {
|
|
m_ent->lg_act_idx = l_id;
|
|
m_ent->sw_marker_id = sw_marker;
|
|
}
|
|
|
|
devm_kfree(ice_hw_to_dev(hw), lg_act);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_create_vsi_list_map
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_array: array of VSIs to form a VSI list
|
|
* @num_vsi: num VSI in the array
|
|
* @vsi_list_id: VSI list id generated as part of allocate resource
|
|
*
|
|
* Helper function to create a new entry of VSI list id to VSI mapping
|
|
* using the given VSI list id
|
|
*/
|
|
static struct ice_vsi_list_map_info *
|
|
ice_create_vsi_list_map(struct ice_hw *hw, u16 *vsi_array, u16 num_vsi,
|
|
u16 vsi_list_id)
|
|
{
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
struct ice_vsi_list_map_info *v_map;
|
|
int i;
|
|
|
|
v_map = devm_kcalloc(ice_hw_to_dev(hw), 1, sizeof(*v_map), GFP_KERNEL);
|
|
if (!v_map)
|
|
return NULL;
|
|
|
|
v_map->vsi_list_id = vsi_list_id;
|
|
|
|
for (i = 0; i < num_vsi; i++)
|
|
set_bit(vsi_array[i], v_map->vsi_map);
|
|
|
|
list_add(&v_map->list_entry, &sw->vsi_list_map_head);
|
|
return v_map;
|
|
}
|
|
|
|
/**
|
|
* ice_update_vsi_list_rule
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_array: array of VSIs to form a VSI list
|
|
* @num_vsi: num VSI in the array
|
|
* @vsi_list_id: VSI list id generated as part of allocate resource
|
|
* @remove: Boolean value to indicate if this is a remove action
|
|
* @opc: switch rules population command type - pass in the command opcode
|
|
* @lkup_type: lookup type of the filter
|
|
*
|
|
* Call AQ command to add a new switch rule or update existing switch rule
|
|
* using the given VSI list id
|
|
*/
|
|
static enum ice_status
|
|
ice_update_vsi_list_rule(struct ice_hw *hw, u16 *vsi_array, u16 num_vsi,
|
|
u16 vsi_list_id, bool remove, enum ice_adminq_opc opc,
|
|
enum ice_sw_lkup_type lkup_type)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
enum ice_status status;
|
|
u16 s_rule_size;
|
|
u16 type;
|
|
int i;
|
|
|
|
if (!num_vsi)
|
|
return ICE_ERR_PARAM;
|
|
|
|
if (lkup_type == ICE_SW_LKUP_MAC ||
|
|
lkup_type == ICE_SW_LKUP_MAC_VLAN ||
|
|
lkup_type == ICE_SW_LKUP_ETHERTYPE ||
|
|
lkup_type == ICE_SW_LKUP_ETHERTYPE_MAC ||
|
|
lkup_type == ICE_SW_LKUP_PROMISC ||
|
|
lkup_type == ICE_SW_LKUP_PROMISC_VLAN)
|
|
type = remove ? ICE_AQC_SW_RULES_T_VSI_LIST_CLEAR :
|
|
ICE_AQC_SW_RULES_T_VSI_LIST_SET;
|
|
else if (lkup_type == ICE_SW_LKUP_VLAN)
|
|
type = remove ? ICE_AQC_SW_RULES_T_PRUNE_LIST_CLEAR :
|
|
ICE_AQC_SW_RULES_T_PRUNE_LIST_SET;
|
|
else
|
|
return ICE_ERR_PARAM;
|
|
|
|
s_rule_size = (u16)ICE_SW_RULE_VSI_LIST_SIZE(num_vsi);
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
for (i = 0; i < num_vsi; i++)
|
|
s_rule->pdata.vsi_list.vsi[i] = cpu_to_le16(vsi_array[i]);
|
|
|
|
s_rule->type = cpu_to_le16(type);
|
|
s_rule->pdata.vsi_list.number_vsi = cpu_to_le16(num_vsi);
|
|
s_rule->pdata.vsi_list.index = cpu_to_le16(vsi_list_id);
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule, s_rule_size, 1, opc, NULL);
|
|
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_create_vsi_list_rule - Creates and populates a VSI list rule
|
|
* @hw: pointer to the hw struct
|
|
* @vsi_array: array of VSIs to form a VSI list
|
|
* @num_vsi: number of VSIs in the array
|
|
* @vsi_list_id: stores the ID of the VSI list to be created
|
|
* @lkup_type: switch rule filter's lookup type
|
|
*/
|
|
static enum ice_status
|
|
ice_create_vsi_list_rule(struct ice_hw *hw, u16 *vsi_array, u16 num_vsi,
|
|
u16 *vsi_list_id, enum ice_sw_lkup_type lkup_type)
|
|
{
|
|
enum ice_status status;
|
|
int i;
|
|
|
|
for (i = 0; i < num_vsi; i++)
|
|
if (vsi_array[i] >= ICE_MAX_VSI)
|
|
return ICE_ERR_OUT_OF_RANGE;
|
|
|
|
status = ice_aq_alloc_free_vsi_list(hw, vsi_list_id, lkup_type,
|
|
ice_aqc_opc_alloc_res);
|
|
if (status)
|
|
return status;
|
|
|
|
/* Update the newly created VSI list to include the specified VSIs */
|
|
return ice_update_vsi_list_rule(hw, vsi_array, num_vsi, *vsi_list_id,
|
|
false, ice_aqc_opc_add_sw_rules,
|
|
lkup_type);
|
|
}
|
|
|
|
/**
|
|
* ice_create_pkt_fwd_rule
|
|
* @hw: pointer to the hardware structure
|
|
* @f_entry: entry containing packet forwarding information
|
|
*
|
|
* Create switch rule with given filter information and add an entry
|
|
* to the corresponding filter management list to track this switch rule
|
|
* and VSI mapping
|
|
*/
|
|
static enum ice_status
|
|
ice_create_pkt_fwd_rule(struct ice_hw *hw,
|
|
struct ice_fltr_list_entry *f_entry)
|
|
{
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
struct ice_fltr_mgmt_list_entry *fm_entry;
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
enum ice_sw_lkup_type l_type;
|
|
enum ice_status status;
|
|
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw),
|
|
ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
fm_entry = devm_kzalloc(ice_hw_to_dev(hw), sizeof(*fm_entry),
|
|
GFP_KERNEL);
|
|
if (!fm_entry) {
|
|
status = ICE_ERR_NO_MEMORY;
|
|
goto ice_create_pkt_fwd_rule_exit;
|
|
}
|
|
|
|
fm_entry->fltr_info = f_entry->fltr_info;
|
|
|
|
/* Initialize all the fields for the management entry */
|
|
fm_entry->vsi_count = 1;
|
|
fm_entry->lg_act_idx = ICE_INVAL_LG_ACT_INDEX;
|
|
fm_entry->sw_marker_id = ICE_INVAL_SW_MARKER_ID;
|
|
fm_entry->counter_index = ICE_INVAL_COUNTER_ID;
|
|
|
|
ice_fill_sw_rule(hw, &fm_entry->fltr_info, s_rule,
|
|
ice_aqc_opc_add_sw_rules);
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule, ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, 1,
|
|
ice_aqc_opc_add_sw_rules, NULL);
|
|
if (status) {
|
|
devm_kfree(ice_hw_to_dev(hw), fm_entry);
|
|
goto ice_create_pkt_fwd_rule_exit;
|
|
}
|
|
|
|
f_entry->fltr_info.fltr_rule_id =
|
|
le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
|
|
fm_entry->fltr_info.fltr_rule_id =
|
|
le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
|
|
|
|
/* The book keeping entries will get removed when base driver
|
|
* calls remove filter AQ command
|
|
*/
|
|
l_type = fm_entry->fltr_info.lkup_type;
|
|
if (l_type == ICE_SW_LKUP_MAC) {
|
|
mutex_lock(&sw->mac_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->mac_list_head);
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
} else if (l_type == ICE_SW_LKUP_VLAN) {
|
|
mutex_lock(&sw->vlan_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->vlan_list_head);
|
|
mutex_unlock(&sw->vlan_list_lock);
|
|
} else if (l_type == ICE_SW_LKUP_ETHERTYPE ||
|
|
l_type == ICE_SW_LKUP_ETHERTYPE_MAC) {
|
|
mutex_lock(&sw->eth_m_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->eth_m_list_head);
|
|
mutex_unlock(&sw->eth_m_list_lock);
|
|
} else if (l_type == ICE_SW_LKUP_PROMISC ||
|
|
l_type == ICE_SW_LKUP_PROMISC_VLAN) {
|
|
mutex_lock(&sw->promisc_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->promisc_list_head);
|
|
mutex_unlock(&sw->promisc_list_lock);
|
|
} else if (fm_entry->fltr_info.lkup_type == ICE_SW_LKUP_MAC_VLAN) {
|
|
mutex_lock(&sw->mac_vlan_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->mac_vlan_list_head);
|
|
mutex_unlock(&sw->mac_vlan_list_lock);
|
|
} else {
|
|
status = ICE_ERR_NOT_IMPL;
|
|
}
|
|
ice_create_pkt_fwd_rule_exit:
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_update_pkt_fwd_rule
|
|
* @hw: pointer to the hardware structure
|
|
* @rule_id: rule of previously created switch rule to update
|
|
* @vsi_list_id: VSI list id to be updated with
|
|
* @f_info: ice_fltr_info to pull other information for switch rule
|
|
*
|
|
* Call AQ command to update a previously created switch rule with a
|
|
* VSI list id
|
|
*/
|
|
static enum ice_status
|
|
ice_update_pkt_fwd_rule(struct ice_hw *hw, u16 rule_id, u16 vsi_list_id,
|
|
struct ice_fltr_info f_info)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
struct ice_fltr_info tmp_fltr;
|
|
enum ice_status status;
|
|
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw),
|
|
ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
tmp_fltr = f_info;
|
|
tmp_fltr.fltr_act = ICE_FWD_TO_VSI_LIST;
|
|
tmp_fltr.fwd_id.vsi_list_id = vsi_list_id;
|
|
|
|
ice_fill_sw_rule(hw, &tmp_fltr, s_rule,
|
|
ice_aqc_opc_update_sw_rules);
|
|
|
|
s_rule->pdata.lkup_tx_rx.index = cpu_to_le16(rule_id);
|
|
|
|
/* Update switch rule with new rule set to forward VSI list */
|
|
status = ice_aq_sw_rules(hw, s_rule, ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, 1,
|
|
ice_aqc_opc_update_sw_rules, NULL);
|
|
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_handle_vsi_list_mgmt
|
|
* @hw: pointer to the hardware structure
|
|
* @m_entry: pointer to current filter management list entry
|
|
* @cur_fltr: filter information from the book keeping entry
|
|
* @new_fltr: filter information with the new VSI to be added
|
|
*
|
|
* Call AQ command to add or update previously created VSI list with new VSI.
|
|
*
|
|
* Helper function to do book keeping associated with adding filter information
|
|
* The algorithm to do the booking keeping is described below :
|
|
* When a VSI needs to subscribe to a given filter( MAC/VLAN/Ethtype etc.)
|
|
* if only one VSI has been added till now
|
|
* Allocate a new VSI list and add two VSIs
|
|
* to this list using switch rule command
|
|
* Update the previously created switch rule with the
|
|
* newly created VSI list id
|
|
* if a VSI list was previously created
|
|
* Add the new VSI to the previously created VSI list set
|
|
* using the update switch rule command
|
|
*/
|
|
static enum ice_status
|
|
ice_handle_vsi_list_mgmt(struct ice_hw *hw,
|
|
struct ice_fltr_mgmt_list_entry *m_entry,
|
|
struct ice_fltr_info *cur_fltr,
|
|
struct ice_fltr_info *new_fltr)
|
|
{
|
|
enum ice_status status = 0;
|
|
u16 vsi_list_id = 0;
|
|
|
|
if ((cur_fltr->fltr_act == ICE_FWD_TO_Q ||
|
|
cur_fltr->fltr_act == ICE_FWD_TO_QGRP))
|
|
return ICE_ERR_NOT_IMPL;
|
|
|
|
if ((new_fltr->fltr_act == ICE_FWD_TO_Q ||
|
|
new_fltr->fltr_act == ICE_FWD_TO_QGRP) &&
|
|
(cur_fltr->fltr_act == ICE_FWD_TO_VSI ||
|
|
cur_fltr->fltr_act == ICE_FWD_TO_VSI_LIST))
|
|
return ICE_ERR_NOT_IMPL;
|
|
|
|
if (m_entry->vsi_count < 2 && !m_entry->vsi_list_info) {
|
|
/* Only one entry existed in the mapping and it was not already
|
|
* a part of a VSI list. So, create a VSI list with the old and
|
|
* new VSIs.
|
|
*/
|
|
u16 vsi_id_arr[2];
|
|
u16 fltr_rule;
|
|
|
|
/* A rule already exists with the new VSI being added */
|
|
if (cur_fltr->fwd_id.vsi_id == new_fltr->fwd_id.vsi_id)
|
|
return ICE_ERR_ALREADY_EXISTS;
|
|
|
|
vsi_id_arr[0] = cur_fltr->fwd_id.vsi_id;
|
|
vsi_id_arr[1] = new_fltr->fwd_id.vsi_id;
|
|
status = ice_create_vsi_list_rule(hw, &vsi_id_arr[0], 2,
|
|
&vsi_list_id,
|
|
new_fltr->lkup_type);
|
|
if (status)
|
|
return status;
|
|
|
|
fltr_rule = cur_fltr->fltr_rule_id;
|
|
/* Update the previous switch rule of "MAC forward to VSI" to
|
|
* "MAC fwd to VSI list"
|
|
*/
|
|
status = ice_update_pkt_fwd_rule(hw, fltr_rule, vsi_list_id,
|
|
*new_fltr);
|
|
if (status)
|
|
return status;
|
|
|
|
cur_fltr->fwd_id.vsi_list_id = vsi_list_id;
|
|
cur_fltr->fltr_act = ICE_FWD_TO_VSI_LIST;
|
|
m_entry->vsi_list_info =
|
|
ice_create_vsi_list_map(hw, &vsi_id_arr[0], 2,
|
|
vsi_list_id);
|
|
|
|
/* If this entry was large action then the large action needs
|
|
* to be updated to point to FWD to VSI list
|
|
*/
|
|
if (m_entry->sw_marker_id != ICE_INVAL_SW_MARKER_ID)
|
|
status =
|
|
ice_add_marker_act(hw, m_entry,
|
|
m_entry->sw_marker_id,
|
|
m_entry->lg_act_idx);
|
|
} else {
|
|
u16 vsi_id = new_fltr->fwd_id.vsi_id;
|
|
enum ice_adminq_opc opcode;
|
|
|
|
if (!m_entry->vsi_list_info)
|
|
return ICE_ERR_CFG;
|
|
|
|
/* A rule already exists with the new VSI being added */
|
|
if (test_bit(vsi_id, m_entry->vsi_list_info->vsi_map))
|
|
return 0;
|
|
|
|
/* Update the previously created VSI list set with
|
|
* the new VSI id passed in
|
|
*/
|
|
vsi_list_id = cur_fltr->fwd_id.vsi_list_id;
|
|
opcode = ice_aqc_opc_update_sw_rules;
|
|
|
|
status = ice_update_vsi_list_rule(hw, &vsi_id, 1, vsi_list_id,
|
|
false, opcode,
|
|
new_fltr->lkup_type);
|
|
/* update VSI list mapping info with new VSI id */
|
|
if (!status)
|
|
set_bit(vsi_id, m_entry->vsi_list_info->vsi_map);
|
|
}
|
|
if (!status)
|
|
m_entry->vsi_count++;
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_find_mac_entry
|
|
* @hw: pointer to the hardware structure
|
|
* @mac_addr: MAC address to search for
|
|
*
|
|
* Helper function to search for a MAC entry using a given MAC address
|
|
* Returns pointer to the entry if found.
|
|
*/
|
|
static struct ice_fltr_mgmt_list_entry *
|
|
ice_find_mac_entry(struct ice_hw *hw, u8 *mac_addr)
|
|
{
|
|
struct ice_fltr_mgmt_list_entry *m_list_itr, *mac_ret = NULL;
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
|
|
mutex_lock(&sw->mac_list_lock);
|
|
list_for_each_entry(m_list_itr, &sw->mac_list_head, list_entry) {
|
|
u8 *buf = &m_list_itr->fltr_info.l_data.mac.mac_addr[0];
|
|
|
|
if (ether_addr_equal(buf, mac_addr)) {
|
|
mac_ret = m_list_itr;
|
|
break;
|
|
}
|
|
}
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
return mac_ret;
|
|
}
|
|
|
|
/**
|
|
* ice_add_shared_mac - Add one MAC shared filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @f_entry: structure containing MAC forwarding information
|
|
*
|
|
* Adds or updates the book keeping list for the MAC addresses
|
|
*/
|
|
static enum ice_status
|
|
ice_add_shared_mac(struct ice_hw *hw, struct ice_fltr_list_entry *f_entry)
|
|
{
|
|
struct ice_fltr_info *new_fltr, *cur_fltr;
|
|
struct ice_fltr_mgmt_list_entry *m_entry;
|
|
|
|
new_fltr = &f_entry->fltr_info;
|
|
|
|
m_entry = ice_find_mac_entry(hw, &new_fltr->l_data.mac.mac_addr[0]);
|
|
if (!m_entry)
|
|
return ice_create_pkt_fwd_rule(hw, f_entry);
|
|
|
|
cur_fltr = &m_entry->fltr_info;
|
|
|
|
return ice_handle_vsi_list_mgmt(hw, m_entry, cur_fltr, new_fltr);
|
|
}
|
|
|
|
/**
|
|
* ice_add_mac - Add a MAC address based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @m_list: list of MAC addresses and forwarding information
|
|
*
|
|
* IMPORTANT: When the ucast_shared flag is set to false and m_list has
|
|
* multiple unicast addresses, the function assumes that all the
|
|
* addresses are unique in a given add_mac call. It doesn't
|
|
* check for duplicates in this case, removing duplicates from a given
|
|
* list should be taken care of in the caller of this function.
|
|
*/
|
|
enum ice_status
|
|
ice_add_mac(struct ice_hw *hw, struct list_head *m_list)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule, *r_iter;
|
|
struct ice_fltr_list_entry *m_list_itr;
|
|
u16 elem_sent, total_elem_left;
|
|
enum ice_status status = 0;
|
|
u16 num_unicast = 0;
|
|
u16 s_rule_size;
|
|
|
|
if (!m_list || !hw)
|
|
return ICE_ERR_PARAM;
|
|
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
u8 *add = &m_list_itr->fltr_info.l_data.mac.mac_addr[0];
|
|
|
|
if (m_list_itr->fltr_info.lkup_type != ICE_SW_LKUP_MAC)
|
|
return ICE_ERR_PARAM;
|
|
if (is_zero_ether_addr(add))
|
|
return ICE_ERR_PARAM;
|
|
if (is_unicast_ether_addr(add) && !hw->ucast_shared) {
|
|
/* Don't overwrite the unicast address */
|
|
if (ice_find_mac_entry(hw, add))
|
|
return ICE_ERR_ALREADY_EXISTS;
|
|
num_unicast++;
|
|
} else if (is_multicast_ether_addr(add) ||
|
|
(is_unicast_ether_addr(add) && hw->ucast_shared)) {
|
|
status = ice_add_shared_mac(hw, m_list_itr);
|
|
if (status) {
|
|
m_list_itr->status = ICE_FLTR_STATUS_FW_FAIL;
|
|
return status;
|
|
}
|
|
m_list_itr->status = ICE_FLTR_STATUS_FW_SUCCESS;
|
|
}
|
|
}
|
|
|
|
/* Exit if no suitable entries were found for adding bulk switch rule */
|
|
if (!num_unicast)
|
|
return 0;
|
|
|
|
/* Allocate switch rule buffer for the bulk update for unicast */
|
|
s_rule_size = ICE_SW_RULE_RX_TX_ETH_HDR_SIZE;
|
|
s_rule = devm_kcalloc(ice_hw_to_dev(hw), num_unicast, s_rule_size,
|
|
GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
r_iter = s_rule;
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
struct ice_fltr_info *f_info = &m_list_itr->fltr_info;
|
|
u8 *addr = &f_info->l_data.mac.mac_addr[0];
|
|
|
|
if (is_unicast_ether_addr(addr)) {
|
|
ice_fill_sw_rule(hw, &m_list_itr->fltr_info,
|
|
r_iter, ice_aqc_opc_add_sw_rules);
|
|
r_iter = (struct ice_aqc_sw_rules_elem *)
|
|
((u8 *)r_iter + s_rule_size);
|
|
}
|
|
}
|
|
|
|
/* Call AQ bulk switch rule update for all unicast addresses */
|
|
r_iter = s_rule;
|
|
/* Call AQ switch rule in AQ_MAX chunk */
|
|
for (total_elem_left = num_unicast; total_elem_left > 0;
|
|
total_elem_left -= elem_sent) {
|
|
struct ice_aqc_sw_rules_elem *entry = r_iter;
|
|
|
|
elem_sent = min(total_elem_left,
|
|
(u16)(ICE_AQ_MAX_BUF_LEN / s_rule_size));
|
|
status = ice_aq_sw_rules(hw, entry, elem_sent * s_rule_size,
|
|
elem_sent, ice_aqc_opc_add_sw_rules,
|
|
NULL);
|
|
if (status)
|
|
goto ice_add_mac_exit;
|
|
r_iter = (struct ice_aqc_sw_rules_elem *)
|
|
((u8 *)r_iter + (elem_sent * s_rule_size));
|
|
}
|
|
|
|
/* Fill up rule id based on the value returned from FW */
|
|
r_iter = s_rule;
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
struct ice_fltr_info *f_info = &m_list_itr->fltr_info;
|
|
u8 *addr = &f_info->l_data.mac.mac_addr[0];
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
struct ice_fltr_mgmt_list_entry *fm_entry;
|
|
|
|
if (is_unicast_ether_addr(addr)) {
|
|
f_info->fltr_rule_id =
|
|
le16_to_cpu(r_iter->pdata.lkup_tx_rx.index);
|
|
f_info->fltr_act = ICE_FWD_TO_VSI;
|
|
/* Create an entry to track this MAC address */
|
|
fm_entry = devm_kzalloc(ice_hw_to_dev(hw),
|
|
sizeof(*fm_entry), GFP_KERNEL);
|
|
if (!fm_entry) {
|
|
status = ICE_ERR_NO_MEMORY;
|
|
goto ice_add_mac_exit;
|
|
}
|
|
fm_entry->fltr_info = *f_info;
|
|
fm_entry->vsi_count = 1;
|
|
/* The book keeping entries will get removed when
|
|
* base driver calls remove filter AQ command
|
|
*/
|
|
mutex_lock(&sw->mac_list_lock);
|
|
list_add(&fm_entry->list_entry, &sw->mac_list_head);
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
|
|
r_iter = (struct ice_aqc_sw_rules_elem *)
|
|
((u8 *)r_iter + s_rule_size);
|
|
}
|
|
}
|
|
|
|
ice_add_mac_exit:
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_find_vlan_entry
|
|
* @hw: pointer to the hardware structure
|
|
* @vlan_id: VLAN id to search for
|
|
*
|
|
* Helper function to search for a VLAN entry using a given VLAN id
|
|
* Returns pointer to the entry if found.
|
|
*/
|
|
static struct ice_fltr_mgmt_list_entry *
|
|
ice_find_vlan_entry(struct ice_hw *hw, u16 vlan_id)
|
|
{
|
|
struct ice_fltr_mgmt_list_entry *vlan_list_itr, *vlan_ret = NULL;
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
|
|
mutex_lock(&sw->vlan_list_lock);
|
|
list_for_each_entry(vlan_list_itr, &sw->vlan_list_head, list_entry)
|
|
if (vlan_list_itr->fltr_info.l_data.vlan.vlan_id == vlan_id) {
|
|
vlan_ret = vlan_list_itr;
|
|
break;
|
|
}
|
|
|
|
mutex_unlock(&sw->vlan_list_lock);
|
|
return vlan_ret;
|
|
}
|
|
|
|
/**
|
|
* ice_add_vlan_internal - Add one VLAN based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @f_entry: filter entry containing one VLAN information
|
|
*/
|
|
static enum ice_status
|
|
ice_add_vlan_internal(struct ice_hw *hw, struct ice_fltr_list_entry *f_entry)
|
|
{
|
|
struct ice_fltr_info *new_fltr, *cur_fltr;
|
|
struct ice_fltr_mgmt_list_entry *v_list_itr;
|
|
u16 vlan_id;
|
|
|
|
new_fltr = &f_entry->fltr_info;
|
|
/* VLAN id should only be 12 bits */
|
|
if (new_fltr->l_data.vlan.vlan_id > ICE_MAX_VLAN_ID)
|
|
return ICE_ERR_PARAM;
|
|
|
|
vlan_id = new_fltr->l_data.vlan.vlan_id;
|
|
v_list_itr = ice_find_vlan_entry(hw, vlan_id);
|
|
if (!v_list_itr) {
|
|
u16 vsi_id = ICE_VSI_INVAL_ID;
|
|
enum ice_status status;
|
|
u16 vsi_list_id = 0;
|
|
|
|
if (new_fltr->fltr_act == ICE_FWD_TO_VSI) {
|
|
enum ice_sw_lkup_type lkup_type = new_fltr->lkup_type;
|
|
|
|
/* All VLAN pruning rules use a VSI list.
|
|
* Convert the action to forwarding to a VSI list.
|
|
*/
|
|
vsi_id = new_fltr->fwd_id.vsi_id;
|
|
status = ice_create_vsi_list_rule(hw, &vsi_id, 1,
|
|
&vsi_list_id,
|
|
lkup_type);
|
|
if (status)
|
|
return status;
|
|
new_fltr->fltr_act = ICE_FWD_TO_VSI_LIST;
|
|
new_fltr->fwd_id.vsi_list_id = vsi_list_id;
|
|
}
|
|
|
|
status = ice_create_pkt_fwd_rule(hw, f_entry);
|
|
if (!status && vsi_id != ICE_VSI_INVAL_ID) {
|
|
v_list_itr = ice_find_vlan_entry(hw, vlan_id);
|
|
if (!v_list_itr)
|
|
return ICE_ERR_DOES_NOT_EXIST;
|
|
v_list_itr->vsi_list_info =
|
|
ice_create_vsi_list_map(hw, &vsi_id, 1,
|
|
vsi_list_id);
|
|
}
|
|
|
|
return status;
|
|
}
|
|
|
|
cur_fltr = &v_list_itr->fltr_info;
|
|
return ice_handle_vsi_list_mgmt(hw, v_list_itr, cur_fltr, new_fltr);
|
|
}
|
|
|
|
/**
|
|
* ice_add_vlan - Add VLAN based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @v_list: list of VLAN entries and forwarding information
|
|
*/
|
|
enum ice_status
|
|
ice_add_vlan(struct ice_hw *hw, struct list_head *v_list)
|
|
{
|
|
struct ice_fltr_list_entry *v_list_itr;
|
|
|
|
if (!v_list || !hw)
|
|
return ICE_ERR_PARAM;
|
|
|
|
list_for_each_entry(v_list_itr, v_list, list_entry) {
|
|
enum ice_status status;
|
|
|
|
if (v_list_itr->fltr_info.lkup_type != ICE_SW_LKUP_VLAN)
|
|
return ICE_ERR_PARAM;
|
|
|
|
status = ice_add_vlan_internal(hw, v_list_itr);
|
|
if (status) {
|
|
v_list_itr->status = ICE_FLTR_STATUS_FW_FAIL;
|
|
return status;
|
|
}
|
|
v_list_itr->status = ICE_FLTR_STATUS_FW_SUCCESS;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ice_remove_vsi_list_rule
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_list_id: VSI list id generated as part of allocate resource
|
|
* @lkup_type: switch rule filter lookup type
|
|
*/
|
|
static enum ice_status
|
|
ice_remove_vsi_list_rule(struct ice_hw *hw, u16 vsi_list_id,
|
|
enum ice_sw_lkup_type lkup_type)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
enum ice_status status;
|
|
u16 s_rule_size;
|
|
|
|
s_rule_size = (u16)ICE_SW_RULE_VSI_LIST_SIZE(0);
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
s_rule->type = cpu_to_le16(ICE_AQC_SW_RULES_T_VSI_LIST_CLEAR);
|
|
s_rule->pdata.vsi_list.index = cpu_to_le16(vsi_list_id);
|
|
/* FW expects number of VSIs in vsi_list resource to be 0 for clear
|
|
* command. Since memory is zero'ed out during initialization, it's not
|
|
* necessary to explicitly initialize the variable to 0.
|
|
*/
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule, s_rule_size, 1,
|
|
ice_aqc_opc_remove_sw_rules, NULL);
|
|
if (!status)
|
|
/* Free the vsi_list resource that we allocated */
|
|
status = ice_aq_alloc_free_vsi_list(hw, &vsi_list_id, lkup_type,
|
|
ice_aqc_opc_free_res);
|
|
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_handle_rem_vsi_list_mgmt
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_id: ID of the VSI to remove
|
|
* @fm_list_itr: filter management entry for which the VSI list management
|
|
* needs to be done
|
|
*/
|
|
static enum ice_status
|
|
ice_handle_rem_vsi_list_mgmt(struct ice_hw *hw, u16 vsi_id,
|
|
struct ice_fltr_mgmt_list_entry *fm_list_itr)
|
|
{
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
enum ice_status status = 0;
|
|
enum ice_sw_lkup_type lkup_type;
|
|
bool is_last_elem = true;
|
|
bool conv_list = false;
|
|
bool del_list = false;
|
|
u16 vsi_list_id;
|
|
|
|
lkup_type = fm_list_itr->fltr_info.lkup_type;
|
|
vsi_list_id = fm_list_itr->fltr_info.fwd_id.vsi_list_id;
|
|
|
|
if (fm_list_itr->vsi_count > 1) {
|
|
status = ice_update_vsi_list_rule(hw, &vsi_id, 1, vsi_list_id,
|
|
true,
|
|
ice_aqc_opc_update_sw_rules,
|
|
lkup_type);
|
|
if (status)
|
|
return status;
|
|
fm_list_itr->vsi_count--;
|
|
is_last_elem = false;
|
|
clear_bit(vsi_id, fm_list_itr->vsi_list_info->vsi_map);
|
|
}
|
|
|
|
/* For non-VLAN rules that forward packets to a VSI list, convert them
|
|
* to forwarding packets to a VSI if there is only one VSI left in the
|
|
* list. Unused lists are then removed.
|
|
* VLAN rules need to use VSI lists even with only one VSI.
|
|
*/
|
|
if (fm_list_itr->fltr_info.fltr_act == ICE_FWD_TO_VSI_LIST) {
|
|
if (lkup_type == ICE_SW_LKUP_VLAN) {
|
|
del_list = is_last_elem;
|
|
} else if (fm_list_itr->vsi_count == 1) {
|
|
conv_list = true;
|
|
del_list = true;
|
|
}
|
|
}
|
|
|
|
if (del_list) {
|
|
/* Remove the VSI list since it is no longer used */
|
|
struct ice_vsi_list_map_info *vsi_list_info =
|
|
fm_list_itr->vsi_list_info;
|
|
|
|
status = ice_remove_vsi_list_rule(hw, vsi_list_id, lkup_type);
|
|
if (status)
|
|
return status;
|
|
|
|
if (conv_list) {
|
|
u16 rem_vsi_id;
|
|
|
|
rem_vsi_id = find_first_bit(vsi_list_info->vsi_map,
|
|
ICE_MAX_VSI);
|
|
|
|
/* Error out when the expected last element is not in
|
|
* the VSI list map
|
|
*/
|
|
if (rem_vsi_id == ICE_MAX_VSI)
|
|
return ICE_ERR_OUT_OF_RANGE;
|
|
|
|
/* Change the list entry action from VSI_LIST to VSI */
|
|
fm_list_itr->fltr_info.fltr_act = ICE_FWD_TO_VSI;
|
|
fm_list_itr->fltr_info.fwd_id.vsi_id = rem_vsi_id;
|
|
}
|
|
|
|
list_del(&vsi_list_info->list_entry);
|
|
devm_kfree(ice_hw_to_dev(hw), vsi_list_info);
|
|
fm_list_itr->vsi_list_info = NULL;
|
|
}
|
|
|
|
if (conv_list) {
|
|
/* Convert the rule's forward action to forwarding packets to
|
|
* a VSI
|
|
*/
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw),
|
|
ICE_SW_RULE_RX_TX_ETH_HDR_SIZE,
|
|
GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
ice_fill_sw_rule(hw, &fm_list_itr->fltr_info, s_rule,
|
|
ice_aqc_opc_update_sw_rules);
|
|
|
|
s_rule->pdata.lkup_tx_rx.index =
|
|
cpu_to_le16(fm_list_itr->fltr_info.fltr_rule_id);
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule,
|
|
ICE_SW_RULE_RX_TX_ETH_HDR_SIZE, 1,
|
|
ice_aqc_opc_update_sw_rules, NULL);
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
if (status)
|
|
return status;
|
|
}
|
|
|
|
if (is_last_elem) {
|
|
/* Remove the lookup rule */
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw),
|
|
ICE_SW_RULE_RX_TX_NO_HDR_SIZE,
|
|
GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
ice_fill_sw_rule(hw, &fm_list_itr->fltr_info, s_rule,
|
|
ice_aqc_opc_remove_sw_rules);
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule,
|
|
ICE_SW_RULE_RX_TX_NO_HDR_SIZE, 1,
|
|
ice_aqc_opc_remove_sw_rules, NULL);
|
|
if (status)
|
|
return status;
|
|
|
|
/* Remove a book keeping entry from the MAC address list */
|
|
mutex_lock(&sw->mac_list_lock);
|
|
list_del(&fm_list_itr->list_entry);
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
devm_kfree(ice_hw_to_dev(hw), fm_list_itr);
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_remove_mac_entry
|
|
* @hw: pointer to the hardware structure
|
|
* @f_entry: structure containing MAC forwarding information
|
|
*/
|
|
static enum ice_status
|
|
ice_remove_mac_entry(struct ice_hw *hw, struct ice_fltr_list_entry *f_entry)
|
|
{
|
|
struct ice_fltr_mgmt_list_entry *m_entry;
|
|
u16 vsi_id;
|
|
u8 *add;
|
|
|
|
add = &f_entry->fltr_info.l_data.mac.mac_addr[0];
|
|
|
|
m_entry = ice_find_mac_entry(hw, add);
|
|
if (!m_entry)
|
|
return ICE_ERR_PARAM;
|
|
|
|
vsi_id = f_entry->fltr_info.fwd_id.vsi_id;
|
|
return ice_handle_rem_vsi_list_mgmt(hw, vsi_id, m_entry);
|
|
}
|
|
|
|
/**
|
|
* ice_remove_mac - remove a MAC address based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @m_list: list of MAC addresses and forwarding information
|
|
*
|
|
* This function removes either a MAC filter rule or a specific VSI from a
|
|
* VSI list for a multicast MAC address.
|
|
*
|
|
* Returns ICE_ERR_DOES_NOT_EXIST if a given entry was not added by
|
|
* ice_add_mac. Caller should be aware that this call will only work if all
|
|
* the entries passed into m_list were added previously. It will not attempt to
|
|
* do a partial remove of entries that were found.
|
|
*/
|
|
enum ice_status
|
|
ice_remove_mac(struct ice_hw *hw, struct list_head *m_list)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule, *r_iter;
|
|
u8 s_rule_size = ICE_SW_RULE_RX_TX_NO_HDR_SIZE;
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
struct ice_fltr_mgmt_list_entry *m_entry;
|
|
struct ice_fltr_list_entry *m_list_itr;
|
|
u16 elem_sent, total_elem_left;
|
|
enum ice_status status = 0;
|
|
u16 num_unicast = 0;
|
|
|
|
if (!m_list)
|
|
return ICE_ERR_PARAM;
|
|
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
u8 *addr = m_list_itr->fltr_info.l_data.mac.mac_addr;
|
|
|
|
if (is_unicast_ether_addr(addr) && !hw->ucast_shared)
|
|
num_unicast++;
|
|
else if (is_multicast_ether_addr(addr) ||
|
|
(is_unicast_ether_addr(addr) && hw->ucast_shared))
|
|
ice_remove_mac_entry(hw, m_list_itr);
|
|
}
|
|
|
|
/* Exit if no unicast addresses found. Multicast switch rules
|
|
* were added individually
|
|
*/
|
|
if (!num_unicast)
|
|
return 0;
|
|
|
|
/* Allocate switch rule buffer for the bulk update for unicast */
|
|
s_rule = devm_kcalloc(ice_hw_to_dev(hw), num_unicast, s_rule_size,
|
|
GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
r_iter = s_rule;
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
u8 *addr = m_list_itr->fltr_info.l_data.mac.mac_addr;
|
|
|
|
if (is_unicast_ether_addr(addr)) {
|
|
m_entry = ice_find_mac_entry(hw, addr);
|
|
if (!m_entry) {
|
|
status = ICE_ERR_DOES_NOT_EXIST;
|
|
goto ice_remove_mac_exit;
|
|
}
|
|
|
|
ice_fill_sw_rule(hw, &m_entry->fltr_info,
|
|
r_iter, ice_aqc_opc_remove_sw_rules);
|
|
r_iter = (struct ice_aqc_sw_rules_elem *)
|
|
((u8 *)r_iter + s_rule_size);
|
|
}
|
|
}
|
|
|
|
/* Call AQ bulk switch rule update for all unicast addresses */
|
|
r_iter = s_rule;
|
|
/* Call AQ switch rule in AQ_MAX chunk */
|
|
for (total_elem_left = num_unicast; total_elem_left > 0;
|
|
total_elem_left -= elem_sent) {
|
|
struct ice_aqc_sw_rules_elem *entry = r_iter;
|
|
|
|
elem_sent = min(total_elem_left,
|
|
(u16)(ICE_AQ_MAX_BUF_LEN / s_rule_size));
|
|
status = ice_aq_sw_rules(hw, entry, elem_sent * s_rule_size,
|
|
elem_sent, ice_aqc_opc_remove_sw_rules,
|
|
NULL);
|
|
if (status)
|
|
break;
|
|
r_iter = (struct ice_aqc_sw_rules_elem *)
|
|
((u8 *)r_iter + s_rule_size);
|
|
}
|
|
|
|
list_for_each_entry(m_list_itr, m_list, list_entry) {
|
|
u8 *addr = m_list_itr->fltr_info.l_data.mac.mac_addr;
|
|
|
|
if (is_unicast_ether_addr(addr)) {
|
|
m_entry = ice_find_mac_entry(hw, addr);
|
|
if (!m_entry)
|
|
return ICE_ERR_OUT_OF_RANGE;
|
|
mutex_lock(&sw->mac_list_lock);
|
|
list_del(&m_entry->list_entry);
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
devm_kfree(ice_hw_to_dev(hw), m_entry);
|
|
}
|
|
}
|
|
|
|
ice_remove_mac_exit:
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_cfg_dflt_vsi - add filter rule to set/unset given VSI as default
|
|
* VSI for the switch (represented by swid)
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_id: number of VSI to set as default
|
|
* @set: true to add the above mentioned switch rule, false to remove it
|
|
* @direction: ICE_FLTR_RX or ICE_FLTR_TX
|
|
*/
|
|
enum ice_status
|
|
ice_cfg_dflt_vsi(struct ice_hw *hw, u16 vsi_id, bool set, u8 direction)
|
|
{
|
|
struct ice_aqc_sw_rules_elem *s_rule;
|
|
struct ice_fltr_info f_info;
|
|
enum ice_adminq_opc opcode;
|
|
enum ice_status status;
|
|
u16 s_rule_size;
|
|
|
|
s_rule_size = set ? ICE_SW_RULE_RX_TX_ETH_HDR_SIZE :
|
|
ICE_SW_RULE_RX_TX_NO_HDR_SIZE;
|
|
s_rule = devm_kzalloc(ice_hw_to_dev(hw), s_rule_size, GFP_KERNEL);
|
|
if (!s_rule)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
memset(&f_info, 0, sizeof(f_info));
|
|
|
|
f_info.lkup_type = ICE_SW_LKUP_DFLT;
|
|
f_info.flag = direction;
|
|
f_info.fltr_act = ICE_FWD_TO_VSI;
|
|
f_info.fwd_id.vsi_id = vsi_id;
|
|
|
|
if (f_info.flag & ICE_FLTR_RX) {
|
|
f_info.src = hw->port_info->lport;
|
|
if (!set)
|
|
f_info.fltr_rule_id =
|
|
hw->port_info->dflt_rx_vsi_rule_id;
|
|
} else if (f_info.flag & ICE_FLTR_TX) {
|
|
f_info.src = vsi_id;
|
|
if (!set)
|
|
f_info.fltr_rule_id =
|
|
hw->port_info->dflt_tx_vsi_rule_id;
|
|
}
|
|
|
|
if (set)
|
|
opcode = ice_aqc_opc_add_sw_rules;
|
|
else
|
|
opcode = ice_aqc_opc_remove_sw_rules;
|
|
|
|
ice_fill_sw_rule(hw, &f_info, s_rule, opcode);
|
|
|
|
status = ice_aq_sw_rules(hw, s_rule, s_rule_size, 1, opcode, NULL);
|
|
if (status || !(f_info.flag & ICE_FLTR_TX_RX))
|
|
goto out;
|
|
if (set) {
|
|
u16 index = le16_to_cpu(s_rule->pdata.lkup_tx_rx.index);
|
|
|
|
if (f_info.flag & ICE_FLTR_TX) {
|
|
hw->port_info->dflt_tx_vsi_num = vsi_id;
|
|
hw->port_info->dflt_tx_vsi_rule_id = index;
|
|
} else if (f_info.flag & ICE_FLTR_RX) {
|
|
hw->port_info->dflt_rx_vsi_num = vsi_id;
|
|
hw->port_info->dflt_rx_vsi_rule_id = index;
|
|
}
|
|
} else {
|
|
if (f_info.flag & ICE_FLTR_TX) {
|
|
hw->port_info->dflt_tx_vsi_num = ICE_DFLT_VSI_INVAL;
|
|
hw->port_info->dflt_tx_vsi_rule_id = ICE_INVAL_ACT;
|
|
} else if (f_info.flag & ICE_FLTR_RX) {
|
|
hw->port_info->dflt_rx_vsi_num = ICE_DFLT_VSI_INVAL;
|
|
hw->port_info->dflt_rx_vsi_rule_id = ICE_INVAL_ACT;
|
|
}
|
|
}
|
|
|
|
out:
|
|
devm_kfree(ice_hw_to_dev(hw), s_rule);
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_remove_vlan_internal - Remove one VLAN based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @f_entry: filter entry containing one VLAN information
|
|
*/
|
|
static enum ice_status
|
|
ice_remove_vlan_internal(struct ice_hw *hw,
|
|
struct ice_fltr_list_entry *f_entry)
|
|
{
|
|
struct ice_fltr_info *new_fltr;
|
|
struct ice_fltr_mgmt_list_entry *v_list_elem;
|
|
u16 vsi_id;
|
|
|
|
new_fltr = &f_entry->fltr_info;
|
|
|
|
v_list_elem = ice_find_vlan_entry(hw, new_fltr->l_data.vlan.vlan_id);
|
|
if (!v_list_elem)
|
|
return ICE_ERR_PARAM;
|
|
|
|
vsi_id = f_entry->fltr_info.fwd_id.vsi_id;
|
|
return ice_handle_rem_vsi_list_mgmt(hw, vsi_id, v_list_elem);
|
|
}
|
|
|
|
/**
|
|
* ice_remove_vlan - Remove VLAN based filter rule
|
|
* @hw: pointer to the hardware structure
|
|
* @v_list: list of VLAN entries and forwarding information
|
|
*/
|
|
enum ice_status
|
|
ice_remove_vlan(struct ice_hw *hw, struct list_head *v_list)
|
|
{
|
|
struct ice_fltr_list_entry *v_list_itr;
|
|
enum ice_status status = 0;
|
|
|
|
if (!v_list || !hw)
|
|
return ICE_ERR_PARAM;
|
|
|
|
list_for_each_entry(v_list_itr, v_list, list_entry) {
|
|
status = ice_remove_vlan_internal(hw, v_list_itr);
|
|
if (status) {
|
|
v_list_itr->status = ICE_FLTR_STATUS_FW_FAIL;
|
|
return status;
|
|
}
|
|
v_list_itr->status = ICE_FLTR_STATUS_FW_SUCCESS;
|
|
}
|
|
return status;
|
|
}
|
|
|
|
/**
|
|
* ice_add_to_vsi_fltr_list - Add VSI filters to the list
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_id: ID of VSI to remove filters from
|
|
* @lkup_list_head: pointer to the list that has certain lookup type filters
|
|
* @vsi_list_head: pointer to the list pertaining to VSI with vsi_id
|
|
*/
|
|
static enum ice_status
|
|
ice_add_to_vsi_fltr_list(struct ice_hw *hw, u16 vsi_id,
|
|
struct list_head *lkup_list_head,
|
|
struct list_head *vsi_list_head)
|
|
{
|
|
struct ice_fltr_mgmt_list_entry *fm_entry;
|
|
|
|
/* check to make sure VSI id is valid and within boundary */
|
|
if (vsi_id >=
|
|
(sizeof(fm_entry->vsi_list_info->vsi_map) * BITS_PER_BYTE - 1))
|
|
return ICE_ERR_PARAM;
|
|
|
|
list_for_each_entry(fm_entry, lkup_list_head, list_entry) {
|
|
struct ice_fltr_info *fi;
|
|
|
|
fi = &fm_entry->fltr_info;
|
|
if ((fi->fltr_act == ICE_FWD_TO_VSI &&
|
|
fi->fwd_id.vsi_id == vsi_id) ||
|
|
(fi->fltr_act == ICE_FWD_TO_VSI_LIST &&
|
|
(test_bit(vsi_id, fm_entry->vsi_list_info->vsi_map)))) {
|
|
struct ice_fltr_list_entry *tmp;
|
|
|
|
/* this memory is freed up in the caller function
|
|
* ice_remove_vsi_lkup_fltr() once filters for
|
|
* this VSI are removed
|
|
*/
|
|
tmp = devm_kzalloc(ice_hw_to_dev(hw), sizeof(*tmp),
|
|
GFP_KERNEL);
|
|
if (!tmp)
|
|
return ICE_ERR_NO_MEMORY;
|
|
|
|
memcpy(&tmp->fltr_info, fi, sizeof(*fi));
|
|
|
|
/* Expected below fields to be set to ICE_FWD_TO_VSI and
|
|
* the particular VSI id since we are only removing this
|
|
* one VSI
|
|
*/
|
|
if (fi->fltr_act == ICE_FWD_TO_VSI_LIST) {
|
|
tmp->fltr_info.fltr_act = ICE_FWD_TO_VSI;
|
|
tmp->fltr_info.fwd_id.vsi_id = vsi_id;
|
|
}
|
|
|
|
list_add(&tmp->list_entry, vsi_list_head);
|
|
}
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
/**
|
|
* ice_remove_vsi_lkup_fltr - Remove lookup type filters for a VSI
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_id: ID of VSI to remove filters from
|
|
* @lkup: switch rule filter lookup type
|
|
*/
|
|
static void
|
|
ice_remove_vsi_lkup_fltr(struct ice_hw *hw, u16 vsi_id,
|
|
enum ice_sw_lkup_type lkup)
|
|
{
|
|
struct ice_switch_info *sw = hw->switch_info;
|
|
struct ice_fltr_list_entry *fm_entry;
|
|
struct list_head remove_list_head;
|
|
struct ice_fltr_list_entry *tmp;
|
|
enum ice_status status;
|
|
|
|
INIT_LIST_HEAD(&remove_list_head);
|
|
switch (lkup) {
|
|
case ICE_SW_LKUP_MAC:
|
|
mutex_lock(&sw->mac_list_lock);
|
|
status = ice_add_to_vsi_fltr_list(hw, vsi_id,
|
|
&sw->mac_list_head,
|
|
&remove_list_head);
|
|
mutex_unlock(&sw->mac_list_lock);
|
|
if (!status) {
|
|
ice_remove_mac(hw, &remove_list_head);
|
|
goto free_fltr_list;
|
|
}
|
|
break;
|
|
case ICE_SW_LKUP_VLAN:
|
|
mutex_lock(&sw->vlan_list_lock);
|
|
status = ice_add_to_vsi_fltr_list(hw, vsi_id,
|
|
&sw->vlan_list_head,
|
|
&remove_list_head);
|
|
mutex_unlock(&sw->vlan_list_lock);
|
|
if (!status) {
|
|
ice_remove_vlan(hw, &remove_list_head);
|
|
goto free_fltr_list;
|
|
}
|
|
break;
|
|
case ICE_SW_LKUP_MAC_VLAN:
|
|
case ICE_SW_LKUP_ETHERTYPE:
|
|
case ICE_SW_LKUP_ETHERTYPE_MAC:
|
|
case ICE_SW_LKUP_PROMISC:
|
|
case ICE_SW_LKUP_PROMISC_VLAN:
|
|
case ICE_SW_LKUP_DFLT:
|
|
ice_debug(hw, ICE_DBG_SW,
|
|
"Remove filters for this lookup type hasn't been implemented yet\n");
|
|
break;
|
|
}
|
|
|
|
return;
|
|
free_fltr_list:
|
|
list_for_each_entry_safe(fm_entry, tmp, &remove_list_head, list_entry) {
|
|
list_del(&fm_entry->list_entry);
|
|
devm_kfree(ice_hw_to_dev(hw), fm_entry);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* ice_remove_vsi_fltr - Remove all filters for a VSI
|
|
* @hw: pointer to the hardware structure
|
|
* @vsi_id: ID of VSI to remove filters from
|
|
*/
|
|
void ice_remove_vsi_fltr(struct ice_hw *hw, u16 vsi_id)
|
|
{
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_MAC);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_MAC_VLAN);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_PROMISC);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_VLAN);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_DFLT);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_ETHERTYPE);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_ETHERTYPE_MAC);
|
|
ice_remove_vsi_lkup_fltr(hw, vsi_id, ICE_SW_LKUP_PROMISC_VLAN);
|
|
}
|