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 
nfp_net_tlv_caps_reset(struct nfp_net_tlv_caps * caps)12 static 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 
20 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)21 nfp_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 
nfp_net_tlv_caps_parse(struct device * dev,u8 __iomem * ctrl_mem,struct nfp_net_tlv_caps * caps)44 int 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