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 bool
21nfp_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