1 // SPDX-License-Identifier: GPL-2.0
2 /* Copyright (c) 2019 Chelsio Communications, Inc. All rights reserved. */
6 static int cxgb4_mps_ref_dec_by_mac(struct adapter *adap,
7 const u8 *addr, const u8 *mask)
9 u8 bitmask[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
10 struct mps_entries_ref *mps_entry, *tmp;
13 spin_lock_bh(&adap->mps_ref_lock);
14 list_for_each_entry_safe(mps_entry, tmp, &adap->mps_ref, list) {
15 if (ether_addr_equal(mps_entry->addr, addr) &&
16 ether_addr_equal(mps_entry->mask, mask ? mask : bitmask)) {
17 if (!refcount_dec_and_test(&mps_entry->refcnt)) {
18 spin_unlock_bh(&adap->mps_ref_lock);
21 list_del(&mps_entry->list);
27 spin_unlock_bh(&adap->mps_ref_lock);
31 static int cxgb4_mps_ref_dec(struct adapter *adap, u16 idx)
33 struct mps_entries_ref *mps_entry, *tmp;
36 spin_lock(&adap->mps_ref_lock);
37 list_for_each_entry_safe(mps_entry, tmp, &adap->mps_ref, list) {
38 if (mps_entry->idx == idx) {
39 if (!refcount_dec_and_test(&mps_entry->refcnt)) {
40 spin_unlock(&adap->mps_ref_lock);
43 list_del(&mps_entry->list);
49 spin_unlock(&adap->mps_ref_lock);
53 static int cxgb4_mps_ref_inc(struct adapter *adap, const u8 *mac_addr,
54 u16 idx, const u8 *mask)
56 u8 bitmask[] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff };
57 struct mps_entries_ref *mps_entry;
60 spin_lock_bh(&adap->mps_ref_lock);
61 list_for_each_entry(mps_entry, &adap->mps_ref, list) {
62 if (mps_entry->idx == idx) {
63 refcount_inc(&mps_entry->refcnt);
67 mps_entry = kzalloc(sizeof(*mps_entry), GFP_ATOMIC);
72 ether_addr_copy(mps_entry->mask, mask ? mask : bitmask);
73 ether_addr_copy(mps_entry->addr, mac_addr);
75 refcount_set(&mps_entry->refcnt, 1);
76 list_add_tail(&mps_entry->list, &adap->mps_ref);
78 spin_unlock_bh(&adap->mps_ref_lock);
82 int cxgb4_free_mac_filt(struct adapter *adap, unsigned int viid,
83 unsigned int naddr, const u8 **addr, bool sleep_ok)
87 for (i = 0; i < naddr; i++) {
88 if (!cxgb4_mps_ref_dec_by_mac(adap, addr[i], NULL)) {
89 ret = t4_free_mac_filt(adap, adap->mbox, viid,
90 1, &addr[i], sleep_ok);
96 /* return number of filters freed */
100 int cxgb4_alloc_mac_filt(struct adapter *adap, unsigned int viid,
101 bool free, unsigned int naddr, const u8 **addr,
102 u16 *idx, u64 *hash, bool sleep_ok)
106 ret = t4_alloc_mac_filt(adap, adap->mbox, viid, free,
107 naddr, addr, idx, hash, sleep_ok);
111 for (i = 0; i < naddr; i++) {
112 if (idx[i] != 0xffff) {
113 if (cxgb4_mps_ref_inc(adap, addr[i], idx[i], NULL)) {
122 cxgb4_free_mac_filt(adap, viid, naddr, addr, sleep_ok);
125 /* Returns a negative error number or the number of filters allocated */
129 int cxgb4_update_mac_filt(struct port_info *pi, unsigned int viid,
130 int *tcam_idx, const u8 *addr,
131 bool persistent, u8 *smt_idx)
135 ret = cxgb4_change_mac(pi, viid, tcam_idx,
136 addr, persistent, smt_idx);
140 cxgb4_mps_ref_inc(pi->adapter, addr, *tcam_idx, NULL);
144 int cxgb4_free_raw_mac_filt(struct adapter *adap,
155 if (!cxgb4_mps_ref_dec(adap, idx))
156 ret = t4_free_raw_mac_filt(adap, viid, addr,
157 mask, idx, lookup_type,
163 int cxgb4_alloc_raw_mac_filt(struct adapter *adap,
174 ret = t4_alloc_raw_mac_filt(adap, viid, addr,
175 mask, idx, lookup_type,
180 if (cxgb4_mps_ref_inc(adap, addr, ret, mask)) {
182 t4_free_raw_mac_filt(adap, viid, addr,
183 mask, idx, lookup_type,
190 int cxgb4_free_encap_mac_filt(struct adapter *adap, unsigned int viid,
191 int idx, bool sleep_ok)
195 if (!cxgb4_mps_ref_dec(adap, idx))
196 ret = t4_free_encap_mac_filt(adap, viid, idx, sleep_ok);
201 int cxgb4_alloc_encap_mac_filt(struct adapter *adap, unsigned int viid,
202 const u8 *addr, const u8 *mask,
203 unsigned int vni, unsigned int vni_mask,
204 u8 dip_hit, u8 lookup_type, bool sleep_ok)
208 ret = t4_alloc_encap_mac_filt(adap, viid, addr, mask, vni, vni_mask,
209 dip_hit, lookup_type, sleep_ok);
213 if (cxgb4_mps_ref_inc(adap, addr, ret, mask)) {
215 t4_free_encap_mac_filt(adap, viid, ret, sleep_ok);
220 int cxgb4_init_mps_ref_entries(struct adapter *adap)
222 spin_lock_init(&adap->mps_ref_lock);
223 INIT_LIST_HEAD(&adap->mps_ref);
228 void cxgb4_free_mps_ref_entries(struct adapter *adap)
230 struct mps_entries_ref *mps_entry, *tmp;
232 if (!list_empty(&adap->mps_ref))
235 spin_lock(&adap->mps_ref_lock);
236 list_for_each_entry_safe(mps_entry, tmp, &adap->mps_ref, list) {
237 list_del(&mps_entry->list);
240 spin_unlock(&adap->mps_ref_lock);