1/*
2 * This file is part of the Chelsio T4/T5/T6 Ethernet driver for Linux.
3 *
4 * Copyright (c) 2017 Chelsio Communications, Inc. All rights reserved.
5 *
6 * This software is available to you under a choice of one of two
7 * licenses. You may choose to be licensed under the terms of the GNU
8 * General Public License (GPL) Version 2, available from the file
9 * COPYING in the main directory of this source tree, or the
10 * OpenIB.org BSD license below:
11 *
12 * Redistribution and use in source and binary forms, with or
13 * without modification, are permitted provided that the following
14 * conditions are met:
15 *
16 * - Redistributions of source code must retain the above
17 * copyright notice, this list of conditions and the following
18 * disclaimer.
19 *
20 * - Redistributions in binary form must reproduce the above
21 * copyright notice, this list of conditions and the following
22 * disclaimer in the documentation and/or other materials
23 * provided with the distribution.
24 *
25 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
26 * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
27 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
28 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
29 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
30 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
31 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
32 * SOFTWARE.
33 */
34
35#include "cxgb4.h"
36#include "smt.h"
37#include "t4_msg.h"
38#include "t4fw_api.h"
39#include "t4_regs.h"
40#include "t4_values.h"
41
42struct smt_data *t4_init_smt(void)
43{
44 unsigned int smt_size;
45 struct smt_data *s;
46 int i;
47
48 smt_size = SMT_SIZE;
49
50 s = kvzalloc(struct_size(s, smtab, smt_size), GFP_KERNEL);
51 if (!s)
52 return NULL;
53 s->smt_size = smt_size;
54 rwlock_init(&s->lock);
55 for (i = 0; i < s->smt_size; ++i) {
56 s->smtab[i].idx = i;
57 s->smtab[i].state = SMT_STATE_UNUSED;
58 eth_zero_addr(addr: s->smtab[i].src_mac);
59 spin_lock_init(&s->smtab[i].lock);
60 s->smtab[i].refcnt = 0;
61 }
62 return s;
63}
64
65static struct smt_entry *find_or_alloc_smte(struct smt_data *s, u8 *smac)
66{
67 struct smt_entry *first_free = NULL;
68 struct smt_entry *e, *end;
69
70 for (e = &s->smtab[0], end = &s->smtab[s->smt_size]; e != end; ++e) {
71 if (e->refcnt == 0) {
72 if (!first_free)
73 first_free = e;
74 } else {
75 if (e->state == SMT_STATE_SWITCHING) {
76 /* This entry is actually in use. See if we can
77 * re-use it ?
78 */
79 if (memcmp(p: e->src_mac, q: smac, ETH_ALEN) == 0)
80 goto found_reuse;
81 }
82 }
83 }
84
85 if (first_free) {
86 e = first_free;
87 goto found;
88 }
89 return NULL;
90
91found:
92 e->state = SMT_STATE_UNUSED;
93
94found_reuse:
95 return e;
96}
97
98static void t4_smte_free(struct smt_entry *e)
99{
100 if (e->refcnt == 0) { /* hasn't been recycled */
101 e->state = SMT_STATE_UNUSED;
102 }
103}
104
105/**
106 * cxgb4_smt_release - Release SMT entry
107 * @e: smt entry to release
108 *
109 * Releases ref count and frees up an smt entry from SMT table
110 */
111void cxgb4_smt_release(struct smt_entry *e)
112{
113 spin_lock_bh(lock: &e->lock);
114 if ((--e->refcnt) == 0)
115 t4_smte_free(e);
116 spin_unlock_bh(lock: &e->lock);
117}
118EXPORT_SYMBOL(cxgb4_smt_release);
119
120void do_smt_write_rpl(struct adapter *adap, const struct cpl_smt_write_rpl *rpl)
121{
122 unsigned int smtidx = TID_TID_G(GET_TID(rpl));
123 struct smt_data *s = adap->smt;
124
125 if (unlikely(rpl->status != CPL_ERR_NONE)) {
126 struct smt_entry *e = &s->smtab[smtidx];
127
128 dev_err(adap->pdev_dev,
129 "Unexpected SMT_WRITE_RPL status %u for entry %u\n",
130 rpl->status, smtidx);
131 spin_lock(lock: &e->lock);
132 e->state = SMT_STATE_ERROR;
133 spin_unlock(lock: &e->lock);
134 return;
135 }
136}
137
138static int write_smt_entry(struct adapter *adapter, struct smt_entry *e)
139{
140 struct cpl_t6_smt_write_req *t6req;
141 struct smt_data *s = adapter->smt;
142 struct cpl_smt_write_req *req;
143 struct sk_buff *skb;
144 int size;
145 u8 row;
146
147 if (CHELSIO_CHIP_VERSION(adapter->params.chip) <= CHELSIO_T5) {
148 size = sizeof(*req);
149 skb = alloc_skb(size, GFP_ATOMIC);
150 if (!skb)
151 return -ENOMEM;
152 /* Source MAC Table (SMT) contains 256 SMAC entries
153 * organized in 128 rows of 2 entries each.
154 */
155 req = (struct cpl_smt_write_req *)__skb_put(skb, len: size);
156 INIT_TP_WR(req, 0);
157
158 /* Each row contains an SMAC pair.
159 * LSB selects the SMAC entry within a row
160 */
161 row = (e->idx >> 1);
162 if (e->idx & 1) {
163 req->pfvf1 = 0x0;
164 memcpy(req->src_mac1, e->src_mac, ETH_ALEN);
165
166 /* fill pfvf0/src_mac0 with entry
167 * at prev index from smt-tab.
168 */
169 req->pfvf0 = 0x0;
170 memcpy(req->src_mac0, s->smtab[e->idx - 1].src_mac,
171 ETH_ALEN);
172 } else {
173 req->pfvf0 = 0x0;
174 memcpy(req->src_mac0, e->src_mac, ETH_ALEN);
175
176 /* fill pfvf1/src_mac1 with entry
177 * at next index from smt-tab
178 */
179 req->pfvf1 = 0x0;
180 memcpy(req->src_mac1, s->smtab[e->idx + 1].src_mac,
181 ETH_ALEN);
182 }
183 } else {
184 size = sizeof(*t6req);
185 skb = alloc_skb(size, GFP_ATOMIC);
186 if (!skb)
187 return -ENOMEM;
188 /* Source MAC Table (SMT) contains 256 SMAC entries */
189 t6req = (struct cpl_t6_smt_write_req *)__skb_put(skb, len: size);
190 INIT_TP_WR(t6req, 0);
191 req = (struct cpl_smt_write_req *)t6req;
192
193 /* fill pfvf0/src_mac0 from smt-tab */
194 req->pfvf0 = 0x0;
195 memcpy(req->src_mac0, s->smtab[e->idx].src_mac, ETH_ALEN);
196 row = e->idx;
197 }
198
199 OPCODE_TID(req) =
200 htonl(MK_OPCODE_TID(CPL_SMT_WRITE_REQ, e->idx |
201 TID_QID_V(adapter->sge.fw_evtq.abs_id)));
202 req->params = htonl(SMTW_NORPL_V(0) |
203 SMTW_IDX_V(row) |
204 SMTW_OVLAN_IDX_V(0));
205 t4_mgmt_tx(adap: adapter, skb);
206 return 0;
207}
208
209static struct smt_entry *t4_smt_alloc_switching(struct adapter *adap, u16 pfvf,
210 u8 *smac)
211{
212 struct smt_data *s = adap->smt;
213 struct smt_entry *e;
214
215 write_lock_bh(&s->lock);
216 e = find_or_alloc_smte(s, smac);
217 if (e) {
218 spin_lock(lock: &e->lock);
219 if (!e->refcnt) {
220 e->refcnt = 1;
221 e->state = SMT_STATE_SWITCHING;
222 e->pfvf = pfvf;
223 memcpy(e->src_mac, smac, ETH_ALEN);
224 write_smt_entry(adapter: adap, e);
225 } else {
226 ++e->refcnt;
227 }
228 spin_unlock(lock: &e->lock);
229 }
230 write_unlock_bh(&s->lock);
231 return e;
232}
233
234/**
235 * cxgb4_smt_alloc_switching - Allocates an SMT entry for switch filters.
236 * @dev: net_device pointer
237 * @smac: MAC address to add to SMT
238 * Returns pointer to the SMT entry created
239 *
240 * Allocates an SMT entry to be used by switching rule of a filter.
241 */
242struct smt_entry *cxgb4_smt_alloc_switching(struct net_device *dev, u8 *smac)
243{
244 struct adapter *adap = netdev2adap(dev);
245
246 return t4_smt_alloc_switching(adap, pfvf: 0x0, smac);
247}
248EXPORT_SYMBOL(cxgb4_smt_alloc_switching);
249

source code of linux/drivers/net/ethernet/chelsio/cxgb4/smt.c