249 lines · c
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 two7 * licenses. You may choose to be licensed under the terms of the GNU8 * General Public License (GPL) Version 2, available from the file9 * COPYING in the main directory of this source tree, or the10 * OpenIB.org BSD license below:11 *12 * Redistribution and use in source and binary forms, with or13 * without modification, are permitted provided that the following14 * conditions are met:15 *16 * - Redistributions of source code must retain the above17 * copyright notice, this list of conditions and the following18 * disclaimer.19 *20 * - Redistributions in binary form must reproduce the above21 * copyright notice, this list of conditions and the following22 * disclaimer in the documentation and/or other materials23 * 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 OF27 * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND28 * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS29 * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN30 * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN31 * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE32 * 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(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 can77 * re-use it ?78 */79 if (memcmp(e->src_mac, 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 entry107 * @e: smt entry to release108 *109 * Releases ref count and frees up an smt entry from SMT table110 */111void cxgb4_smt_release(struct smt_entry *e)112{113 spin_lock_bh(&e->lock);114 if ((--e->refcnt) == 0)115 t4_smte_free(e);116 spin_unlock_bh(&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(&e->lock);132 e->state = SMT_STATE_ERROR;133 spin_unlock(&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 entries153 * organized in 128 rows of 2 entries each.154 */155 req = (struct cpl_smt_write_req *)__skb_put(skb, size);156 INIT_TP_WR(req, 0);157 158 /* Each row contains an SMAC pair.159 * LSB selects the SMAC entry within a row160 */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 entry167 * 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 entry177 * at next index from smt-tab178 */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, 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(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(&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(adap, e);225 } else {226 ++e->refcnt;227 }228 spin_unlock(&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 pointer237 * @smac: MAC address to add to SMT238 * Returns pointer to the SMT entry created239 *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, 0x0, smac);247}248EXPORT_SYMBOL(cxgb4_smt_alloc_switching);249