1
2
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
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
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
169 return -EINVAL;
170}
171
