blob: 5670e4b7dfef8dfe6af7b06f0a10f88e27063bde [file] [log] [blame]
Greg Kroah-Hartmanb2441312017-11-01 15:07:57 +01001// SPDX-License-Identifier: GPL-2.0
Thomas Grafbfa83a92005-11-10 02:25:51 +01002/*
3 * NETLINK Netlink attributes
4 *
5 * Authors: Thomas Graf <tgraf@suug.ch>
6 * Alexey Kuznetsov <kuznet@ms2.inr.ac.ru>
7 */
8
Paul Gortmaker8bc3bcc2011-11-16 21:29:17 -05009#include <linux/export.h>
Thomas Grafbfa83a92005-11-10 02:25:51 +010010#include <linux/kernel.h>
11#include <linux/errno.h>
12#include <linux/jiffies.h>
Thomas Grafbfa83a92005-11-10 02:25:51 +010013#include <linux/skbuff.h>
14#include <linux/string.h>
15#include <linux/types.h>
16#include <net/netlink.h>
17
David Ahern6e237d02017-12-06 20:09:12 -080018/* For these data types, attribute length should be exactly the given
19 * size. However, to maintain compatibility with broken commands, if the
20 * attribute length does not match the expected size a warning is emitted
21 * to the user that the command is sending invalid data and needs to be fixed.
22 */
David Ahern28033ae2017-11-07 21:59:40 -080023static const u8 nla_attr_len[NLA_TYPE_MAX+1] = {
Thomas Grafbfa83a92005-11-10 02:25:51 +010024 [NLA_U8] = sizeof(u8),
25 [NLA_U16] = sizeof(u16),
26 [NLA_U32] = sizeof(u32),
27 [NLA_U64] = sizeof(u64),
Julian Anastasov9eca2eb2012-08-25 22:47:57 +000028 [NLA_S8] = sizeof(s8),
29 [NLA_S16] = sizeof(s16),
30 [NLA_S32] = sizeof(s32),
31 [NLA_S64] = sizeof(s64),
Thomas Grafbfa83a92005-11-10 02:25:51 +010032};
33
David Ahern28033ae2017-11-07 21:59:40 -080034static const u8 nla_attr_minlen[NLA_TYPE_MAX+1] = {
David Ahern6e237d02017-12-06 20:09:12 -080035 [NLA_U8] = sizeof(u8),
36 [NLA_U16] = sizeof(u16),
37 [NLA_U32] = sizeof(u32),
38 [NLA_U64] = sizeof(u64),
David Ahern28033ae2017-11-07 21:59:40 -080039 [NLA_MSECS] = sizeof(u64),
40 [NLA_NESTED] = NLA_HDRLEN,
David Ahern6e237d02017-12-06 20:09:12 -080041 [NLA_S8] = sizeof(s8),
42 [NLA_S16] = sizeof(s16),
43 [NLA_S32] = sizeof(s32),
44 [NLA_S64] = sizeof(s64),
David Ahern28033ae2017-11-07 21:59:40 -080045};
46
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -040047static int validate_nla_bitfield32(const struct nlattr *nla,
Johannes Berg48fde902018-09-26 11:15:31 +020048 const u32 *valid_flags_mask)
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -040049{
50 const struct nla_bitfield32 *bf = nla_data(nla);
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -040051
Johannes Berg48fde902018-09-26 11:15:31 +020052 if (!valid_flags_mask)
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -040053 return -EINVAL;
54
55 /*disallow invalid bit selector */
56 if (bf->selector & ~*valid_flags_mask)
57 return -EINVAL;
58
59 /*disallow invalid bit values */
60 if (bf->value & ~*valid_flags_mask)
61 return -EINVAL;
62
63 /*disallow valid bit values that are not selected*/
64 if (bf->value & ~bf->selector)
65 return -EINVAL;
66
67 return 0;
68}
69
Johannes Berg1501d132018-09-26 11:15:34 +020070static int nla_validate_array(const struct nlattr *head, int len, int maxtype,
71 const struct nla_policy *policy,
72 struct netlink_ext_ack *extack)
73{
74 const struct nlattr *entry;
75 int rem;
76
77 nla_for_each_attr(entry, head, len, rem) {
78 int ret;
79
80 if (nla_len(entry) == 0)
81 continue;
82
83 if (nla_len(entry) < NLA_HDRLEN) {
84 NL_SET_ERR_MSG_ATTR(extack, entry,
85 "Array element too short");
86 return -ERANGE;
87 }
88
89 ret = nla_validate(nla_data(entry), nla_len(entry),
90 maxtype, policy, extack);
91 if (ret < 0)
92 return ret;
93 }
94
95 return 0;
96}
97
Johannes Berg3e48be02018-09-27 11:28:35 +020098static int nla_validate_int_range(const struct nla_policy *pt,
99 const struct nlattr *nla,
100 struct netlink_ext_ack *extack)
101{
102 bool validate_min, validate_max;
103 s64 value;
104
105 validate_min = pt->validation_type == NLA_VALIDATE_RANGE ||
106 pt->validation_type == NLA_VALIDATE_MIN;
107 validate_max = pt->validation_type == NLA_VALIDATE_RANGE ||
108 pt->validation_type == NLA_VALIDATE_MAX;
109
110 switch (pt->type) {
111 case NLA_U8:
112 value = nla_get_u8(nla);
113 break;
114 case NLA_U16:
115 value = nla_get_u16(nla);
116 break;
117 case NLA_U32:
118 value = nla_get_u32(nla);
119 break;
120 case NLA_S8:
121 value = nla_get_s8(nla);
122 break;
123 case NLA_S16:
124 value = nla_get_s16(nla);
125 break;
126 case NLA_S32:
127 value = nla_get_s32(nla);
128 break;
129 case NLA_S64:
130 value = nla_get_s64(nla);
131 break;
132 case NLA_U64:
133 /* treat this one specially, since it may not fit into s64 */
134 if ((validate_min && nla_get_u64(nla) < pt->min) ||
135 (validate_max && nla_get_u64(nla) > pt->max)) {
136 NL_SET_ERR_MSG_ATTR(extack, nla,
137 "integer out of range");
138 return -ERANGE;
139 }
140 return 0;
141 default:
142 WARN_ON(1);
143 return -EINVAL;
144 }
145
146 if ((validate_min && value < pt->min) ||
147 (validate_max && value > pt->max)) {
148 NL_SET_ERR_MSG_ATTR(extack, nla,
149 "integer out of range");
150 return -ERANGE;
151 }
152
153 return 0;
154}
155
Jan Engelhardt36546542010-11-16 09:52:32 -0800156static int validate_nla(const struct nlattr *nla, int maxtype,
Johannes Berg568b7422018-09-17 11:57:28 +0200157 const struct nla_policy *policy,
Johannes Bergc29f1842018-09-26 11:15:32 +0200158 struct netlink_ext_ack *extack)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100159{
Patrick McHardyef7c79e2007-06-05 12:38:30 -0700160 const struct nla_policy *pt;
Thomas Graf8f4c1f92007-09-12 14:44:36 +0200161 int minlen = 0, attrlen = nla_len(nla), type = nla_type(nla);
Johannes Bergc29f1842018-09-26 11:15:32 +0200162 int err = -ERANGE;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100163
Thomas Graf8f4c1f92007-09-12 14:44:36 +0200164 if (type <= 0 || type > maxtype)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100165 return 0;
166
Thomas Graf8f4c1f92007-09-12 14:44:36 +0200167 pt = &policy[type];
Thomas Grafbfa83a92005-11-10 02:25:51 +0100168
169 BUG_ON(pt->type > NLA_TYPE_MAX);
170
Johannes Bergb60b87f2018-09-17 11:57:29 +0200171 if ((nla_attr_len[pt->type] && attrlen != nla_attr_len[pt->type]) ||
172 (pt->type == NLA_EXACT_LEN_WARN && attrlen != pt->len)) {
David Ahern6e237d02017-12-06 20:09:12 -0800173 pr_warn_ratelimited("netlink: '%s': attribute type %d has an invalid length.\n",
174 current->comm, type);
David Ahern28033ae2017-11-07 21:59:40 -0800175 }
176
Thomas Grafa5531a52006-08-26 20:11:47 -0700177 switch (pt->type) {
Johannes Bergb60b87f2018-09-17 11:57:29 +0200178 case NLA_EXACT_LEN:
179 if (attrlen != pt->len)
Johannes Bergc29f1842018-09-26 11:15:32 +0200180 goto out_err;
Johannes Bergb60b87f2018-09-17 11:57:29 +0200181 break;
182
Johannes Berg568b7422018-09-17 11:57:28 +0200183 case NLA_REJECT:
Johannes Bergc29f1842018-09-26 11:15:32 +0200184 if (extack && pt->validation_data) {
185 NL_SET_BAD_ATTR(extack, nla);
186 extack->_msg = pt->validation_data;
187 return -EINVAL;
188 }
189 err = -EINVAL;
190 goto out_err;
Johannes Berg568b7422018-09-17 11:57:28 +0200191
Thomas Grafa5531a52006-08-26 20:11:47 -0700192 case NLA_FLAG:
193 if (attrlen > 0)
Johannes Bergc29f1842018-09-26 11:15:32 +0200194 goto out_err;
Thomas Grafa5531a52006-08-26 20:11:47 -0700195 break;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100196
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -0400197 case NLA_BITFIELD32:
198 if (attrlen != sizeof(struct nla_bitfield32))
Johannes Bergc29f1842018-09-26 11:15:32 +0200199 goto out_err;
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -0400200
Johannes Bergc29f1842018-09-26 11:15:32 +0200201 err = validate_nla_bitfield32(nla, pt->validation_data);
202 if (err)
203 goto out_err;
204 break;
Jamal Hadi Salim64c83d82017-07-30 13:24:49 -0400205
Thomas Grafa5531a52006-08-26 20:11:47 -0700206 case NLA_NUL_STRING:
207 if (pt->len)
208 minlen = min_t(int, attrlen, pt->len + 1);
209 else
210 minlen = attrlen;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100211
Johannes Bergc29f1842018-09-26 11:15:32 +0200212 if (!minlen || memchr(nla_data(nla), '\0', minlen) == NULL) {
213 err = -EINVAL;
214 goto out_err;
215 }
Thomas Grafa5531a52006-08-26 20:11:47 -0700216 /* fall through */
217
218 case NLA_STRING:
219 if (attrlen < 1)
Johannes Bergc29f1842018-09-26 11:15:32 +0200220 goto out_err;
Thomas Grafa5531a52006-08-26 20:11:47 -0700221
222 if (pt->len) {
223 char *buf = nla_data(nla);
224
225 if (buf[attrlen - 1] == '\0')
226 attrlen--;
227
228 if (attrlen > pt->len)
Johannes Bergc29f1842018-09-26 11:15:32 +0200229 goto out_err;
Thomas Grafa5531a52006-08-26 20:11:47 -0700230 }
231 break;
232
Johannes Bergd30045a2007-03-23 11:37:48 -0700233 case NLA_BINARY:
234 if (pt->len && attrlen > pt->len)
Johannes Bergc29f1842018-09-26 11:15:32 +0200235 goto out_err;
Johannes Bergd30045a2007-03-23 11:37:48 -0700236 break;
237
Patrick McHardyea5693c2008-11-28 03:05:19 -0800238 case NLA_NESTED:
239 /* a nested attributes is allowed to be empty; if its not,
240 * it must have a size of at least NLA_HDRLEN.
241 */
242 if (attrlen == 0)
243 break;
Johannes Berg9a659a32018-09-26 11:15:33 +0200244 if (attrlen < NLA_HDRLEN)
245 goto out_err;
246 if (pt->validation_data) {
247 err = nla_validate(nla_data(nla), nla_len(nla), pt->len,
248 pt->validation_data, extack);
249 if (err < 0) {
250 /*
251 * return directly to preserve the inner
252 * error message/attribute pointer
253 */
254 return err;
255 }
256 }
257 break;
Johannes Berg1501d132018-09-26 11:15:34 +0200258 case NLA_NESTED_ARRAY:
259 /* a nested array attribute is allowed to be empty; if its not,
260 * it must have a size of at least NLA_HDRLEN.
261 */
262 if (attrlen == 0)
263 break;
264 if (attrlen < NLA_HDRLEN)
265 goto out_err;
266 if (pt->validation_data) {
267 int err;
268
269 err = nla_validate_array(nla_data(nla), nla_len(nla),
270 pt->len, pt->validation_data,
271 extack);
272 if (err < 0) {
273 /*
274 * return directly to preserve the inner
275 * error message/attribute pointer
276 */
277 return err;
278 }
279 }
280 break;
Thomas Grafa5531a52006-08-26 20:11:47 -0700281 default:
282 if (pt->len)
283 minlen = pt->len;
284 else if (pt->type != NLA_UNSPEC)
285 minlen = nla_attr_minlen[pt->type];
286
287 if (attrlen < minlen)
Johannes Bergc29f1842018-09-26 11:15:32 +0200288 goto out_err;
Thomas Grafa5531a52006-08-26 20:11:47 -0700289 }
Thomas Grafbfa83a92005-11-10 02:25:51 +0100290
Johannes Berg3e48be02018-09-27 11:28:35 +0200291 /* further validation */
292 switch (pt->validation_type) {
293 case NLA_VALIDATE_NONE:
294 /* nothing to do */
295 break;
296 case NLA_VALIDATE_RANGE:
297 case NLA_VALIDATE_MIN:
298 case NLA_VALIDATE_MAX:
299 err = nla_validate_int_range(pt, nla, extack);
300 if (err)
301 return err;
302 break;
303 }
304
Thomas Grafbfa83a92005-11-10 02:25:51 +0100305 return 0;
Johannes Bergc29f1842018-09-26 11:15:32 +0200306out_err:
307 NL_SET_ERR_MSG_ATTR(extack, nla, "Attribute failed policy validation");
308 return err;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100309}
310
311/**
312 * nla_validate - Validate a stream of attributes
313 * @head: head of attribute stream
314 * @len: length of attribute stream
315 * @maxtype: maximum attribute type to be expected
316 * @policy: validation policy
Johannes Bergfceb6432017-04-12 14:34:07 +0200317 * @extack: extended ACK report struct
Thomas Grafbfa83a92005-11-10 02:25:51 +0100318 *
319 * Validates all attributes in the specified attribute stream against the
320 * specified policy. Attributes with a type exceeding maxtype will be
321 * ignored. See documenation of struct nla_policy for more details.
322 *
323 * Returns 0 on success or a negative error code.
324 */
Jan Engelhardt36546542010-11-16 09:52:32 -0800325int nla_validate(const struct nlattr *head, int len, int maxtype,
Johannes Bergfceb6432017-04-12 14:34:07 +0200326 const struct nla_policy *policy,
327 struct netlink_ext_ack *extack)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100328{
Jan Engelhardt36546542010-11-16 09:52:32 -0800329 const struct nlattr *nla;
Johannes Bergfceb6432017-04-12 14:34:07 +0200330 int rem;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100331
332 nla_for_each_attr(nla, head, len, rem) {
Johannes Bergc29f1842018-09-26 11:15:32 +0200333 int err = validate_nla(nla, maxtype, policy, extack);
Johannes Bergfceb6432017-04-12 14:34:07 +0200334
Johannes Bergc29f1842018-09-26 11:15:32 +0200335 if (err < 0)
Johannes Bergfceb6432017-04-12 14:34:07 +0200336 return err;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100337 }
338
Johannes Bergfceb6432017-04-12 14:34:07 +0200339 return 0;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100340}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700341EXPORT_SYMBOL(nla_validate);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100342
343/**
Holger Eitzenbergere487eb992009-03-25 18:26:30 +0100344 * nla_policy_len - Determin the max. length of a policy
345 * @policy: policy to use
346 * @n: number of policies
347 *
348 * Determines the max. length of the policy. It is currently used
349 * to allocated Netlink buffers roughly the size of the actual
350 * message.
351 *
352 * Returns 0 on success or a negative error code.
353 */
354int
355nla_policy_len(const struct nla_policy *p, int n)
356{
357 int i, len = 0;
358
Lars Ellenberge3fa3af2011-02-28 12:38:25 -0800359 for (i = 0; i < n; i++, p++) {
Holger Eitzenbergere487eb992009-03-25 18:26:30 +0100360 if (p->len)
361 len += nla_total_size(p->len);
David Ahern28033ae2017-11-07 21:59:40 -0800362 else if (nla_attr_len[p->type])
363 len += nla_total_size(nla_attr_len[p->type]);
Holger Eitzenbergere487eb992009-03-25 18:26:30 +0100364 else if (nla_attr_minlen[p->type])
365 len += nla_total_size(nla_attr_minlen[p->type]);
366 }
367
368 return len;
369}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700370EXPORT_SYMBOL(nla_policy_len);
Holger Eitzenbergere487eb992009-03-25 18:26:30 +0100371
372/**
Thomas Grafbfa83a92005-11-10 02:25:51 +0100373 * nla_parse - Parse a stream of attributes into a tb buffer
374 * @tb: destination array with maxtype+1 elements
375 * @maxtype: maximum attribute type to be expected
376 * @head: head of attribute stream
377 * @len: length of attribute stream
Julius Volz10b595a2008-06-27 20:02:14 -0700378 * @policy: validation policy
Thomas Grafbfa83a92005-11-10 02:25:51 +0100379 *
380 * Parses a stream of attributes and stores a pointer to each attribute in
Uwe Kleine-Königb5950762010-11-01 15:38:34 -0400381 * the tb array accessible via the attribute type. Attributes with a type
Thomas Grafbfa83a92005-11-10 02:25:51 +0100382 * exceeding maxtype will be silently ignored for backwards compatibility
383 * reasons. policy may be set to NULL if no validation is required.
384 *
385 * Returns 0 on success or a negative error code.
386 */
Jan Engelhardt36546542010-11-16 09:52:32 -0800387int nla_parse(struct nlattr **tb, int maxtype, const struct nlattr *head,
Johannes Bergfceb6432017-04-12 14:34:07 +0200388 int len, const struct nla_policy *policy,
389 struct netlink_ext_ack *extack)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100390{
Jan Engelhardt36546542010-11-16 09:52:32 -0800391 const struct nlattr *nla;
Johannes Bergc29f1842018-09-26 11:15:32 +0200392 int rem;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100393
394 memset(tb, 0, sizeof(struct nlattr *) * (maxtype + 1));
395
396 nla_for_each_attr(nla, head, len, rem) {
Thomas Graf8f4c1f92007-09-12 14:44:36 +0200397 u16 type = nla_type(nla);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100398
399 if (type > 0 && type <= maxtype) {
400 if (policy) {
Johannes Bergc29f1842018-09-26 11:15:32 +0200401 int err = validate_nla(nla, maxtype, policy,
402 extack);
403
404 if (err < 0)
405 return err;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100406 }
407
Jan Engelhardt36546542010-11-16 09:52:32 -0800408 tb[type] = (struct nlattr *)nla;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100409 }
410 }
411
412 if (unlikely(rem > 0))
Michal Schmidtbfc51842014-06-02 18:25:02 +0200413 pr_warn_ratelimited("netlink: %d bytes leftover after parsing attributes in process `%s'.\n",
414 rem, current->comm);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100415
Johannes Bergc29f1842018-09-26 11:15:32 +0200416 return 0;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100417}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700418EXPORT_SYMBOL(nla_parse);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100419
420/**
421 * nla_find - Find a specific attribute in a stream of attributes
422 * @head: head of attribute stream
423 * @len: length of attribute stream
424 * @attrtype: type of attribute to look for
425 *
426 * Returns the first attribute in the stream matching the specified type.
427 */
Jan Engelhardt36546542010-11-16 09:52:32 -0800428struct nlattr *nla_find(const struct nlattr *head, int len, int attrtype)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100429{
Jan Engelhardt36546542010-11-16 09:52:32 -0800430 const struct nlattr *nla;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100431 int rem;
432
433 nla_for_each_attr(nla, head, len, rem)
Thomas Graf8f4c1f92007-09-12 14:44:36 +0200434 if (nla_type(nla) == attrtype)
Jan Engelhardt36546542010-11-16 09:52:32 -0800435 return (struct nlattr *)nla;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100436
437 return NULL;
438}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700439EXPORT_SYMBOL(nla_find);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100440
441/**
442 * nla_strlcpy - Copy string attribute payload into a sized buffer
443 * @dst: where to copy the string to
Julius Volz10b595a2008-06-27 20:02:14 -0700444 * @nla: attribute to copy the string from
Thomas Grafbfa83a92005-11-10 02:25:51 +0100445 * @dstsize: size of destination buffer
446 *
447 * Copies at most dstsize - 1 bytes into the destination buffer.
448 * The result is always a valid NUL-terminated string. Unlike
449 * strlcpy the destination buffer is always padded out.
450 *
451 * Returns the length of the source buffer.
452 */
453size_t nla_strlcpy(char *dst, const struct nlattr *nla, size_t dstsize)
454{
455 size_t srclen = nla_len(nla);
456 char *src = nla_data(nla);
457
458 if (srclen > 0 && src[srclen - 1] == '\0')
459 srclen--;
460
461 if (dstsize > 0) {
462 size_t len = (srclen >= dstsize) ? dstsize - 1 : srclen;
463
464 memset(dst, 0, dstsize);
465 memcpy(dst, src, len);
466 }
467
468 return srclen;
469}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700470EXPORT_SYMBOL(nla_strlcpy);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100471
472/**
Phil Sutter2cf0c8b2017-07-27 16:56:40 +0200473 * nla_strdup - Copy string attribute payload into a newly allocated buffer
474 * @nla: attribute to copy the string from
475 * @flags: the type of memory to allocate (see kmalloc).
476 *
477 * Returns a pointer to the allocated buffer or NULL on error.
478 */
479char *nla_strdup(const struct nlattr *nla, gfp_t flags)
480{
481 size_t srclen = nla_len(nla);
482 char *src = nla_data(nla), *dst;
483
484 if (srclen > 0 && src[srclen - 1] == '\0')
485 srclen--;
486
487 dst = kmalloc(srclen + 1, flags);
488 if (dst != NULL) {
489 memcpy(dst, src, srclen);
490 dst[srclen] = '\0';
491 }
492 return dst;
493}
494EXPORT_SYMBOL(nla_strdup);
495
496/**
Thomas Grafbfa83a92005-11-10 02:25:51 +0100497 * nla_memcpy - Copy a netlink attribute into another memory area
498 * @dest: where to copy to memcpy
499 * @src: netlink attribute to copy from
500 * @count: size of the destination area
501 *
502 * Note: The number of bytes copied is limited by the length of
503 * attribute's payload. memcpy
504 *
505 * Returns the number of bytes copied.
506 */
Patrick McHardyb057efd2008-10-28 11:59:11 -0700507int nla_memcpy(void *dest, const struct nlattr *src, int count)
Thomas Grafbfa83a92005-11-10 02:25:51 +0100508{
509 int minlen = min_t(int, count, nla_len(src));
510
511 memcpy(dest, nla_data(src), minlen);
Jiri Benc5899f042015-03-29 16:05:28 +0200512 if (count > minlen)
513 memset(dest + minlen, 0, count - minlen);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100514
515 return minlen;
516}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700517EXPORT_SYMBOL(nla_memcpy);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100518
519/**
520 * nla_memcmp - Compare an attribute with sized memory area
521 * @nla: netlink attribute
522 * @data: memory area
523 * @size: size of memory area
524 */
525int nla_memcmp(const struct nlattr *nla, const void *data,
526 size_t size)
527{
528 int d = nla_len(nla) - size;
529
530 if (d == 0)
531 d = memcmp(nla_data(nla), data, size);
532
533 return d;
534}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700535EXPORT_SYMBOL(nla_memcmp);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100536
537/**
538 * nla_strcmp - Compare a string attribute against a string
539 * @nla: netlink string attribute
540 * @str: another string
541 */
542int nla_strcmp(const struct nlattr *nla, const char *str)
543{
Pablo Neira8b7b9322014-04-01 19:38:44 +0200544 int len = strlen(str);
545 char *buf = nla_data(nla);
546 int attrlen = nla_len(nla);
547 int d;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100548
Pablo Neira8b7b9322014-04-01 19:38:44 +0200549 if (attrlen > 0 && buf[attrlen - 1] == '\0')
550 attrlen--;
551
552 d = attrlen - len;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100553 if (d == 0)
554 d = memcmp(nla_data(nla), str, len);
555
556 return d;
557}
Fabian Frederick6d6a1382014-06-04 16:11:57 -0700558EXPORT_SYMBOL(nla_strcmp);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100559
Herbert Xu90800212009-03-11 23:18:32 +0800560#ifdef CONFIG_NET
Thomas Grafbfa83a92005-11-10 02:25:51 +0100561/**
562 * __nla_reserve - reserve room for attribute on the skb
563 * @skb: socket buffer to reserve room on
564 * @attrtype: attribute type
565 * @attrlen: length of attribute payload
566 *
567 * Adds a netlink attribute header to a socket buffer and reserves
568 * room for the payload but does not copy it.
569 *
570 * The caller is responsible to ensure that the skb provides enough
571 * tailroom for the attribute header and payload.
572 */
573struct nlattr *__nla_reserve(struct sk_buff *skb, int attrtype, int attrlen)
574{
575 struct nlattr *nla;
576
Johannes Berg4df864c2017-06-16 14:29:21 +0200577 nla = skb_put(skb, nla_total_size(attrlen));
Thomas Grafbfa83a92005-11-10 02:25:51 +0100578 nla->nla_type = attrtype;
579 nla->nla_len = nla_attr_size(attrlen);
580
581 memset((unsigned char *) nla + nla->nla_len, 0, nla_padlen(attrlen));
582
583 return nla;
584}
Herbert Xu90800212009-03-11 23:18:32 +0800585EXPORT_SYMBOL(__nla_reserve);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100586
587/**
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200588 * __nla_reserve_64bit - reserve room for attribute on the skb and align it
589 * @skb: socket buffer to reserve room on
590 * @attrtype: attribute type
591 * @attrlen: length of attribute payload
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200592 * @padattr: attribute type for the padding
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200593 *
594 * Adds a netlink attribute header to a socket buffer and reserves
595 * room for the payload but does not copy it. It also ensure that this
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200596 * attribute will have a 64-bit aligned nla_data() area.
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200597 *
598 * The caller is responsible to ensure that the skb provides enough
599 * tailroom for the attribute header and payload.
600 */
601struct nlattr *__nla_reserve_64bit(struct sk_buff *skb, int attrtype,
602 int attrlen, int padattr)
603{
604 if (nla_need_padding_for_64bit(skb))
605 nla_align_64bit(skb, padattr);
606
607 return __nla_reserve(skb, attrtype, attrlen);
608}
609EXPORT_SYMBOL(__nla_reserve_64bit);
610
611/**
Thomas Graffe4944e2006-08-04 23:03:05 -0700612 * __nla_reserve_nohdr - reserve room for attribute without header
613 * @skb: socket buffer to reserve room on
614 * @attrlen: length of attribute payload
615 *
616 * Reserves room for attribute payload without a header.
617 *
618 * The caller is responsible to ensure that the skb provides enough
619 * tailroom for the payload.
620 */
621void *__nla_reserve_nohdr(struct sk_buff *skb, int attrlen)
622{
yuan linyub952f4d2017-06-18 22:52:04 +0800623 return skb_put_zero(skb, NLA_ALIGN(attrlen));
Thomas Graffe4944e2006-08-04 23:03:05 -0700624}
Herbert Xu90800212009-03-11 23:18:32 +0800625EXPORT_SYMBOL(__nla_reserve_nohdr);
Thomas Graffe4944e2006-08-04 23:03:05 -0700626
627/**
Thomas Grafbfa83a92005-11-10 02:25:51 +0100628 * nla_reserve - reserve room for attribute on the skb
629 * @skb: socket buffer to reserve room on
630 * @attrtype: attribute type
631 * @attrlen: length of attribute payload
632 *
633 * Adds a netlink attribute header to a socket buffer and reserves
634 * room for the payload but does not copy it.
635 *
636 * Returns NULL if the tailroom of the skb is insufficient to store
637 * the attribute header and payload.
638 */
639struct nlattr *nla_reserve(struct sk_buff *skb, int attrtype, int attrlen)
640{
641 if (unlikely(skb_tailroom(skb) < nla_total_size(attrlen)))
642 return NULL;
643
644 return __nla_reserve(skb, attrtype, attrlen);
645}
Herbert Xu90800212009-03-11 23:18:32 +0800646EXPORT_SYMBOL(nla_reserve);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100647
648/**
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200649 * nla_reserve_64bit - reserve room for attribute on the skb and align it
650 * @skb: socket buffer to reserve room on
651 * @attrtype: attribute type
652 * @attrlen: length of attribute payload
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200653 * @padattr: attribute type for the padding
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200654 *
655 * Adds a netlink attribute header to a socket buffer and reserves
656 * room for the payload but does not copy it. It also ensure that this
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200657 * attribute will have a 64-bit aligned nla_data() area.
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200658 *
659 * Returns NULL if the tailroom of the skb is insufficient to store
660 * the attribute header and payload.
661 */
662struct nlattr *nla_reserve_64bit(struct sk_buff *skb, int attrtype, int attrlen,
663 int padattr)
664{
665 size_t len;
666
667 if (nla_need_padding_for_64bit(skb))
668 len = nla_total_size_64bit(attrlen);
669 else
670 len = nla_total_size(attrlen);
671 if (unlikely(skb_tailroom(skb) < len))
672 return NULL;
673
674 return __nla_reserve_64bit(skb, attrtype, attrlen, padattr);
675}
676EXPORT_SYMBOL(nla_reserve_64bit);
677
678/**
Julius Volz10b595a2008-06-27 20:02:14 -0700679 * nla_reserve_nohdr - reserve room for attribute without header
Thomas Graffe4944e2006-08-04 23:03:05 -0700680 * @skb: socket buffer to reserve room on
Julius Volz10b595a2008-06-27 20:02:14 -0700681 * @attrlen: length of attribute payload
Thomas Graffe4944e2006-08-04 23:03:05 -0700682 *
683 * Reserves room for attribute payload without a header.
684 *
685 * Returns NULL if the tailroom of the skb is insufficient to store
686 * the attribute payload.
687 */
688void *nla_reserve_nohdr(struct sk_buff *skb, int attrlen)
689{
690 if (unlikely(skb_tailroom(skb) < NLA_ALIGN(attrlen)))
691 return NULL;
692
693 return __nla_reserve_nohdr(skb, attrlen);
694}
Herbert Xu90800212009-03-11 23:18:32 +0800695EXPORT_SYMBOL(nla_reserve_nohdr);
Thomas Graffe4944e2006-08-04 23:03:05 -0700696
697/**
Thomas Grafbfa83a92005-11-10 02:25:51 +0100698 * __nla_put - Add a netlink attribute to a socket buffer
699 * @skb: socket buffer to add attribute to
700 * @attrtype: attribute type
701 * @attrlen: length of attribute payload
702 * @data: head of attribute payload
703 *
704 * The caller is responsible to ensure that the skb provides enough
705 * tailroom for the attribute header and payload.
706 */
707void __nla_put(struct sk_buff *skb, int attrtype, int attrlen,
708 const void *data)
709{
710 struct nlattr *nla;
711
712 nla = __nla_reserve(skb, attrtype, attrlen);
713 memcpy(nla_data(nla), data, attrlen);
714}
Herbert Xu90800212009-03-11 23:18:32 +0800715EXPORT_SYMBOL(__nla_put);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100716
Thomas Graffe4944e2006-08-04 23:03:05 -0700717/**
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200718 * __nla_put_64bit - Add a netlink attribute to a socket buffer and align it
719 * @skb: socket buffer to add attribute to
720 * @attrtype: attribute type
721 * @attrlen: length of attribute payload
722 * @data: head of attribute payload
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200723 * @padattr: attribute type for the padding
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200724 *
725 * The caller is responsible to ensure that the skb provides enough
726 * tailroom for the attribute header and payload.
727 */
728void __nla_put_64bit(struct sk_buff *skb, int attrtype, int attrlen,
729 const void *data, int padattr)
730{
731 struct nlattr *nla;
732
733 nla = __nla_reserve_64bit(skb, attrtype, attrlen, padattr);
734 memcpy(nla_data(nla), data, attrlen);
735}
736EXPORT_SYMBOL(__nla_put_64bit);
737
738/**
Thomas Graffe4944e2006-08-04 23:03:05 -0700739 * __nla_put_nohdr - Add a netlink attribute without header
740 * @skb: socket buffer to add attribute to
741 * @attrlen: length of attribute payload
742 * @data: head of attribute payload
743 *
744 * The caller is responsible to ensure that the skb provides enough
745 * tailroom for the attribute payload.
746 */
747void __nla_put_nohdr(struct sk_buff *skb, int attrlen, const void *data)
748{
749 void *start;
750
751 start = __nla_reserve_nohdr(skb, attrlen);
752 memcpy(start, data, attrlen);
753}
Herbert Xu90800212009-03-11 23:18:32 +0800754EXPORT_SYMBOL(__nla_put_nohdr);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100755
756/**
757 * nla_put - Add a netlink attribute to a socket buffer
758 * @skb: socket buffer to add attribute to
759 * @attrtype: attribute type
760 * @attrlen: length of attribute payload
761 * @data: head of attribute payload
762 *
Thomas Grafbc3ed282008-06-03 16:36:54 -0700763 * Returns -EMSGSIZE if the tailroom of the skb is insufficient to store
Thomas Grafbfa83a92005-11-10 02:25:51 +0100764 * the attribute header and payload.
765 */
766int nla_put(struct sk_buff *skb, int attrtype, int attrlen, const void *data)
767{
768 if (unlikely(skb_tailroom(skb) < nla_total_size(attrlen)))
Thomas Grafbc3ed282008-06-03 16:36:54 -0700769 return -EMSGSIZE;
Thomas Grafbfa83a92005-11-10 02:25:51 +0100770
771 __nla_put(skb, attrtype, attrlen, data);
772 return 0;
773}
Herbert Xu90800212009-03-11 23:18:32 +0800774EXPORT_SYMBOL(nla_put);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100775
Thomas Graffe4944e2006-08-04 23:03:05 -0700776/**
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200777 * nla_put_64bit - Add a netlink attribute to a socket buffer and align it
778 * @skb: socket buffer to add attribute to
779 * @attrtype: attribute type
780 * @attrlen: length of attribute payload
781 * @data: head of attribute payload
Nicolas Dichtel11a99572016-04-22 17:31:16 +0200782 * @padattr: attribute type for the padding
Nicolas Dichtel089bf1a2016-04-21 18:58:24 +0200783 *
784 * Returns -EMSGSIZE if the tailroom of the skb is insufficient to store
785 * the attribute header and payload.
786 */
787int nla_put_64bit(struct sk_buff *skb, int attrtype, int attrlen,
788 const void *data, int padattr)
789{
790 size_t len;
791
792 if (nla_need_padding_for_64bit(skb))
793 len = nla_total_size_64bit(attrlen);
794 else
795 len = nla_total_size(attrlen);
796 if (unlikely(skb_tailroom(skb) < len))
797 return -EMSGSIZE;
798
799 __nla_put_64bit(skb, attrtype, attrlen, data, padattr);
800 return 0;
801}
802EXPORT_SYMBOL(nla_put_64bit);
803
804/**
Thomas Graffe4944e2006-08-04 23:03:05 -0700805 * nla_put_nohdr - Add a netlink attribute without header
806 * @skb: socket buffer to add attribute to
807 * @attrlen: length of attribute payload
808 * @data: head of attribute payload
809 *
Thomas Grafbc3ed282008-06-03 16:36:54 -0700810 * Returns -EMSGSIZE if the tailroom of the skb is insufficient to store
Thomas Graffe4944e2006-08-04 23:03:05 -0700811 * the attribute payload.
812 */
813int nla_put_nohdr(struct sk_buff *skb, int attrlen, const void *data)
814{
815 if (unlikely(skb_tailroom(skb) < NLA_ALIGN(attrlen)))
Thomas Grafbc3ed282008-06-03 16:36:54 -0700816 return -EMSGSIZE;
Thomas Graffe4944e2006-08-04 23:03:05 -0700817
818 __nla_put_nohdr(skb, attrlen, data);
819 return 0;
820}
Herbert Xu90800212009-03-11 23:18:32 +0800821EXPORT_SYMBOL(nla_put_nohdr);
Thomas Grafbfa83a92005-11-10 02:25:51 +0100822
Patrick McHardy01480e12008-01-22 22:10:59 -0800823/**
824 * nla_append - Add a netlink attribute without header or padding
825 * @skb: socket buffer to add attribute to
826 * @attrlen: length of attribute payload
827 * @data: head of attribute payload
828 *
Thomas Grafbc3ed282008-06-03 16:36:54 -0700829 * Returns -EMSGSIZE if the tailroom of the skb is insufficient to store
Patrick McHardy01480e12008-01-22 22:10:59 -0800830 * the attribute payload.
831 */
832int nla_append(struct sk_buff *skb, int attrlen, const void *data)
833{
834 if (unlikely(skb_tailroom(skb) < NLA_ALIGN(attrlen)))
Thomas Grafbc3ed282008-06-03 16:36:54 -0700835 return -EMSGSIZE;
Patrick McHardy01480e12008-01-22 22:10:59 -0800836
Johannes Berg59ae1d12017-06-16 14:29:20 +0200837 skb_put_data(skb, data, attrlen);
Patrick McHardy01480e12008-01-22 22:10:59 -0800838 return 0;
839}
Herbert Xu90800212009-03-11 23:18:32 +0800840EXPORT_SYMBOL(nla_append);
841#endif