drivers/net/ethernet/intel/ice/ice_fltr.c

   1 // SPDX-License-Identifier: GPL-2.0
   2 /* Copyright (C) 2018-2020, Intel Corporation. */
   3
   4 #include "ice.h"
   5 #include "ice_fltr.h"
   6
   7 /**
   8  * ice_fltr_free_list - free filter lists helper
   9  * @dev: pointer to the device struct
  10  * @h: pointer to the list head to be freed
  11  *
  12  * Helper function to free filter lists previously created using
  13  * ice_fltr_add_mac_to_list
  14  */
  15 void ice_fltr_free_list(struct device *dev, struct list_head *h)
  16 {
  17         struct ice_fltr_list_entry *e, *tmp;
  18
  19         list_for_each_entry_safe(e, tmp, h, list_entry) {
  20                 list_del(&e->list_entry);
  21                 devm_kfree(dev, e);
  22         }
  23 }
  24
  25 /**
  26  * ice_fltr_add_entry_to_list - allocate and add filter entry to list
  27  * @dev: pointer to device needed by alloc function
  28  * @info: filter info struct that gets added to the passed in list
  29  * @list: pointer to the list which contains MAC filters entry
  30  */
  31 static int
  32 ice_fltr_add_entry_to_list(struct device *dev, struct ice_fltr_info *info,
  33                            struct list_head *list)
  34 {
  35         struct ice_fltr_list_entry *entry;
  36
  37         entry = devm_kzalloc(dev, sizeof(*entry), GFP_ATOMIC);
  38         if (!entry)
  39                 return -ENOMEM;
  40
  41         entry->fltr_info = *info;
  42
  43         INIT_LIST_HEAD(&entry->list_entry);
  44         list_add(&entry->list_entry, list);
  45
  46         return 0;
  47 }
  48
  49 /**
  50  * ice_fltr_add_mac_list - add list of MAC filters
  51  * @vsi: pointer to VSI struct
  52  * @list: list of filters
  53  */
  54 enum ice_status
  55 ice_fltr_add_mac_list(struct ice_vsi *vsi, struct list_head *list)
  56 {
  57         return ice_add_mac(&vsi->back->hw, list);
  58 }
  59
  60 /**
  61  * ice_fltr_remove_mac_list - remove list of MAC filters
  62  * @vsi: pointer to VSI struct
  63  * @list: list of filters
  64  */
  65 enum ice_status
  66 ice_fltr_remove_mac_list(struct ice_vsi *vsi, struct list_head *list)
  67 {
  68         return ice_remove_mac(&vsi->back->hw, list);
  69 }
  70
  71 /**
  72  * ice_fltr_add_vlan_list - add list of VLAN filters
  73  * @vsi: pointer to VSI struct
  74  * @list: list of filters
  75  */
  76 static enum ice_status
  77 ice_fltr_add_vlan_list(struct ice_vsi *vsi, struct list_head *list)
  78 {
  79         return ice_add_vlan(&vsi->back->hw, list);
  80 }
  81
  82 /**
  83  * ice_fltr_remove_vlan_list - remove list of VLAN filters
  84  * @vsi: pointer to VSI struct
  85  * @list: list of filters
  86  */
  87 static enum ice_status
  88 ice_fltr_remove_vlan_list(struct ice_vsi *vsi, struct list_head *list)
  89 {
  90         return ice_remove_vlan(&vsi->back->hw, list);
  91 }
  92
  93 /**
  94  * ice_fltr_add_eth_list - add list of ethertype filters
  95  * @vsi: pointer to VSI struct
  96  * @list: list of filters
  97  */
  98 static enum ice_status
  99 ice_fltr_add_eth_list(struct ice_vsi *vsi, struct list_head *list)
 100 {
 101         return ice_add_eth_mac(&vsi->back->hw, list);
 102 }
 103
 104 /**
 105  * ice_fltr_remove_eth_list - remove list of ethertype filters
 106  * @vsi: pointer to VSI struct
 107  * @list: list of filters
 108  */
 109 static enum ice_status
 110 ice_fltr_remove_eth_list(struct ice_vsi *vsi, struct list_head *list)
 111 {
 112         return ice_remove_eth_mac(&vsi->back->hw, list);
 113 }
 114
 115 /**
 116  * ice_fltr_remove_all - remove all filters associated with VSI
 117  * @vsi: pointer to VSI struct
 118  */
 119 void ice_fltr_remove_all(struct ice_vsi *vsi)
 120 {
 121         ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
 122 }
 123
 124 /**
 125  * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
 126  * @vsi: pointer to VSI struct
 127  * @list: list to add filter info to
 128  * @mac: MAC address to add
 129  * @action: filter action
 130  */
 131 int
 132 ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
 133                          const u8 *mac, enum ice_sw_fwd_act_type action)
 134 {
 135         struct ice_fltr_info info = { 0 };
 136
 137         info.flag = ICE_FLTR_TX;
 138         info.src_id = ICE_SRC_ID_VSI;
 139         info.lkup_type = ICE_SW_LKUP_MAC;
 140         info.fltr_act = action;
 141         info.vsi_handle = vsi->idx;
 142
 143         ether_addr_copy(info.l_data.mac.mac_addr, mac);
 144
 145         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 146                                           list);
 147 }
 148
 149 /**
 150  * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
 151  * @vsi: pointer to VSI struct
 152  * @list: list to add filter info to
 153  * @vlan_id: VLAN ID to add
 154  * @action: filter action
 155  */
 156 static int
 157 ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
 158                           u16 vlan_id, enum ice_sw_fwd_act_type action)
 159 {
 160         struct ice_fltr_info info = { 0 };
 161
 162         info.flag = ICE_FLTR_TX;
 163         info.src_id = ICE_SRC_ID_VSI;
 164         info.lkup_type = ICE_SW_LKUP_VLAN;
 165         info.fltr_act = action;
 166         info.vsi_handle = vsi->idx;
 167         info.l_data.vlan.vlan_id = vlan_id;
 168
 169         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 170                                           list);
 171 }
 172
 173 /**
 174  * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
 175  * @vsi: pointer to VSI struct
 176  * @list: list to add filter info to
 177  * @ethertype: ethertype of packet that matches filter
 178  * @flag: filter direction, Tx or Rx
 179  * @action: filter action
 180  */
 181 static int
 182 ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
 183                          u16 ethertype, u16 flag,
 184                          enum ice_sw_fwd_act_type action)
 185 {
 186         struct ice_fltr_info info = { 0 };
 187
 188         info.flag = flag;
 189         info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
 190         info.fltr_act = action;
 191         info.vsi_handle = vsi->idx;
 192         info.l_data.ethertype_mac.ethertype = ethertype;
 193
 194         if (flag == ICE_FLTR_TX)
 195                 info.src_id = ICE_SRC_ID_VSI;
 196         else
 197                 info.src_id = ICE_SRC_ID_LPORT;
 198
 199         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 200                                           list);
 201 }
 202
 203 /**
 204  * ice_fltr_prepare_mac - add or remove MAC rule
 205  * @vsi: pointer to VSI struct
 206  * @mac: MAC address to add
 207  * @action: action to be performed on filter match
 208  * @mac_action: pointer to add or remove MAC function
 209  */
 210 static enum ice_status
 211 ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
 212                      enum ice_sw_fwd_act_type action,
 213                      enum ice_status (*mac_action)(struct ice_vsi *,
 214                                                    struct list_head *))
 215 {
 216         enum ice_status result;
 217         LIST_HEAD(tmp_list);
 218
 219         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
 220                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 221                 return ICE_ERR_NO_MEMORY;
 222         }
 223
 224         result = mac_action(vsi, &tmp_list);
 225         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 226         return result;
 227 }
 228
 229 /**
 230  * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
 231  * @vsi: pointer to VSI struct
 232  * @mac: MAC address to add
 233  * @action: action to be performed on filter match
 234  * @mac_action: pointer to add or remove MAC function
 235  */
 236 static enum ice_status
 237 ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
 238                                    enum ice_sw_fwd_act_type action,
 239                                    enum ice_status(*mac_action)
 240                                    (struct ice_vsi *, struct list_head *))
 241 {
 242         u8 broadcast[ETH_ALEN];
 243         enum ice_status result;
 244         LIST_HEAD(tmp_list);
 245
 246         eth_broadcast_addr(broadcast);
 247         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
 248             ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
 249                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 250                 return ICE_ERR_NO_MEMORY;
 251         }
 252
 253         result = mac_action(vsi, &tmp_list);
 254         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 255         return result;
 256 }
 257
 258 /**
 259  * ice_fltr_prepare_vlan - add or remove VLAN filter
 260  * @vsi: pointer to VSI struct
 261  * @vlan_id: VLAN ID to add
 262  * @action: action to be performed on filter match
 263  * @vlan_action: pointer to add or remove VLAN function
 264  */
 265 static enum ice_status
 266 ice_fltr_prepare_vlan(struct ice_vsi *vsi, u16 vlan_id,
 267                       enum ice_sw_fwd_act_type action,
 268                       enum ice_status (*vlan_action)(struct ice_vsi *,
 269                                                      struct list_head *))
 270 {
 271         enum ice_status result;
 272         LIST_HEAD(tmp_list);
 273
 274         if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan_id, action))
 275                 return ICE_ERR_NO_MEMORY;
 276
 277         result = vlan_action(vsi, &tmp_list);
 278         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 279         return result;
 280 }
 281
 282 /**
 283  * ice_fltr_prepare_eth - add or remove ethertype filter
 284  * @vsi: pointer to VSI struct
 285  * @ethertype: ethertype of packet to be filtered
 286  * @flag: direction of packet, Tx or Rx
 287  * @action: action to be performed on filter match
 288  * @eth_action: pointer to add or remove ethertype function
 289  */
 290 static enum ice_status
 291 ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
 292                      enum ice_sw_fwd_act_type action,
 293                      enum ice_status (*eth_action)(struct ice_vsi *,
 294                                                    struct list_head *))
 295 {
 296         enum ice_status result;
 297         LIST_HEAD(tmp_list);
 298
 299         if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
 300                 return ICE_ERR_NO_MEMORY;
 301
 302         result = eth_action(vsi, &tmp_list);
 303         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 304         return result;
 305 }
 306
 307 /**
 308  * ice_fltr_add_mac - add single MAC filter
 309  * @vsi: pointer to VSI struct
 310  * @mac: MAC to add
 311  * @action: action to be performed on filter match
 312  */
 313 enum ice_status ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
 314                                  enum ice_sw_fwd_act_type action)
 315 {
 316         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
 317 }
 318
 319 /**
 320  * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
 321  * @vsi: pointer to VSI struct
 322  * @mac: MAC to add
 323  * @action: action to be performed on filter match
 324  */
 325 enum ice_status
 326 ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
 327                                enum ice_sw_fwd_act_type action)
 328 {
 329         return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
 330                                                   ice_fltr_add_mac_list);
 331 }
 332
 333 /**
 334  * ice_fltr_remove_mac - remove MAC filter
 335  * @vsi: pointer to VSI struct
 336  * @mac: filter MAC to remove
 337  * @action: action to remove
 338  */
 339 enum ice_status ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
 340                                     enum ice_sw_fwd_act_type action)
 341 {
 342         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
 343 }
 344
 345 /**
 346  * ice_fltr_add_vlan - add single VLAN filter
 347  * @vsi: pointer to VSI struct
 348  * @vlan_id: VLAN ID to add
 349  * @action: action to be performed on filter match
 350  */
 351 enum ice_status ice_fltr_add_vlan(struct ice_vsi *vsi, u16 vlan_id,
 352                                   enum ice_sw_fwd_act_type action)
 353 {
 354         return ice_fltr_prepare_vlan(vsi, vlan_id, action,
 355                                      ice_fltr_add_vlan_list);
 356 }
 357
 358 /**
 359  * ice_fltr_remove_vlan - remove VLAN filter
 360  * @vsi: pointer to VSI struct
 361  * @vlan_id: filter VLAN to remove
 362  * @action: action to remove
 363  */
 364 enum ice_status ice_fltr_remove_vlan(struct ice_vsi *vsi, u16 vlan_id,
 365                                      enum ice_sw_fwd_act_type action)
 366 {
 367         return ice_fltr_prepare_vlan(vsi, vlan_id, action,
 368                                      ice_fltr_remove_vlan_list);
 369 }
 370
 371 /**
 372  * ice_fltr_add_eth - add specyfic ethertype filter
 373  * @vsi: pointer to VSI struct
 374  * @ethertype: ethertype of filter
 375  * @flag: direction of packet to be filtered, Tx or Rx
 376  * @action: action to be performed on filter match
 377  */
 378 enum ice_status ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
 379                                  enum ice_sw_fwd_act_type action)
 380 {
 381         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
 382                                     ice_fltr_add_eth_list);
 383 }
 384
 385 /**
 386  * ice_fltr_remove_eth - remove ethertype filter
 387  * @vsi: pointer to VSI struct
 388  * @ethertype: ethertype of filter
 389  * @flag: direction of filter
 390  * @action: action to remove
 391  */
 392 enum ice_status ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype,
 393                                     u16 flag, enum ice_sw_fwd_act_type action)
 394 {
 395         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
 396                                     ice_fltr_remove_eth_list);
 397 }