// SPDX-License-Identifier: GPL-2.0
/* Copyright (C) 2018-2020, Intel Corporation. */

#include "ice.h"
#include "ice_fltr.h"

/**
 * ice_fltr_free_list - free filter lists helper
 * @dev: pointer to the device struct
 * @h: pointer to the list head to be freed
 *
 * Helper function to free filter lists previously created using
 * ice_fltr_add_mac_to_list
 */
void ice_fltr_free_list(struct device *dev, struct list_head *h)
{
        struct ice_fltr_list_entry *e, *tmp;

        list_for_each_entry_safe(e, tmp, h, list_entry) {
                list_del(&e->list_entry);
                devm_kfree(dev, e);
        }
}

/**
 * ice_fltr_add_entry_to_list - allocate and add filter entry to list
 * @dev: pointer to device needed by alloc function
 * @info: filter info struct that gets added to the passed in list
 * @list: pointer to the list which contains MAC filters entry
 */
static int
ice_fltr_add_entry_to_list(struct device *dev, struct ice_fltr_info *info,
                           struct list_head *list)
{
        struct ice_fltr_list_entry *entry;

        entry = devm_kzalloc(dev, sizeof(*entry), GFP_ATOMIC);
        if (!entry)
                return -ENOMEM;

        entry->fltr_info = *info;

        INIT_LIST_HEAD(&entry->list_entry);
        list_add(&entry->list_entry, list);

        return 0;
}

/**
 * ice_fltr_add_mac_list - add list of MAC filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
enum ice_status
ice_fltr_add_mac_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_add_mac(&vsi->back->hw, list);
}

/**
 * ice_fltr_remove_mac_list - remove list of MAC filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
enum ice_status
ice_fltr_remove_mac_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_remove_mac(&vsi->back->hw, list);
}

/**
 * ice_fltr_add_vlan_list - add list of VLAN filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
static enum ice_status
ice_fltr_add_vlan_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_add_vlan(&vsi->back->hw, list);
}

/**
 * ice_fltr_remove_vlan_list - remove list of VLAN filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
static enum ice_status
ice_fltr_remove_vlan_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_remove_vlan(&vsi->back->hw, list);
}

/**
 * ice_fltr_add_eth_list - add list of ethertype filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
static enum ice_status
ice_fltr_add_eth_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_add_eth_mac(&vsi->back->hw, list);
}

/**
 * ice_fltr_remove_eth_list - remove list of ethertype filters
 * @vsi: pointer to VSI struct
 * @list: list of filters
 */
static enum ice_status
ice_fltr_remove_eth_list(struct ice_vsi *vsi, struct list_head *list)
{
        return ice_remove_eth_mac(&vsi->back->hw, list);
}

/**
 * ice_fltr_remove_all - remove all filters associated with VSI
 * @vsi: pointer to VSI struct
 */
void ice_fltr_remove_all(struct ice_vsi *vsi)
{
        ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
}

/**
 * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
 * @vsi: pointer to VSI struct
 * @list: list to add filter info to
 * @mac: MAC address to add
 * @action: filter action
 */
int
ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
                         const u8 *mac, enum ice_sw_fwd_act_type action)
{
        struct ice_fltr_info info = { 0 };

        info.flag = ICE_FLTR_TX;
        info.src_id = ICE_SRC_ID_VSI;
        info.lkup_type = ICE_SW_LKUP_MAC;
        info.fltr_act = action;
        info.vsi_handle = vsi->idx;

        ether_addr_copy(info.l_data.mac.mac_addr, mac);

        return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
                                          list);
}

/**
 * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
 * @vsi: pointer to VSI struct
 * @list: list to add filter info to
 * @vlan_id: VLAN ID to add
 * @action: filter action
 */
static int
ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
                          u16 vlan_id, enum ice_sw_fwd_act_type action)
{
        struct ice_fltr_info info = { 0 };

        info.flag = ICE_FLTR_TX;
        info.src_id = ICE_SRC_ID_VSI;
        info.lkup_type = ICE_SW_LKUP_VLAN;
        info.fltr_act = action;
        info.vsi_handle = vsi->idx;
        info.l_data.vlan.vlan_id = vlan_id;

        return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
                                          list);
}

/**
 * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
 * @vsi: pointer to VSI struct
 * @list: list to add filter info to
 * @ethertype: ethertype of packet that matches filter
 * @flag: filter direction, Tx or Rx
 * @action: filter action
 */
static int
ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
                         u16 ethertype, u16 flag,
                         enum ice_sw_fwd_act_type action)
{
        struct ice_fltr_info info = { 0 };

        info.flag = flag;
        info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
        info.fltr_act = action;
        info.vsi_handle = vsi->idx;
        info.l_data.ethertype_mac.ethertype = ethertype;

        if (flag == ICE_FLTR_TX)
                info.src_id = ICE_SRC_ID_VSI;
        else
                info.src_id = ICE_SRC_ID_LPORT;

        return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
                                          list);
}

