171 lines · c
1// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)2/* Copyright (C) 2018 Netronome Systems, Inc. */3 4#include <linux/bitfield.h>5#include <linux/device.h>6#include <linux/kernel.h>7#include <linux/types.h>8 9#include "nfp_net_ctrl.h"10#include "nfp_net.h"11 12static void nfp_net_tlv_caps_reset(struct nfp_net_tlv_caps *caps)13{14 memset(caps, 0, sizeof(*caps));15 caps->me_freq_mhz = 1200;16 caps->mbox_off = NFP_NET_CFG_MBOX_BASE;17 caps->mbox_len = NFP_NET_CFG_MBOX_VAL_MAX_SZ;18}19 20static bool21nfp_net_tls_parse_crypto_ops(struct device *dev, struct nfp_net_tlv_caps *caps,22 u8 __iomem *ctrl_mem, u8 __iomem *data,23 unsigned int length, unsigned int offset,24 bool rx_stream_scan)25{26 /* Ignore the legacy TLV if new one was already parsed */27 if (caps->tls_resync_ss && !rx_stream_scan)28 return true;29 30 if (length < 32) {31 dev_err(dev,32 "CRYPTO OPS TLV should be at least 32B, is %dB offset:%u\n",33 length, offset);34 return false;35 }36 37 caps->crypto_ops = readl(data);38 caps->crypto_enable_off = data - ctrl_mem + 16;39 caps->tls_resync_ss = rx_stream_scan;40 41 return true;42}43 44int nfp_net_tlv_caps_parse(struct device *dev, u8 __iomem *ctrl_mem,45 struct nfp_net_tlv_caps *caps)46{47 u8 __iomem *data = ctrl_mem + NFP_NET_CFG_TLV_BASE;48 u8 __iomem *end = ctrl_mem + NFP_NET_CFG_BAR_SZ;49 u32 hdr;50 51 nfp_net_tlv_caps_reset(caps);52 53 hdr = readl(data);54 if (!hdr)55 return 0;56 57 while (true) {58 unsigned int length, offset;59 u32 hdr = readl(data);60 61 length = FIELD_GET(NFP_NET_CFG_TLV_HEADER_LENGTH, hdr);62 offset = data - ctrl_mem;63 64 /* Advance past the header */65 data += 4;66 67 if (length % NFP_NET_CFG_TLV_LENGTH_INC) {68 dev_err(dev, "TLV size not multiple of %u offset:%u len:%u\n",69 NFP_NET_CFG_TLV_LENGTH_INC, offset, length);70 return -EINVAL;71 }72 if (data + length > end) {73 dev_err(dev, "oversized TLV offset:%u len:%u\n",74 offset, length);75 return -EINVAL;76 }77 78 switch (FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr)) {79 case NFP_NET_CFG_TLV_TYPE_UNKNOWN:80 dev_err(dev, "NULL TLV at offset:%u\n", offset);81 return -EINVAL;82 case NFP_NET_CFG_TLV_TYPE_RESERVED:83 break;84 case NFP_NET_CFG_TLV_TYPE_END:85 if (!length)86 return 0;87 88 dev_err(dev, "END TLV should be empty, has offset:%u len:%d\n",89 offset, length);90 return -EINVAL;91 case NFP_NET_CFG_TLV_TYPE_ME_FREQ:92 if (length != 4) {93 dev_err(dev,94 "ME FREQ TLV should be 4B, is %dB offset:%u\n",95 length, offset);96 return -EINVAL;97 }98 99 caps->me_freq_mhz = readl(data);100 break;101 case NFP_NET_CFG_TLV_TYPE_MBOX:102 if (!length) {103 caps->mbox_off = 0;104 caps->mbox_len = 0;105 } else {106 caps->mbox_off = data - ctrl_mem;107 caps->mbox_len = length;108 }109 break;110 case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL0:111 case NFP_NET_CFG_TLV_TYPE_EXPERIMENTAL1:112 dev_warn(dev,113 "experimental TLV type:%u offset:%u len:%u\n",114 FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr),115 offset, length);116 break;117 case NFP_NET_CFG_TLV_TYPE_REPR_CAP:118 if (length < 4) {119 dev_err(dev, "REPR CAP TLV short %dB < 4B offset:%u\n",120 length, offset);121 return -EINVAL;122 }123 124 caps->repr_cap = readl(data);125 break;126 case NFP_NET_CFG_TLV_TYPE_MBOX_CMSG_TYPES:127 if (length >= 4)128 caps->mbox_cmsg_types = readl(data);129 break;130 case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS:131 if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem,132 data, length, offset,133 false))134 return -EINVAL;135 break;136 case NFP_NET_CFG_TLV_TYPE_VNIC_STATS:137 if ((data - ctrl_mem) % 8) {138 dev_warn(dev, "VNIC STATS TLV misaligned, ignoring offset:%u len:%u\n",139 offset, length);140 break;141 }142 caps->vnic_stats_off = data - ctrl_mem;143 caps->vnic_stats_cnt = length / 10;144 break;145 case NFP_NET_CFG_TLV_TYPE_CRYPTO_OPS_RX_SCAN:146 if (!nfp_net_tls_parse_crypto_ops(dev, caps, ctrl_mem,147 data, length, offset,148 true))149 return -EINVAL;150 break;151 default:152 if (!FIELD_GET(NFP_NET_CFG_TLV_HEADER_REQUIRED, hdr))153 break;154 155 dev_err(dev, "unknown TLV type:%u offset:%u len:%u\n",156 FIELD_GET(NFP_NET_CFG_TLV_HEADER_TYPE, hdr),157 offset, length);158 return -EINVAL;159 }160 161 data += length;162 if (data + 4 > end) {163 dev_err(dev, "reached end of BAR without END TLV\n");164 return -EINVAL;165 }166 }167 168 /* Not reached */169 return -EINVAL;170}171