318 lines
9.9 KiB
C
318 lines
9.9 KiB
C
|
/*******************************************************************************
|
||
|
Copyright (C) Marvell Interfdbional Ltd. and its affiliates
|
||
|
|
||
|
This software file (the "File") is owned and distributed by Marvell
|
||
|
Interfdbional Ltd. and/or its affiliates ("Marvell") under the following
|
||
|
alterfdbive licensing terms. Once you have made an election to distribute the
|
||
|
File under one of the following license alterfdbives, please (i) delete this
|
||
|
introductory statement regarding license alterfdbives, (ii) delete the two
|
||
|
license alterfdbives that you have not elected to use and (iii) preserve the
|
||
|
Marvell copyright notice above.
|
||
|
|
||
|
********************************************************************************
|
||
|
Marvell Commercial License Option
|
||
|
|
||
|
If you received this File from Marvell and you have entered into a commercial
|
||
|
license agreement (a "Commercial License") with Marvell, the File is licensed
|
||
|
to you under the terms of the applicable Commercial License.
|
||
|
|
||
|
********************************************************************************
|
||
|
Marvell GPL License Option
|
||
|
|
||
|
If you received this File from Marvell, you may opt to use, redistribute and/or
|
||
|
modify this File in accordance with the terms and conditions of the General
|
||
|
Public License Version 2, June 1991 (the "GPL License"), a copy of which is
|
||
|
available along with the File in the license.txt file or by writing to the Free
|
||
|
Software Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 or
|
||
|
on the worldwide web at http://www.gnu.org/licenses/gpl.txt.
|
||
|
|
||
|
THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE IMPLIED
|
||
|
WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE ARE EXPRESSLY
|
||
|
DISCLAIMED. The GPL License provides additional details about this warranty
|
||
|
disclaimer.
|
||
|
********************************************************************************
|
||
|
Marvell BSD License Option
|
||
|
|
||
|
If you received this File from Marvell, you may opt to use, redistribute and/or
|
||
|
modify this File under the following licensing terms.
|
||
|
Redistribution and use in source and binary forms, with or without modification,
|
||
|
are permitted provided that the following conditions are met:
|
||
|
|
||
|
* Redistributions of source code must retain the above copyright notice,
|
||
|
this list of conditions and the following disclaimer.
|
||
|
|
||
|
* Redistributions in binary form must reproduce the above copyright
|
||
|
notice, this list of conditions and the following disclaimer in the
|
||
|
documentation and/or other materials provided with the distribution.
|
||
|
|
||
|
* Neither the name of Marvell nor the names of its contributors may be
|
||
|
used to endorse or promote products derived from this software without
|
||
|
specific prior written permission.
|
||
|
|
||
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
|
||
|
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
|
||
|
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
|
||
|
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR
|
||
|
ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
|
||
|
(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
|
||
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
|
||
|
ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
||
|
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
|
||
|
*******************************************************************************/
|
||
|
|
||
|
/*******************************************************************************
|
||
|
* mvFastPath.c - Marvell Fast Route Routing and Bridge
|
||
|
*
|
||
|
* DESCRIPTION:
|
||
|
*
|
||
|
* Supported Features:
|
||
|
* - OS independent.
|
||
|
*
|
||
|
*******************************************************************************/
|
||
|
|
||
|
/* includes */
|
||
|
#include "mvOs.h"
|
||
|
#include "mvDebug.h"
|
||
|
#include "eth/nfp/mvNfp.h"
|
||
|
#include "eth/mvEth.h"
|
||
|
|
||
|
|
||
|
struct fdbRuleHashBucket *fdbRuleDb;
|
||
|
MV_U32 fdbRuleDbSize;
|
||
|
MV_U32 fdbMember[ETH_FP_IFINDEX_MAX];
|
||
|
MV_U32 fdbRuleUpdateCount = 0;
|
||
|
MV_U32 fdbRuleSetCount = 0;
|
||
|
MV_U32 fdbRuleDeleteCount = 0;
|
||
|
MV_U32 fdbHashMaxDepth;
|
||
|
|
||
|
|
||
|
MV_STATUS mvFpFdbInit(MV_U32 dbSize)
|
||
|
{
|
||
|
fdbRuleDb = (struct fdbRuleHashBucket *)mvOsMalloc(sizeof(struct fdbRuleHashBucket)*dbSize);
|
||
|
if (fdbRuleDb == NULL) {
|
||
|
mvOsPrintf("NFP (fdb): not enough memory\n");
|
||
|
return MV_NO_RESOURCE;
|
||
|
}
|
||
|
fdbRuleDbSize = dbSize;
|
||
|
memset(fdbRuleDb, 0, sizeof(struct fdbRuleHashBucket)*fdbRuleDbSize);
|
||
|
memset(fdbMember, 0, sizeof(fdbMember));
|
||
|
|
||
|
mvOsPrintf("NFP (fdb) init %d entries, %d bytes\n",
|
||
|
fdbRuleDbSize, sizeof(struct fdbRuleHashBucket)*fdbRuleDbSize);
|
||
|
return MV_OK;
|
||
|
}
|
||
|
|
||
|
/* Clear Fast Route Bridge Rule Database (SNAT + DNAT table) */
|
||
|
MV_STATUS mvFpFdbClear(void)
|
||
|
{
|
||
|
MV_U32 i = fdbRuleDbSize;
|
||
|
MV_FP_FDB_RULE *rule, *tmp;
|
||
|
|
||
|
if (fdbRuleDb != NULL)
|
||
|
return MV_NOT_INITIALIZED;
|
||
|
|
||
|
while (i--) {
|
||
|
rule = fdbRuleDb[i].ruleChain;
|
||
|
while (rule) {
|
||
|
tmp = rule;
|
||
|
rule = rule->next;
|
||
|
mvOsFree(tmp);
|
||
|
}
|
||
|
fdbRuleDb[i].ruleChain = NULL;
|
||
|
}
|
||
|
return MV_OK;
|
||
|
}
|
||
|
|
||
|
void mvFpFdbDestroy(void)
|
||
|
{
|
||
|
if (fdbRuleDb != NULL)
|
||
|
mvOsFree(fdbRuleDb);
|
||
|
}
|
||
|
|
||
|
static INLINE int mvFpFdbRuleCmp(MV_FP_RULE_FDB_INFO *rule1, MV_FP_RULE_FDB_INFO *rule2)
|
||
|
{
|
||
|
return !((rule1->bridge == rule2->bridge) &&
|
||
|
(rule1->ifIndex == rule2->ifIndex) &&
|
||
|
!memcmp(rule1->mac, rule2->mac, 6));
|
||
|
}
|
||
|
|
||
|
static INLINE MV_U32 mvFpFdbRuleHash(MV_FP_FDB_RULE *rule)
|
||
|
{
|
||
|
return mv_jhash_3words( rule->fdbInfo.bridge,
|
||
|
0,*(MV_U32*)(rule->fdbInfo.mac+2), fp_ip_jhash_iv);
|
||
|
}
|
||
|
|
||
|
MV_STATUS mvFpFdbRuleSet(MV_FP_FDB_RULE *newrule)
|
||
|
{
|
||
|
int depth = 0;
|
||
|
MV_U32 hash;
|
||
|
MV_FP_FDB_RULE* rule;
|
||
|
|
||
|
/* ignore foreign ifindex */
|
||
|
if (newrule->fdbInfo.ifIndex >= ETH_FP_IFINDEX_MAX)
|
||
|
return MV_OUT_OF_RANGE;
|
||
|
|
||
|
hash = mvFpFdbRuleHash(newrule);
|
||
|
hash &= (fdbRuleDbSize - 1);
|
||
|
|
||
|
rule = fdbRuleDb[hash].ruleChain;
|
||
|
while (rule) {
|
||
|
if (!mvFpFdbRuleCmp(&rule->fdbInfo, &newrule->fdbInfo))
|
||
|
{
|
||
|
fdbRuleUpdateCount++;
|
||
|
goto out;
|
||
|
}
|
||
|
depth++;
|
||
|
rule = rule->next;
|
||
|
}
|
||
|
fdbRuleSetCount++;
|
||
|
if(depth > fdbHashMaxDepth)
|
||
|
fdbHashMaxDepth = depth;
|
||
|
|
||
|
rule = mvOsMalloc(sizeof(MV_FP_FDB_RULE));
|
||
|
|
||
|
if (!rule) {
|
||
|
mvOsPrintf("NFP (fdb): can't allocate new rule\n");
|
||
|
return MV_FAIL;
|
||
|
}
|
||
|
|
||
|
/* FIXME: No spinlocks */
|
||
|
rule->next = fdbRuleDb[hash].ruleChain;
|
||
|
fdbRuleDb[hash].ruleChain = rule;
|
||
|
out:
|
||
|
mvOsMemcpy(rule, newrule, sizeof(MV_FP_FDB_RULE));
|
||
|
|
||
|
if (rule->fdbInfo.flags & MV_FP_FDB_IS_LOCAL) {
|
||
|
fdbMember[rule->fdbInfo.ifIndex] = rule->fdbInfo.bridge;
|
||
|
fdbMember[rule->fdbInfo.bridge] = rule->fdbInfo.bridge;
|
||
|
}
|
||
|
|
||
|
MV_NFP_DBG("NFP (fdb): new bridge=%d ifIndex=%d %02X:%02X:%02X:%02X:%02X:%02X flags=%x\n",
|
||
|
rule->fdbInfo.bridge, rule->fdbInfo.ifIndex,
|
||
|
rule->fdbInfo.mac[0], rule->fdbInfo.mac[1], rule->fdbInfo.mac[2],
|
||
|
rule->fdbInfo.mac[3], rule->fdbInfo.mac[4], rule->fdbInfo.mac[5],
|
||
|
rule->fdbInfo.flags);
|
||
|
|
||
|
return MV_OK;
|
||
|
}
|
||
|
|
||
|
MV_STATUS mvFpFdbRuleDel(MV_FP_FDB_RULE *oldrule)
|
||
|
{
|
||
|
MV_U32 hash;
|
||
|
MV_FP_FDB_RULE* rule, *prev;
|
||
|
|
||
|
/* ignore foreign ifindex */
|
||
|
if (oldrule->fdbInfo.ifIndex >= ETH_FP_IFINDEX_MAX)
|
||
|
return MV_OUT_OF_RANGE;
|
||
|
|
||
|
if (oldrule->fdbInfo.flags & MV_FP_FDB_IS_LOCAL) {
|
||
|
fdbMember[oldrule->fdbInfo.ifIndex] = 0;
|
||
|
fdbMember[oldrule->fdbInfo.bridge] = 0;
|
||
|
MV_NFP_DBG("NFP (fdb): del member bridge=%d ifIndex=%d\n",
|
||
|
oldrule->fdbInfo.bridge, oldrule->fdbInfo.ifIndex);
|
||
|
}
|
||
|
|
||
|
hash = mvFpFdbRuleHash(oldrule);
|
||
|
hash &= (fdbRuleDbSize - 1);
|
||
|
|
||
|
rule = fdbRuleDb[hash].ruleChain;
|
||
|
prev = NULL;
|
||
|
|
||
|
while (rule) {
|
||
|
if (!mvFpFdbRuleCmp(&rule->fdbInfo, &oldrule->fdbInfo)) {
|
||
|
|
||
|
if (prev)
|
||
|
prev->next = rule->next;
|
||
|
else
|
||
|
fdbRuleDb[hash].ruleChain = rule->next;
|
||
|
|
||
|
fdbRuleDeleteCount++;
|
||
|
MV_NFP_DBG("NFP (fdb): del bridge=%d ifIndex=%d %02X:%02X:%02X:%02X:%02X:%02X flags=%x count=%d\n",
|
||
|
rule->fdbInfo.bridge, rule->fdbInfo.ifIndex,
|
||
|
rule->fdbInfo.mac[0], rule->fdbInfo.mac[1], rule->fdbInfo.mac[2],
|
||
|
rule->fdbInfo.mac[3], rule->fdbInfo.mac[4], rule->fdbInfo.mac[5],
|
||
|
rule->fdbInfo.flags, rule->mgmtInfo.new_count);
|
||
|
|
||
|
mvOsFree(rule);
|
||
|
return MV_OK;
|
||
|
}
|
||
|
|
||
|
prev = rule;
|
||
|
rule = rule->next;
|
||
|
}
|
||
|
|
||
|
return MV_NOT_FOUND;
|
||
|
}
|
||
|
|
||
|
MV_U32 mvFpFdbRuleAge(MV_FP_FDB_RULE *oldrule)
|
||
|
{
|
||
|
MV_U32 hash, age;
|
||
|
MV_FP_FDB_RULE* rule, *prev;
|
||
|
|
||
|
/* ignore foreign ifindex */
|
||
|
if (oldrule->fdbInfo.ifIndex >= ETH_FP_IFINDEX_MAX)
|
||
|
return 0;
|
||
|
|
||
|
hash = mvFpFdbRuleHash(oldrule);
|
||
|
hash &= (fdbRuleDbSize - 1);
|
||
|
|
||
|
rule = fdbRuleDb[hash].ruleChain;
|
||
|
prev = NULL;
|
||
|
|
||
|
while (rule) {
|
||
|
if (!mvFpFdbRuleCmp(&rule->fdbInfo, &oldrule->fdbInfo)) {
|
||
|
|
||
|
MV_NFP_DBG("NFP (fdb): age bridge=%d ifIndex=%d %02X:%02X:%02X:%02X:%02X:%02X flags=%x age=%d\n",
|
||
|
rule->fdbInfo.bridge, rule->fdbInfo.ifIndex,
|
||
|
rule->fdbInfo.mac[0], rule->fdbInfo.mac[1], rule->fdbInfo.mac[2],
|
||
|
rule->fdbInfo.mac[3], rule->fdbInfo.mac[4], rule->fdbInfo.mac[5],
|
||
|
rule->fdbInfo.flags, rule->mgmtInfo.new_count);
|
||
|
|
||
|
age = rule->mgmtInfo.new_count;
|
||
|
rule->mgmtInfo.new_count = 0;
|
||
|
return age;
|
||
|
|
||
|
}
|
||
|
|
||
|
prev = rule;
|
||
|
rule = rule->next;
|
||
|
}
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void mvFpFdbRulePrint(MV_FP_FDB_RULE *rule, MV_U32 hash)
|
||
|
{
|
||
|
mvOsPrintf("NFP (fdb): 0x%x bridge=%d ifIndex=%d %02X:%02X:%02X:%02X:%02X:%02X flags=%x count=%d\n",
|
||
|
mvFpFdbRuleHash((MV_FP_FDB_RULE*)rule),
|
||
|
rule->fdbInfo.bridge, rule->fdbInfo.ifIndex,
|
||
|
rule->fdbInfo.mac[0], rule->fdbInfo.mac[1], rule->fdbInfo.mac[2],
|
||
|
rule->fdbInfo.mac[3], rule->fdbInfo.mac[4], rule->fdbInfo.mac[5],
|
||
|
rule->fdbInfo.flags, rule->mgmtInfo.new_count);
|
||
|
}
|
||
|
|
||
|
MV_STATUS mvFpFdbPrint(void)
|
||
|
{
|
||
|
MV_U32 i = fdbRuleDbSize;
|
||
|
MV_FP_FDB_RULE *rule;
|
||
|
|
||
|
for (i=0; i<ETH_FP_IFINDEX_MAX; i++) {
|
||
|
if (fdbMember[i])
|
||
|
mvOsPrintf("NFP (fdb): bridge=%d ifIndex=%d\n",fdbMember[i],i);
|
||
|
}
|
||
|
|
||
|
for (i=0; i<fdbRuleDbSize; i++) {
|
||
|
rule = fdbRuleDb[i].ruleChain;
|
||
|
|
||
|
while (rule) {
|
||
|
mvFpFdbRulePrint(rule, i);
|
||
|
rule = rule->next;
|
||
|
}
|
||
|
}
|
||
|
return MV_OK;
|
||
|
}
|
||
|
|
||
|
|