/**
 * ice_fltr_prepare_mac - add or remove MAC rule
 * @vsi: pointer to VSI struct
 * @mac: MAC address to add
 * @action: action to be performed on filter match
 * @mac_action: pointer to add or remove MAC function
 */
static enum ice_status
ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
                     enum ice_sw_fwd_act_type action,
                     enum ice_status (*mac_action)(struct ice_vsi *,
                                                   struct list_head *))
{
        enum ice_status result;
        LIST_HEAD(tmp_list);

        if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
                ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
                return ICE_ERR_NO_MEMORY;
        }

        result = mac_action(vsi, &tmp_list);
        ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
        return result;
}

/**
 * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
 * @vsi: pointer to VSI struct
 * @mac: MAC address to add
 * @action: action to be performed on filter match
 * @mac_action: pointer to add or remove MAC function
 */
static enum ice_status
ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
                                   enum ice_sw_fwd_act_type action,
                                   enum ice_status(*mac_action)
                                   (struct ice_vsi *, struct list_head *))
{
        u8 broadcast[ETH_ALEN];
        enum ice_status result;
        LIST_HEAD(tmp_list);

        eth_broadcast_addr(broadcast);
        if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
            ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
                ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
                return ICE_ERR_NO_MEMORY;
        }

        result = mac_action(vsi, &tmp_list);
        ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
        return result;
}

/**
 * ice_fltr_prepare_vlan - add or remove VLAN filter
 * @vsi: pointer to VSI struct
 * @vlan_id: VLAN ID to add
 * @action: action to be performed on filter match
 * @vlan_action: pointer to add or remove VLAN function
 */
static enum ice_status
ice_fltr_prepare_vlan(struct ice_vsi *vsi, u16 vlan_id,
                      enum ice_sw_fwd_act_type action,
                      enum ice_status (*vlan_action)(struct ice_vsi *,
                                                     struct list_head *))
{
        enum ice_status result;
        LIST_HEAD(tmp_list);

        if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan_id, action))
                return ICE_ERR_NO_MEMORY;

        result = vlan_action(vsi, &tmp_list);
        ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
        return result;
}

/**
 * ice_fltr_prepare_eth - add or remove ethertype filter
 * @vsi: pointer to VSI struct
 * @ethertype: ethertype of packet to be filtered
 * @flag: direction of packet, Tx or Rx
 * @action: action to be performed on filter match
 * @eth_action: pointer to add or remove ethertype function
 */
static enum ice_status
ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
                     enum ice_sw_fwd_act_type action,
                     enum ice_status (*eth_action)(struct ice_vsi *,
                                                   struct list_head *))
{
        enum ice_status result;
        LIST_HEAD(tmp_list);

        if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
                return ICE_ERR_NO_MEMORY;

        result = eth_action(vsi, &tmp_list);
        ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
        return result;
}

/**
 * ice_fltr_add_mac - add single MAC filter
 * @vsi: pointer to VSI struct
 * @mac: MAC to add
 * @action: action to be performed on filter match
 */
enum ice_status ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
                                 enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
}

/**
 * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
 * @vsi: pointer to VSI struct
 * @mac: MAC to add
 * @action: action to be performed on filter match
 */
enum ice_status
ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
                               enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
                                                  ice_fltr_add_mac_list);
}

/**
 * ice_fltr_remove_mac - remove MAC filter
 * @vsi: pointer to VSI struct
 * @mac: filter MAC to remove
 * @action: action to remove
 */
enum ice_status ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
                                    enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
}

/**
 * ice_fltr_add_vlan - add single VLAN filter
 * @vsi: pointer to VSI struct
 * @vlan_id: VLAN ID to add
 * @action: action to be performed on filter match
 */
enum ice_status ice_fltr_add_vlan(struct ice_vsi *vsi, u16 vlan_id,
                                  enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_vlan(vsi, vlan_id, action,
                                     ice_fltr_add_vlan_list);
}

/**
 * ice_fltr_remove_vlan - remove VLAN filter
 * @vsi: pointer to VSI struct
 * @vlan_id: filter VLAN to remove
 * @action: action to remove
 */
enum ice_status ice_fltr_remove_vlan(struct ice_vsi *vsi, u16 vlan_id,
                                     enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_vlan(vsi, vlan_id, action,
                                     ice_fltr_remove_vlan_list);
}

/**
 * ice_fltr_add_eth - add specyfic ethertype filter
 * @vsi: pointer to VSI struct
 * @ethertype: ethertype of filter
 * @flag: direction of packet to be filtered, Tx or Rx
 * @action: action to be performed on filter match
 */
enum ice_status ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
                                 enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
                                    ice_fltr_add_eth_list);
}

/**
 * ice_fltr_remove_eth - remove ethertype filter
 * @vsi: pointer to VSI struct
 * @ethertype: ethertype of filter
 * @flag: direction of filter
 * @action: action to remove
 */
enum ice_status ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype,
                                    u16 flag, enum ice_sw_fwd_act_type action)
{
        return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
                                    ice_fltr_remove_eth_list);
}