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_set_vlan_vsi_promisc
  51  * @hw: pointer to the hardware structure
  52  * @vsi: the VSI being configured
  53  * @promisc_mask: mask of promiscuous config bits
  54  *
  55  * Set VSI with all associated VLANs to given promiscuous mode(s)
  56  */
  57 int
  58 ice_fltr_set_vlan_vsi_promisc(struct ice_hw *hw, struct ice_vsi *vsi,
  59                               u8 promisc_mask)
  60 {
  61         struct ice_pf *pf = hw->back;
  62         int result;
  63
  64         result = ice_set_vlan_vsi_promisc(hw, vsi->idx, promisc_mask, false);
  65         if (result && result != -EEXIST)
  66                 dev_err(ice_pf_to_dev(pf),
  67                         "Error setting promisc mode on VSI %i (rc=%d)\n",
  68                         vsi->vsi_num, result);
  69
  70         return result;
  71 }
  72
  73 /**
  74  * ice_fltr_clear_vlan_vsi_promisc
  75  * @hw: pointer to the hardware structure
  76  * @vsi: the VSI being configured
  77  * @promisc_mask: mask of promiscuous config bits
  78  *
  79  * Clear VSI with all associated VLANs to given promiscuous mode(s)
  80  */
  81 int
  82 ice_fltr_clear_vlan_vsi_promisc(struct ice_hw *hw, struct ice_vsi *vsi,
  83                                 u8 promisc_mask)
  84 {
  85         struct ice_pf *pf = hw->back;
  86         int result;
  87
  88         result = ice_set_vlan_vsi_promisc(hw, vsi->idx, promisc_mask, true);
  89         if (result && result != -EEXIST)
  90                 dev_err(ice_pf_to_dev(pf),
  91                         "Error clearing promisc mode on VSI %i (rc=%d)\n",
  92                         vsi->vsi_num, result);
  93
  94         return result;
  95 }
  96
  97 /**
  98  * ice_fltr_clear_vsi_promisc - clear specified promiscuous mode(s)
  99  * @hw: pointer to the hardware structure
 100  * @vsi_handle: VSI handle to clear mode
 101  * @promisc_mask: mask of promiscuous config bits to clear
 102  * @vid: VLAN ID to clear VLAN promiscuous
 103  */
 104 int
 105 ice_fltr_clear_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
 106                            u16 vid)
 107 {
 108         struct ice_pf *pf = hw->back;
 109         int result;
 110
 111         result = ice_clear_vsi_promisc(hw, vsi_handle, promisc_mask, vid);
 112         if (result && result != -EEXIST)
 113                 dev_err(ice_pf_to_dev(pf),
 114                         "Error clearing promisc mode on VSI %i for VID %u (rc=%d)\n",
 115                         ice_get_hw_vsi_num(hw, vsi_handle), vid, result);
 116
 117         return result;
 118 }
 119
 120 /**
 121  * ice_fltr_set_vsi_promisc - set given VSI to given promiscuous mode(s)
 122  * @hw: pointer to the hardware structure
 123  * @vsi_handle: VSI handle to configure
 124  * @promisc_mask: mask of promiscuous config bits
 125  * @vid: VLAN ID to set VLAN promiscuous
 126  */
 127 int
 128 ice_fltr_set_vsi_promisc(struct ice_hw *hw, u16 vsi_handle, u8 promisc_mask,
 129                          u16 vid)
 130 {
 131         struct ice_pf *pf = hw->back;
 132         int result;
 133
 134         result = ice_set_vsi_promisc(hw, vsi_handle, promisc_mask, vid);
 135         if (result && result != -EEXIST)
 136                 dev_err(ice_pf_to_dev(pf),
 137                         "Error setting promisc mode on VSI %i for VID %u (rc=%d)\n",
 138                         ice_get_hw_vsi_num(hw, vsi_handle), vid, result);
 139
 140         return result;
 141 }
 142
 143 /**
 144  * ice_fltr_add_mac_list - add list of MAC filters
 145  * @vsi: pointer to VSI struct
 146  * @list: list of filters
 147  */
 148 int ice_fltr_add_mac_list(struct ice_vsi *vsi, struct list_head *list)
 149 {
 150         return ice_add_mac(&vsi->back->hw, list);
 151 }
 152
 153 /**
 154  * ice_fltr_remove_mac_list - remove list of MAC filters
 155  * @vsi: pointer to VSI struct
 156  * @list: list of filters
 157  */
 158 int ice_fltr_remove_mac_list(struct ice_vsi *vsi, struct list_head *list)
 159 {
 160         return ice_remove_mac(&vsi->back->hw, list);
 161 }
 162
 163 /**
 164  * ice_fltr_add_vlan_list - add list of VLAN filters
 165  * @vsi: pointer to VSI struct
 166  * @list: list of filters
 167  */
 168 static int ice_fltr_add_vlan_list(struct ice_vsi *vsi, struct list_head *list)
 169 {
 170         return ice_add_vlan(&vsi->back->hw, list);
 171 }
 172
 173 /**
 174  * ice_fltr_remove_vlan_list - remove list of VLAN filters
 175  * @vsi: pointer to VSI struct
 176  * @list: list of filters
 177  */
 178 static int
 179 ice_fltr_remove_vlan_list(struct ice_vsi *vsi, struct list_head *list)
 180 {
 181         return ice_remove_vlan(&vsi->back->hw, list);
 182 }
 183
 184 /**
 185  * ice_fltr_add_eth_list - add list of ethertype filters
 186  * @vsi: pointer to VSI struct
 187  * @list: list of filters
 188  */
 189 static int ice_fltr_add_eth_list(struct ice_vsi *vsi, struct list_head *list)
 190 {
 191         return ice_add_eth_mac(&vsi->back->hw, list);
 192 }
 193
 194 /**
 195  * ice_fltr_remove_eth_list - remove list of ethertype filters
 196  * @vsi: pointer to VSI struct
 197  * @list: list of filters
 198  */
 199 static int ice_fltr_remove_eth_list(struct ice_vsi *vsi, struct list_head *list)
 200 {
 201         return ice_remove_eth_mac(&vsi->back->hw, list);
 202 }
 203
 204 /**
 205  * ice_fltr_remove_all - remove all filters associated with VSI
 206  * @vsi: pointer to VSI struct
 207  */
 208 void ice_fltr_remove_all(struct ice_vsi *vsi)
 209 {
 210         ice_remove_vsi_fltr(&vsi->back->hw, vsi->idx);
 211         /* sync netdev filters if exist */
 212         if (vsi->netdev) {
 213                 __dev_uc_unsync(vsi->netdev, NULL);
 214                 __dev_mc_unsync(vsi->netdev, NULL);
 215         }
 216 }
 217
 218 /**
 219  * ice_fltr_add_mac_to_list - add MAC filter info to exsisting list
 220  * @vsi: pointer to VSI struct
 221  * @list: list to add filter info to
 222  * @mac: MAC address to add
 223  * @action: filter action
 224  */
 225 int
 226 ice_fltr_add_mac_to_list(struct ice_vsi *vsi, struct list_head *list,
 227                          const u8 *mac, enum ice_sw_fwd_act_type action)
 228 {
 229         struct ice_fltr_info info = { 0 };
 230
 231         info.flag = ICE_FLTR_TX;
 232         info.src_id = ICE_SRC_ID_VSI;
 233         info.lkup_type = ICE_SW_LKUP_MAC;
 234         info.fltr_act = action;
 235         info.vsi_handle = vsi->idx;
 236
 237         ether_addr_copy(info.l_data.mac.mac_addr, mac);
 238
 239         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 240                                           list);
 241 }
 242
 243 /**
 244  * ice_fltr_add_vlan_to_list - add VLAN filter info to exsisting list
 245  * @vsi: pointer to VSI struct
 246  * @list: list to add filter info to
 247  * @vlan: VLAN filter details
 248  */
 249 static int
 250 ice_fltr_add_vlan_to_list(struct ice_vsi *vsi, struct list_head *list,
 251                           struct ice_vlan *vlan)
 252 {
 253         struct ice_fltr_info info = { 0 };
 254
 255         info.flag = ICE_FLTR_TX;
 256         info.src_id = ICE_SRC_ID_VSI;
 257         info.lkup_type = ICE_SW_LKUP_VLAN;
 258         info.fltr_act = ICE_FWD_TO_VSI;
 259         info.vsi_handle = vsi->idx;
 260         info.l_data.vlan.vlan_id = vlan->vid;
 261         info.l_data.vlan.tpid = vlan->tpid;
 262         info.l_data.vlan.tpid_valid = true;
 263
 264         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 265                                           list);
 266 }
 267
 268 /**
 269  * ice_fltr_add_eth_to_list - add ethertype filter info to exsisting list
 270  * @vsi: pointer to VSI struct
 271  * @list: list to add filter info to
 272  * @ethertype: ethertype of packet that matches filter
 273  * @flag: filter direction, Tx or Rx
 274  * @action: filter action
 275  */
 276 static int
 277 ice_fltr_add_eth_to_list(struct ice_vsi *vsi, struct list_head *list,
 278                          u16 ethertype, u16 flag,
 279                          enum ice_sw_fwd_act_type action)
 280 {
 281         struct ice_fltr_info info = { 0 };
 282
 283         info.flag = flag;
 284         info.lkup_type = ICE_SW_LKUP_ETHERTYPE;
 285         info.fltr_act = action;
 286         info.vsi_handle = vsi->idx;
 287         info.l_data.ethertype_mac.ethertype = ethertype;
 288
 289         if (flag == ICE_FLTR_TX)
 290                 info.src_id = ICE_SRC_ID_VSI;
 291         else
 292                 info.src_id = ICE_SRC_ID_LPORT;
 293
 294         return ice_fltr_add_entry_to_list(ice_pf_to_dev(vsi->back), &info,
 295                                           list);
 296 }
 297
 298 /**
 299  * ice_fltr_prepare_mac - add or remove MAC rule
 300  * @vsi: pointer to VSI struct
 301  * @mac: MAC address to add
 302  * @action: action to be performed on filter match
 303  * @mac_action: pointer to add or remove MAC function
 304  */
 305 static int
 306 ice_fltr_prepare_mac(struct ice_vsi *vsi, const u8 *mac,
 307                      enum ice_sw_fwd_act_type action,
 308                      int (*mac_action)(struct ice_vsi *, struct list_head *))
 309 {
 310         LIST_HEAD(tmp_list);
 311         int result;
 312
 313         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action)) {
 314                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 315                 return -ENOMEM;
 316         }
 317
 318         result = mac_action(vsi, &tmp_list);
 319         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 320         return result;
 321 }
 322
 323 /**
 324  * ice_fltr_prepare_mac_and_broadcast - add or remove MAC and broadcast filter
 325  * @vsi: pointer to VSI struct
 326  * @mac: MAC address to add
 327  * @action: action to be performed on filter match
 328  * @mac_action: pointer to add or remove MAC function
 329  */
 330 static int
 331 ice_fltr_prepare_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
 332                                    enum ice_sw_fwd_act_type action,
 333                                    int(*mac_action)
 334                                    (struct ice_vsi *, struct list_head *))
 335 {
 336         u8 broadcast[ETH_ALEN];
 337         LIST_HEAD(tmp_list);
 338         int result;
 339
 340         eth_broadcast_addr(broadcast);
 341         if (ice_fltr_add_mac_to_list(vsi, &tmp_list, mac, action) ||
 342             ice_fltr_add_mac_to_list(vsi, &tmp_list, broadcast, action)) {
 343                 ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 344                 return -ENOMEM;
 345         }
 346
 347         result = mac_action(vsi, &tmp_list);
 348         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 349         return result;
 350 }
 351
 352 /**
 353  * ice_fltr_prepare_vlan - add or remove VLAN filter
 354  * @vsi: pointer to VSI struct
 355  * @vlan: VLAN filter details
 356  * @vlan_action: pointer to add or remove VLAN function
 357  */
 358 static int
 359 ice_fltr_prepare_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan,
 360                       int (*vlan_action)(struct ice_vsi *, struct list_head *))
 361 {
 362         LIST_HEAD(tmp_list);
 363         int result;
 364
 365         if (ice_fltr_add_vlan_to_list(vsi, &tmp_list, vlan))
 366                 return -ENOMEM;
 367
 368         result = vlan_action(vsi, &tmp_list);
 369         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 370         return result;
 371 }
 372
 373 /**
 374  * ice_fltr_prepare_eth - add or remove ethertype filter
 375  * @vsi: pointer to VSI struct
 376  * @ethertype: ethertype of packet to be filtered
 377  * @flag: direction of packet, Tx or Rx
 378  * @action: action to be performed on filter match
 379  * @eth_action: pointer to add or remove ethertype function
 380  */
 381 static int
 382 ice_fltr_prepare_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
 383                      enum ice_sw_fwd_act_type action,
 384                      int (*eth_action)(struct ice_vsi *, struct list_head *))
 385 {
 386         LIST_HEAD(tmp_list);
 387         int result;
 388
 389         if (ice_fltr_add_eth_to_list(vsi, &tmp_list, ethertype, flag, action))
 390                 return -ENOMEM;
 391
 392         result = eth_action(vsi, &tmp_list);
 393         ice_fltr_free_list(ice_pf_to_dev(vsi->back), &tmp_list);
 394         return result;
 395 }
 396
 397 /**
 398  * ice_fltr_add_mac - add single MAC filter
 399  * @vsi: pointer to VSI struct
 400  * @mac: MAC to add
 401  * @action: action to be performed on filter match
 402  */
 403 int ice_fltr_add_mac(struct ice_vsi *vsi, const u8 *mac,
 404                      enum ice_sw_fwd_act_type action)
 405 {
 406         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_add_mac_list);
 407 }
 408
 409 /**
 410  * ice_fltr_add_mac_and_broadcast - add single MAC and broadcast
 411  * @vsi: pointer to VSI struct
 412  * @mac: MAC to add
 413  * @action: action to be performed on filter match
 414  */
 415 int
 416 ice_fltr_add_mac_and_broadcast(struct ice_vsi *vsi, const u8 *mac,
 417                                enum ice_sw_fwd_act_type action)
 418 {
 419         return ice_fltr_prepare_mac_and_broadcast(vsi, mac, action,
 420                                                   ice_fltr_add_mac_list);
 421 }
 422
 423 /**
 424  * ice_fltr_remove_mac - remove MAC filter
 425  * @vsi: pointer to VSI struct
 426  * @mac: filter MAC to remove
 427  * @action: action to remove
 428  */
 429 int ice_fltr_remove_mac(struct ice_vsi *vsi, const u8 *mac,
 430                         enum ice_sw_fwd_act_type action)
 431 {
 432         return ice_fltr_prepare_mac(vsi, mac, action, ice_fltr_remove_mac_list);
 433 }
 434
 435 /**
 436  * ice_fltr_add_vlan - add single VLAN filter
 437  * @vsi: pointer to VSI struct
 438  * @vlan: VLAN filter details
 439  */
 440 int ice_fltr_add_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
 441 {
 442         return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_add_vlan_list);
 443 }
 444
 445 /**
 446  * ice_fltr_remove_vlan - remove VLAN filter
 447  * @vsi: pointer to VSI struct
 448  * @vlan: VLAN filter details
 449  */
 450 int ice_fltr_remove_vlan(struct ice_vsi *vsi, struct ice_vlan *vlan)
 451 {
 452         return ice_fltr_prepare_vlan(vsi, vlan, ice_fltr_remove_vlan_list);
 453 }
 454
 455 /**
 456  * ice_fltr_add_eth - add specyfic ethertype filter
 457  * @vsi: pointer to VSI struct
 458  * @ethertype: ethertype of filter
 459  * @flag: direction of packet to be filtered, Tx or Rx
 460  * @action: action to be performed on filter match
 461  */
 462 int ice_fltr_add_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
 463                      enum ice_sw_fwd_act_type action)
 464 {
 465         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
 466                                     ice_fltr_add_eth_list);
 467 }
 468
 469 /**
 470  * ice_fltr_remove_eth - remove ethertype filter
 471  * @vsi: pointer to VSI struct
 472  * @ethertype: ethertype of filter
 473  * @flag: direction of filter
 474  * @action: action to remove
 475  */
 476 int ice_fltr_remove_eth(struct ice_vsi *vsi, u16 ethertype, u16 flag,
 477                         enum ice_sw_fwd_act_type action)
 478 {
 479         return ice_fltr_prepare_eth(vsi, ethertype, flag, action,
 480                                     ice_fltr_remove_eth_list);
 481 }