forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
170 lines
4.2 KiB
170 lines
4.2 KiB
// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause) |
|
/* Copyright (C) 2018 Netronome Systems, Inc. */ |
|
|
|
#include <linux/bitfield.h> |
|
#include <linux/device.h> |
|
#include <linux/kernel.h> |
|
#include <linux/types.h> |
|
|
|
#include "nfp_net_ctrl.h" |
|
#include "nfp_net.h" |
|
|
|
static void nfp_net_tlv_caps_reset(struct nfp_net_tlv_caps *caps) |
|
{ |
|
memset(caps, 0, sizeof(*caps)); |
|
caps->me_freq_mhz = 1200; |
|
caps->mbox_off = NFP_NET_CFG_MBOX_BASE; |
|
caps->mbox_len = NFP_NET_CFG_MBOX_VAL_MAX_SZ; |
|
} |
|
|
|
static bool |
|
nfp_net_tls_parse_crypto_ops(struct device *dev, struct nfp_net_tlv_caps *caps, |
|
u8 __iomem *ctrl_mem, u8 __iomem *data, |
|
unsigned int length, unsigned int offset, |
|
bool rx_stream_scan) |
|
{ |
|
/* Ignore the legacy TLV if new one was already parsed */ |
|
if (caps->tls_resync_ss && !rx_stream_scan) |
|
return true; |
|
|
|
if (length < 32) { |
|
dev_err(dev, |
|
"CRYPTO OPS TLV should be at least 32B, is %dB offset:%u\n", |
|
length, offset); |
|
return false; |
|
} |
|
|
|
caps->crypto_ops = readl(data); |
|
caps->crypto_enable_off = data - ctrl_mem + 16; |
|
caps->tls_resync_ss = rx_stream_scan; |
|
|
|
return true; |
|
} |
|
|
|
int nfp_net_tlv_caps_parse(struct device *dev, u8 __iomem *ctrl_mem, |
|
struct nfp_net_tlv_caps *caps) |
|
{ |
|
u8 __iomem *data = ctrl_mem + NFP_NET_CFG_TLV_BASE; |
|
u8 __iomem *end = ctrl_mem + NFP_NET_CFG_BAR_SZ; |
|
u32 hdr; |
|
|
|
nfp_net_tlv_caps_reset(caps); |
|
|
|
hdr = readl(data); |
|
if (!hdr) |
|
return 0; |
|
|
|
while (true) { |
|
unsigned int length, offset; |
|
u32 hdr = readl(data); |
|
|
|
length = FIELD_GET(NFP_NET_CFG_TLV_HEADER_LENGTH, hdr); |
|
offset = data - ctrl_mem; |
|
|
|
/* Advance past the header */ |
|
data += 4; |
|
|
|
if (length % NFP_NET_CFG_TLV_LENGTH_INC) { |
|
dev_err(dev, "TLV size not multiple of %u offset:%u len:%u\n", |
|
NFP_NET_CFG_TLV_LENGTH_INC, offset, length); |
|
return -EINVAL; |
|
} |
|
if (data + length > end) { |
|
dev_err(dev, "oversized TLV offset:%u len:%u\n", |
|
offset, length); |
|
return -EINVAL; |
|
} |
|
|
|
switch (FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr)) { |
|
case NFP_NET_CFG_TLV_TYPE_UNKNOWN: |
|
dev_err(dev, "NULL TLV at offset:%u\n", offset); |
|
return -EINVAL; |
|
case NFP_NET_CFG_TLV_TYPE_RESERVED: |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_END: |
|
if (!length) |
|
return 0; |
|
|
|
dev_err(dev, "END TLV should be empty, has offset:%u len:%d\n", |
|
offset, length); |
|
return -EINVAL; |
|
case NFP_NET_CFG_TLV_TYPE_ME_FREQ: |
|
if (length != 4) { |
|
dev_err(dev, |
|
"ME FREQ TLV should be 4B, is %dB offset:%u\n", |
|
length, offset); |
|
return -EINVAL; |
|
} |
|
|
|
caps->me_freq_mhz = readl(data); |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_MBOX: |
|
if (!length) { |
|
caps->mbox_off = 0; |
|
caps->mbox_len = 0; |
|
} else { |
|
caps->mbox_off = data - ctrl_mem; |
|
caps->mbox_len = length; |
|
} |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL0: |
|
case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL1: |
|
dev_warn(dev, |
|
"experimental TLV type:%u offset:%u len:%u\n", |
|
FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr), |
|
offset, length); |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_REPR_CAP: |
|
if (length < 4) { |
|
dev_err(dev, "REPR CAP TLV short %dB < 4B offset:%u\n", |
|
length, offset); |
|
return -EINVAL; |
|
} |
|
|
|
caps->repr_cap = readl(data); |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_MBOX_CMSG_TYPES: |
|
if (length >= 4) |
|
caps->mbox_cmsg_types = readl(data); |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS: |
|
if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem, |
|
data, length, offset, |
|
false)) |
|
return -EINVAL; |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_VNIC_STATS: |
|
if ((data - ctrl_mem) % 8) { |
|
dev_warn(dev, "VNIC STATS TLV misaligned, ignoring offset:%u len:%u\n", |
|
offset, length); |
|
break; |
|
} |
|
caps->vnic_stats_off = data - ctrl_mem; |
|
caps->vnic_stats_cnt = length / 10; |
|
break; |
|
case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS_RX_SCAN: |
|
if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem, |
|
data, length, offset, |
|
true)) |
|
return -EINVAL; |
|
break; |
|
default: |
|
if (!FIELD_GET(NFP_NET_CFG_TLV_HEADER_REQUIRED, hdr)) |
|
break; |
|
|
|
dev_err(dev, "unknown TLV type:%u offset:%u len:%u\n", |
|
FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr), |
|
offset, length); |
|
return -EINVAL; |
|
} |
|
|
|
data += length; |
|
if (data + 4 > end) { |
|
dev_err(dev, "reached end of BAR without END TLV\n"); |
|
return -EINVAL; |
|
} |
|
} |
|
|
|
/* Not reached */ |
|
return -EINVAL; |
|
}
|
|
|