137 lines
3.3 KiB
C
137 lines
3.3 KiB
C
// 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;
|
|
}
|
|
|
|
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 (length < 32) {
|
|
dev_err(dev,
|
|
"CRYPTO OPS TLV should be at least 32B, is %dB offset:%u\n",
|
|
length, offset);
|
|
return -EINVAL;
|
|
}
|
|
|
|
caps->crypto_ops = readl(data);
|
|
caps->crypto_enable_off = data - ctrl_mem + 16;
|
|
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;
|
|
}
|