xref: /openbmc/linux/include/net/netlink.h (revision 1045b03e)
1 #ifndef __NET_NETLINK_H
2 #define __NET_NETLINK_H
3 
4 #include <linux/types.h>
5 #include <linux/netlink.h>
6 #include <linux/jiffies.h>
7 
8 /* ========================================================================
9  *         Netlink Messages and Attributes Interface (As Seen On TV)
10  * ------------------------------------------------------------------------
11  *                          Messages Interface
12  * ------------------------------------------------------------------------
13  *
14  * Message Format:
15  *    <--- nlmsg_total_size(payload)  --->
16  *    <-- nlmsg_msg_size(payload) ->
17  *   +----------+- - -+-------------+- - -+-------- - -
18  *   | nlmsghdr | Pad |   Payload   | Pad | nlmsghdr
19  *   +----------+- - -+-------------+- - -+-------- - -
20  *   nlmsg_data(nlh)---^                   ^
21  *   nlmsg_next(nlh)-----------------------+
22  *
23  * Payload Format:
24  *    <---------------------- nlmsg_len(nlh) --------------------->
25  *    <------ hdrlen ------>       <- nlmsg_attrlen(nlh, hdrlen) ->
26  *   +----------------------+- - -+--------------------------------+
27  *   |     Family Header    | Pad |           Attributes           |
28  *   +----------------------+- - -+--------------------------------+
29  *   nlmsg_attrdata(nlh, hdrlen)---^
30  *
31  * Data Structures:
32  *   struct nlmsghdr			netlink message header
33  *
34  * Message Construction:
35  *   nlmsg_new()			create a new netlink message
36  *   nlmsg_put()			add a netlink message to an skb
37  *   nlmsg_put_answer()			callback based nlmsg_put()
38  *   nlmsg_end()			finanlize netlink message
39  *   nlmsg_get_pos()			return current position in message
40  *   nlmsg_trim()			trim part of message
41  *   nlmsg_cancel()			cancel message construction
42  *   nlmsg_free()			free a netlink message
43  *
44  * Message Sending:
45  *   nlmsg_multicast()			multicast message to several groups
46  *   nlmsg_unicast()			unicast a message to a single socket
47  *   nlmsg_notify()			send notification message
48  *
49  * Message Length Calculations:
50  *   nlmsg_msg_size(payload)		length of message w/o padding
51  *   nlmsg_total_size(payload)		length of message w/ padding
52  *   nlmsg_padlen(payload)		length of padding at tail
53  *
54  * Message Payload Access:
55  *   nlmsg_data(nlh)			head of message payload
56  *   nlmsg_len(nlh)			length of message payload
57  *   nlmsg_attrdata(nlh, hdrlen)	head of attributes data
58  *   nlmsg_attrlen(nlh, hdrlen)		length of attributes data
59  *
60  * Message Parsing:
61  *   nlmsg_ok(nlh, remaining)		does nlh fit into remaining bytes?
62  *   nlmsg_next(nlh, remaining)		get next netlink message
63  *   nlmsg_parse()			parse attributes of a message
64  *   nlmsg_find_attr()			find an attribute in a message
65  *   nlmsg_for_each_msg()		loop over all messages
66  *   nlmsg_validate()			validate netlink message incl. attrs
67  *   nlmsg_for_each_attr()		loop over all attributes
68  *
69  * Misc:
70  *   nlmsg_report()			report back to application?
71  *
72  * ------------------------------------------------------------------------
73  *                          Attributes Interface
74  * ------------------------------------------------------------------------
75  *
76  * Attribute Format:
77  *    <------- nla_total_size(payload) ------->
78  *    <---- nla_attr_size(payload) ----->
79  *   +----------+- - -+- - - - - - - - - +- - -+-------- - -
80  *   |  Header  | Pad |     Payload      | Pad |  Header
81  *   +----------+- - -+- - - - - - - - - +- - -+-------- - -
82  *                     <- nla_len(nla) ->      ^
83  *   nla_data(nla)----^                        |
84  *   nla_next(nla)-----------------------------'
85  *
86  * Data Structures:
87  *   struct nlattr			netlink attribute header
88  *
89  * Attribute Construction:
90  *   nla_reserve(skb, type, len)	reserve room for an attribute
91  *   nla_reserve_nohdr(skb, len)	reserve room for an attribute w/o hdr
92  *   nla_put(skb, type, len, data)	add attribute to skb
93  *   nla_put_nohdr(skb, len, data)	add attribute w/o hdr
94  *   nla_append(skb, len, data)		append data to skb
95  *
96  * Attribute Construction for Basic Types:
97  *   nla_put_u8(skb, type, value)	add u8 attribute to skb
98  *   nla_put_u16(skb, type, value)	add u16 attribute to skb
99  *   nla_put_u32(skb, type, value)	add u32 attribute to skb
100  *   nla_put_u64(skb, type, value)	add u64 attribute to skb
101  *   nla_put_string(skb, type, str)	add string attribute to skb
102  *   nla_put_flag(skb, type)		add flag attribute to skb
103  *   nla_put_msecs(skb, type, jiffies)	add msecs attribute to skb
104  *
105  * Exceptions Based Attribute Construction:
106  *   NLA_PUT(skb, type, len, data)	add attribute to skb
107  *   NLA_PUT_U8(skb, type, value)	add u8 attribute to skb
108  *   NLA_PUT_U16(skb, type, value)	add u16 attribute to skb
109  *   NLA_PUT_U32(skb, type, value)	add u32 attribute to skb
110  *   NLA_PUT_U64(skb, type, value)	add u64 attribute to skb
111  *   NLA_PUT_STRING(skb, type, str)	add string attribute to skb
112  *   NLA_PUT_FLAG(skb, type)		add flag attribute to skb
113  *   NLA_PUT_MSECS(skb, type, jiffies)	add msecs attribute to skb
114  *
115  *   The meaning of these functions is equal to their lower case
116  *   variants but they jump to the label nla_put_failure in case
117  *   of a failure.
118  *
119  * Nested Attributes Construction:
120  *   nla_nest_start(skb, type)		start a nested attribute
121  *   nla_nest_end(skb, nla)		finalize a nested attribute
122  *   nla_nest_compat_start(skb, type,	start a nested compat attribute
123  *			   len, data)
124  *   nla_nest_compat_end(skb, type)	finalize a nested compat attribute
125  *   nla_nest_cancel(skb, nla)		cancel nested attribute construction
126  *
127  * Attribute Length Calculations:
128  *   nla_attr_size(payload)		length of attribute w/o padding
129  *   nla_total_size(payload)		length of attribute w/ padding
130  *   nla_padlen(payload)		length of padding
131  *
132  * Attribute Payload Access:
133  *   nla_data(nla)			head of attribute payload
134  *   nla_len(nla)			length of attribute payload
135  *
136  * Attribute Payload Access for Basic Types:
137  *   nla_get_u8(nla)			get payload for a u8 attribute
138  *   nla_get_u16(nla)			get payload for a u16 attribute
139  *   nla_get_u32(nla)			get payload for a u32 attribute
140  *   nla_get_u64(nla)			get payload for a u64 attribute
141  *   nla_get_flag(nla)			return 1 if flag is true
142  *   nla_get_msecs(nla)			get payload for a msecs attribute
143  *
144  * Attribute Misc:
145  *   nla_memcpy(dest, nla, count)	copy attribute into memory
146  *   nla_memcmp(nla, data, size)	compare attribute with memory area
147  *   nla_strlcpy(dst, nla, size)	copy attribute to a sized string
148  *   nla_strcmp(nla, str)		compare attribute with string
149  *
150  * Attribute Parsing:
151  *   nla_ok(nla, remaining)		does nla fit into remaining bytes?
152  *   nla_next(nla, remaining)		get next netlink attribute
153  *   nla_validate()			validate a stream of attributes
154  *   nla_validate_nested()		validate a stream of nested attributes
155  *   nla_find()				find attribute in stream of attributes
156  *   nla_find_nested()			find attribute in nested attributes
157  *   nla_parse()			parse and validate stream of attrs
158  *   nla_parse_nested()			parse nested attribuets
159  *   nla_parse_nested_compat()		parse nested compat attributes
160  *   nla_for_each_attr()		loop over all attributes
161  *   nla_for_each_nested()		loop over the nested attributes
162  *=========================================================================
163  */
164 
165  /**
166   * Standard attribute types to specify validation policy
167   */
168 enum {
169 	NLA_UNSPEC,
170 	NLA_U8,
171 	NLA_U16,
172 	NLA_U32,
173 	NLA_U64,
174 	NLA_STRING,
175 	NLA_FLAG,
176 	NLA_MSECS,
177 	NLA_NESTED,
178 	NLA_NESTED_COMPAT,
179 	NLA_NUL_STRING,
180 	NLA_BINARY,
181 	__NLA_TYPE_MAX,
182 };
183 
184 #define NLA_TYPE_MAX (__NLA_TYPE_MAX - 1)
185 
186 /**
187  * struct nla_policy - attribute validation policy
188  * @type: Type of attribute or NLA_UNSPEC
189  * @len: Type specific length of payload
190  *
191  * Policies are defined as arrays of this struct, the array must be
192  * accessible by attribute type up to the highest identifier to be expected.
193  *
194  * Meaning of `len' field:
195  *    NLA_STRING           Maximum length of string
196  *    NLA_NUL_STRING       Maximum length of string (excluding NUL)
197  *    NLA_FLAG             Unused
198  *    NLA_BINARY           Maximum length of attribute payload
199  *    NLA_NESTED_COMPAT    Exact length of structure payload
200  *    All other            Exact length of attribute payload
201  *
202  * Example:
203  * static struct nla_policy my_policy[ATTR_MAX+1] __read_mostly = {
204  * 	[ATTR_FOO] = { .type = NLA_U16 },
205  *	[ATTR_BAR] = { .type = NLA_STRING, .len = BARSIZ },
206  *	[ATTR_BAZ] = { .len = sizeof(struct mystruct) },
207  * };
208  */
209 struct nla_policy {
210 	u16		type;
211 	u16		len;
212 };
213 
214 /**
215  * struct nl_info - netlink source information
216  * @nlh: Netlink message header of original request
217  * @pid: Netlink PID of requesting application
218  */
219 struct nl_info {
220 	struct nlmsghdr		*nlh;
221 	struct net		*nl_net;
222 	u32			pid;
223 };
224 
225 extern int		netlink_rcv_skb(struct sk_buff *skb,
226 					int (*cb)(struct sk_buff *,
227 						  struct nlmsghdr *));
228 extern int		nlmsg_notify(struct sock *sk, struct sk_buff *skb,
229 				     u32 pid, unsigned int group, int report,
230 				     gfp_t flags);
231 
232 extern int		nla_validate(struct nlattr *head, int len, int maxtype,
233 				     const struct nla_policy *policy);
234 extern int		nla_parse(struct nlattr *tb[], int maxtype,
235 				  struct nlattr *head, int len,
236 				  const struct nla_policy *policy);
237 extern struct nlattr *	nla_find(struct nlattr *head, int len, int attrtype);
238 extern size_t		nla_strlcpy(char *dst, const struct nlattr *nla,
239 				    size_t dstsize);
240 extern int		nla_memcpy(void *dest, struct nlattr *src, int count);
241 extern int		nla_memcmp(const struct nlattr *nla, const void *data,
242 				   size_t size);
243 extern int		nla_strcmp(const struct nlattr *nla, const char *str);
244 extern struct nlattr *	__nla_reserve(struct sk_buff *skb, int attrtype,
245 				      int attrlen);
246 extern void *		__nla_reserve_nohdr(struct sk_buff *skb, int attrlen);
247 extern struct nlattr *	nla_reserve(struct sk_buff *skb, int attrtype,
248 				    int attrlen);
249 extern void *		nla_reserve_nohdr(struct sk_buff *skb, int attrlen);
250 extern void		__nla_put(struct sk_buff *skb, int attrtype,
251 				  int attrlen, const void *data);
252 extern void		__nla_put_nohdr(struct sk_buff *skb, int attrlen,
253 					const void *data);
254 extern int		nla_put(struct sk_buff *skb, int attrtype,
255 				int attrlen, const void *data);
256 extern int		nla_put_nohdr(struct sk_buff *skb, int attrlen,
257 				      const void *data);
258 extern int		nla_append(struct sk_buff *skb, int attrlen,
259 				   const void *data);
260 
261 /**************************************************************************
262  * Netlink Messages
263  **************************************************************************/
264 
265 /**
266  * nlmsg_msg_size - length of netlink message not including padding
267  * @payload: length of message payload
268  */
269 static inline int nlmsg_msg_size(int payload)
270 {
271 	return NLMSG_HDRLEN + payload;
272 }
273 
274 /**
275  * nlmsg_total_size - length of netlink message including padding
276  * @payload: length of message payload
277  */
278 static inline int nlmsg_total_size(int payload)
279 {
280 	return NLMSG_ALIGN(nlmsg_msg_size(payload));
281 }
282 
283 /**
284  * nlmsg_padlen - length of padding at the message's tail
285  * @payload: length of message payload
286  */
287 static inline int nlmsg_padlen(int payload)
288 {
289 	return nlmsg_total_size(payload) - nlmsg_msg_size(payload);
290 }
291 
292 /**
293  * nlmsg_data - head of message payload
294  * @nlh: netlink messsage header
295  */
296 static inline void *nlmsg_data(const struct nlmsghdr *nlh)
297 {
298 	return (unsigned char *) nlh + NLMSG_HDRLEN;
299 }
300 
301 /**
302  * nlmsg_len - length of message payload
303  * @nlh: netlink message header
304  */
305 static inline int nlmsg_len(const struct nlmsghdr *nlh)
306 {
307 	return nlh->nlmsg_len - NLMSG_HDRLEN;
308 }
309 
310 /**
311  * nlmsg_attrdata - head of attributes data
312  * @nlh: netlink message header
313  * @hdrlen: length of family specific header
314  */
315 static inline struct nlattr *nlmsg_attrdata(const struct nlmsghdr *nlh,
316 					    int hdrlen)
317 {
318 	unsigned char *data = nlmsg_data(nlh);
319 	return (struct nlattr *) (data + NLMSG_ALIGN(hdrlen));
320 }
321 
322 /**
323  * nlmsg_attrlen - length of attributes data
324  * @nlh: netlink message header
325  * @hdrlen: length of family specific header
326  */
327 static inline int nlmsg_attrlen(const struct nlmsghdr *nlh, int hdrlen)
328 {
329 	return nlmsg_len(nlh) - NLMSG_ALIGN(hdrlen);
330 }
331 
332 /**
333  * nlmsg_ok - check if the netlink message fits into the remaining bytes
334  * @nlh: netlink message header
335  * @remaining: number of bytes remaining in message stream
336  */
337 static inline int nlmsg_ok(const struct nlmsghdr *nlh, int remaining)
338 {
339 	return (remaining >= sizeof(struct nlmsghdr) &&
340 		nlh->nlmsg_len >= sizeof(struct nlmsghdr) &&
341 		nlh->nlmsg_len <= remaining);
342 }
343 
344 /**
345  * nlmsg_next - next netlink message in message stream
346  * @nlh: netlink message header
347  * @remaining: number of bytes remaining in message stream
348  *
349  * Returns the next netlink message in the message stream and
350  * decrements remaining by the size of the current message.
351  */
352 static inline struct nlmsghdr *nlmsg_next(struct nlmsghdr *nlh, int *remaining)
353 {
354 	int totlen = NLMSG_ALIGN(nlh->nlmsg_len);
355 
356 	*remaining -= totlen;
357 
358 	return (struct nlmsghdr *) ((unsigned char *) nlh + totlen);
359 }
360 
361 /**
362  * nlmsg_parse - parse attributes of a netlink message
363  * @nlh: netlink message header
364  * @hdrlen: length of family specific header
365  * @tb: destination array with maxtype+1 elements
366  * @maxtype: maximum attribute type to be expected
367  * @policy: validation policy
368  *
369  * See nla_parse()
370  */
371 static inline int nlmsg_parse(struct nlmsghdr *nlh, int hdrlen,
372 			      struct nlattr *tb[], int maxtype,
373 			      const struct nla_policy *policy)
374 {
375 	if (nlh->nlmsg_len < nlmsg_msg_size(hdrlen))
376 		return -EINVAL;
377 
378 	return nla_parse(tb, maxtype, nlmsg_attrdata(nlh, hdrlen),
379 			 nlmsg_attrlen(nlh, hdrlen), policy);
380 }
381 
382 /**
383  * nlmsg_find_attr - find a specific attribute in a netlink message
384  * @nlh: netlink message header
385  * @hdrlen: length of familiy specific header
386  * @attrtype: type of attribute to look for
387  *
388  * Returns the first attribute which matches the specified type.
389  */
390 static inline struct nlattr *nlmsg_find_attr(struct nlmsghdr *nlh,
391 					     int hdrlen, int attrtype)
392 {
393 	return nla_find(nlmsg_attrdata(nlh, hdrlen),
394 			nlmsg_attrlen(nlh, hdrlen), attrtype);
395 }
396 
397 /**
398  * nlmsg_validate - validate a netlink message including attributes
399  * @nlh: netlinket message header
400  * @hdrlen: length of familiy specific header
401  * @maxtype: maximum attribute type to be expected
402  * @policy: validation policy
403  */
404 static inline int nlmsg_validate(struct nlmsghdr *nlh, int hdrlen, int maxtype,
405 				 const struct nla_policy *policy)
406 {
407 	if (nlh->nlmsg_len < nlmsg_msg_size(hdrlen))
408 		return -EINVAL;
409 
410 	return nla_validate(nlmsg_attrdata(nlh, hdrlen),
411 			    nlmsg_attrlen(nlh, hdrlen), maxtype, policy);
412 }
413 
414 /**
415  * nlmsg_report - need to report back to application?
416  * @nlh: netlink message header
417  *
418  * Returns 1 if a report back to the application is requested.
419  */
420 static inline int nlmsg_report(struct nlmsghdr *nlh)
421 {
422 	return !!(nlh->nlmsg_flags & NLM_F_ECHO);
423 }
424 
425 /**
426  * nlmsg_for_each_attr - iterate over a stream of attributes
427  * @pos: loop counter, set to current attribute
428  * @nlh: netlink message header
429  * @hdrlen: length of familiy specific header
430  * @rem: initialized to len, holds bytes currently remaining in stream
431  */
432 #define nlmsg_for_each_attr(pos, nlh, hdrlen, rem) \
433 	nla_for_each_attr(pos, nlmsg_attrdata(nlh, hdrlen), \
434 			  nlmsg_attrlen(nlh, hdrlen), rem)
435 
436 #if 0
437 /* FIXME: Enable once all users have been converted */
438 
439 /**
440  * __nlmsg_put - Add a new netlink message to an skb
441  * @skb: socket buffer to store message in
442  * @pid: netlink process id
443  * @seq: sequence number of message
444  * @type: message type
445  * @payload: length of message payload
446  * @flags: message flags
447  *
448  * The caller is responsible to ensure that the skb provides enough
449  * tailroom for both the netlink header and payload.
450  */
451 static inline struct nlmsghdr *__nlmsg_put(struct sk_buff *skb, u32 pid,
452 					   u32 seq, int type, int payload,
453 					   int flags)
454 {
455 	struct nlmsghdr *nlh;
456 
457 	nlh = (struct nlmsghdr *) skb_put(skb, nlmsg_total_size(payload));
458 	nlh->nlmsg_type = type;
459 	nlh->nlmsg_len = nlmsg_msg_size(payload);
460 	nlh->nlmsg_flags = flags;
461 	nlh->nlmsg_pid = pid;
462 	nlh->nlmsg_seq = seq;
463 
464 	memset((unsigned char *) nlmsg_data(nlh) + payload, 0,
465 	       nlmsg_padlen(payload));
466 
467 	return nlh;
468 }
469 #endif
470 
471 /**
472  * nlmsg_put - Add a new netlink message to an skb
473  * @skb: socket buffer to store message in
474  * @pid: netlink process id
475  * @seq: sequence number of message
476  * @type: message type
477  * @payload: length of message payload
478  * @flags: message flags
479  *
480  * Returns NULL if the tailroom of the skb is insufficient to store
481  * the message header and payload.
482  */
483 static inline struct nlmsghdr *nlmsg_put(struct sk_buff *skb, u32 pid, u32 seq,
484 					 int type, int payload, int flags)
485 {
486 	if (unlikely(skb_tailroom(skb) < nlmsg_total_size(payload)))
487 		return NULL;
488 
489 	return __nlmsg_put(skb, pid, seq, type, payload, flags);
490 }
491 
492 /**
493  * nlmsg_put_answer - Add a new callback based netlink message to an skb
494  * @skb: socket buffer to store message in
495  * @cb: netlink callback
496  * @type: message type
497  * @payload: length of message payload
498  * @flags: message flags
499  *
500  * Returns NULL if the tailroom of the skb is insufficient to store
501  * the message header and payload.
502  */
503 static inline struct nlmsghdr *nlmsg_put_answer(struct sk_buff *skb,
504 						struct netlink_callback *cb,
505 						int type, int payload,
506 						int flags)
507 {
508 	return nlmsg_put(skb, NETLINK_CB(cb->skb).pid, cb->nlh->nlmsg_seq,
509 			 type, payload, flags);
510 }
511 
512 /**
513  * nlmsg_new - Allocate a new netlink message
514  * @payload: size of the message payload
515  * @flags: the type of memory to allocate.
516  *
517  * Use NLMSG_DEFAULT_SIZE if the size of the payload isn't known
518  * and a good default is needed.
519  */
520 static inline struct sk_buff *nlmsg_new(size_t payload, gfp_t flags)
521 {
522 	return alloc_skb(nlmsg_total_size(payload), flags);
523 }
524 
525 /**
526  * nlmsg_end - Finalize a netlink message
527  * @skb: socket buffer the message is stored in
528  * @nlh: netlink message header
529  *
530  * Corrects the netlink message header to include the appeneded
531  * attributes. Only necessary if attributes have been added to
532  * the message.
533  *
534  * Returns the total data length of the skb.
535  */
536 static inline int nlmsg_end(struct sk_buff *skb, struct nlmsghdr *nlh)
537 {
538 	nlh->nlmsg_len = skb_tail_pointer(skb) - (unsigned char *)nlh;
539 
540 	return skb->len;
541 }
542 
543 /**
544  * nlmsg_get_pos - return current position in netlink message
545  * @skb: socket buffer the message is stored in
546  *
547  * Returns a pointer to the current tail of the message.
548  */
549 static inline void *nlmsg_get_pos(struct sk_buff *skb)
550 {
551 	return skb_tail_pointer(skb);
552 }
553 
554 /**
555  * nlmsg_trim - Trim message to a mark
556  * @skb: socket buffer the message is stored in
557  * @mark: mark to trim to
558  *
559  * Trims the message to the provided mark.
560  */
561 static inline void nlmsg_trim(struct sk_buff *skb, const void *mark)
562 {
563 	if (mark)
564 		skb_trim(skb, (unsigned char *) mark - skb->data);
565 }
566 
567 /**
568  * nlmsg_cancel - Cancel construction of a netlink message
569  * @skb: socket buffer the message is stored in
570  * @nlh: netlink message header
571  *
572  * Removes the complete netlink message including all
573  * attributes from the socket buffer again.
574  */
575 static inline void nlmsg_cancel(struct sk_buff *skb, struct nlmsghdr *nlh)
576 {
577 	nlmsg_trim(skb, nlh);
578 }
579 
580 /**
581  * nlmsg_free - free a netlink message
582  * @skb: socket buffer of netlink message
583  */
584 static inline void nlmsg_free(struct sk_buff *skb)
585 {
586 	kfree_skb(skb);
587 }
588 
589 /**
590  * nlmsg_multicast - multicast a netlink message
591  * @sk: netlink socket to spread messages to
592  * @skb: netlink message as socket buffer
593  * @pid: own netlink pid to avoid sending to yourself
594  * @group: multicast group id
595  * @flags: allocation flags
596  */
597 static inline int nlmsg_multicast(struct sock *sk, struct sk_buff *skb,
598 				  u32 pid, unsigned int group, gfp_t flags)
599 {
600 	int err;
601 
602 	NETLINK_CB(skb).dst_group = group;
603 
604 	err = netlink_broadcast(sk, skb, pid, group, flags);
605 	if (err > 0)
606 		err = 0;
607 
608 	return err;
609 }
610 
611 /**
612  * nlmsg_unicast - unicast a netlink message
613  * @sk: netlink socket to spread message to
614  * @skb: netlink message as socket buffer
615  * @pid: netlink pid of the destination socket
616  */
617 static inline int nlmsg_unicast(struct sock *sk, struct sk_buff *skb, u32 pid)
618 {
619 	int err;
620 
621 	err = netlink_unicast(sk, skb, pid, MSG_DONTWAIT);
622 	if (err > 0)
623 		err = 0;
624 
625 	return err;
626 }
627 
628 /**
629  * nlmsg_for_each_msg - iterate over a stream of messages
630  * @pos: loop counter, set to current message
631  * @head: head of message stream
632  * @len: length of message stream
633  * @rem: initialized to len, holds bytes currently remaining in stream
634  */
635 #define nlmsg_for_each_msg(pos, head, len, rem) \
636 	for (pos = head, rem = len; \
637 	     nlmsg_ok(pos, rem); \
638 	     pos = nlmsg_next(pos, &(rem)))
639 
640 /**************************************************************************
641  * Netlink Attributes
642  **************************************************************************/
643 
644 /**
645  * nla_attr_size - length of attribute not including padding
646  * @payload: length of payload
647  */
648 static inline int nla_attr_size(int payload)
649 {
650 	return NLA_HDRLEN + payload;
651 }
652 
653 /**
654  * nla_total_size - total length of attribute including padding
655  * @payload: length of payload
656  */
657 static inline int nla_total_size(int payload)
658 {
659 	return NLA_ALIGN(nla_attr_size(payload));
660 }
661 
662 /**
663  * nla_padlen - length of padding at the tail of attribute
664  * @payload: length of payload
665  */
666 static inline int nla_padlen(int payload)
667 {
668 	return nla_total_size(payload) - nla_attr_size(payload);
669 }
670 
671 /**
672  * nla_type - attribute type
673  * @nla: netlink attribute
674  */
675 static inline int nla_type(const struct nlattr *nla)
676 {
677 	return nla->nla_type & NLA_TYPE_MASK;
678 }
679 
680 /**
681  * nla_data - head of payload
682  * @nla: netlink attribute
683  */
684 static inline void *nla_data(const struct nlattr *nla)
685 {
686 	return (char *) nla + NLA_HDRLEN;
687 }
688 
689 /**
690  * nla_len - length of payload
691  * @nla: netlink attribute
692  */
693 static inline int nla_len(const struct nlattr *nla)
694 {
695 	return nla->nla_len - NLA_HDRLEN;
696 }
697 
698 /**
699  * nla_ok - check if the netlink attribute fits into the remaining bytes
700  * @nla: netlink attribute
701  * @remaining: number of bytes remaining in attribute stream
702  */
703 static inline int nla_ok(const struct nlattr *nla, int remaining)
704 {
705 	return remaining >= (int) sizeof(*nla) &&
706 	       nla->nla_len >= sizeof(*nla) &&
707 	       nla->nla_len <= remaining;
708 }
709 
710 /**
711  * nla_next - next netlink attribute in attribute stream
712  * @nla: netlink attribute
713  * @remaining: number of bytes remaining in attribute stream
714  *
715  * Returns the next netlink attribute in the attribute stream and
716  * decrements remaining by the size of the current attribute.
717  */
718 static inline struct nlattr *nla_next(const struct nlattr *nla, int *remaining)
719 {
720 	int totlen = NLA_ALIGN(nla->nla_len);
721 
722 	*remaining -= totlen;
723 	return (struct nlattr *) ((char *) nla + totlen);
724 }
725 
726 /**
727  * nla_find_nested - find attribute in a set of nested attributes
728  * @nla: attribute containing the nested attributes
729  * @attrtype: type of attribute to look for
730  *
731  * Returns the first attribute which matches the specified type.
732  */
733 static inline struct nlattr *nla_find_nested(struct nlattr *nla, int attrtype)
734 {
735 	return nla_find(nla_data(nla), nla_len(nla), attrtype);
736 }
737 
738 /**
739  * nla_parse_nested - parse nested attributes
740  * @tb: destination array with maxtype+1 elements
741  * @maxtype: maximum attribute type to be expected
742  * @nla: attribute containing the nested attributes
743  * @policy: validation policy
744  *
745  * See nla_parse()
746  */
747 static inline int nla_parse_nested(struct nlattr *tb[], int maxtype,
748 				   struct nlattr *nla,
749 				   const struct nla_policy *policy)
750 {
751 	return nla_parse(tb, maxtype, nla_data(nla), nla_len(nla), policy);
752 }
753 
754 /**
755  * nla_parse_nested_compat - parse nested compat attributes
756  * @tb: destination array with maxtype+1 elements
757  * @maxtype: maximum attribute type to be expected
758  * @nla: attribute containing the nested attributes
759  * @data: pointer to point to contained structure
760  * @len: length of contained structure
761  * @policy: validation policy
762  *
763  * Parse a nested compat attribute. The compat attribute contains a structure
764  * and optionally a set of nested attributes. On success the data pointer
765  * points to the nested data and tb contains the parsed attributes
766  * (see nla_parse).
767  */
768 static inline int __nla_parse_nested_compat(struct nlattr *tb[], int maxtype,
769 					    struct nlattr *nla,
770 					    const struct nla_policy *policy,
771 					    int len)
772 {
773 	int nested_len = nla_len(nla) - NLA_ALIGN(len);
774 
775 	if (nested_len < 0)
776 		return -EINVAL;
777 	if (nested_len >= nla_attr_size(0))
778 		return nla_parse(tb, maxtype, nla_data(nla) + NLA_ALIGN(len),
779 				 nested_len, policy);
780 	memset(tb, 0, sizeof(struct nlattr *) * (maxtype + 1));
781 	return 0;
782 }
783 
784 #define nla_parse_nested_compat(tb, maxtype, nla, policy, data, len) \
785 ({	data = nla_len(nla) >= len ? nla_data(nla) : NULL; \
786 	__nla_parse_nested_compat(tb, maxtype, nla, policy, len); })
787 /**
788  * nla_put_u8 - Add a u8 netlink attribute to a socket buffer
789  * @skb: socket buffer to add attribute to
790  * @attrtype: attribute type
791  * @value: numeric value
792  */
793 static inline int nla_put_u8(struct sk_buff *skb, int attrtype, u8 value)
794 {
795 	return nla_put(skb, attrtype, sizeof(u8), &value);
796 }
797 
798 /**
799  * nla_put_u16 - Add a u16 netlink attribute to a socket buffer
800  * @skb: socket buffer to add attribute to
801  * @attrtype: attribute type
802  * @value: numeric value
803  */
804 static inline int nla_put_u16(struct sk_buff *skb, int attrtype, u16 value)
805 {
806 	return nla_put(skb, attrtype, sizeof(u16), &value);
807 }
808 
809 /**
810  * nla_put_u32 - Add a u32 netlink attribute to a socket buffer
811  * @skb: socket buffer to add attribute to
812  * @attrtype: attribute type
813  * @value: numeric value
814  */
815 static inline int nla_put_u32(struct sk_buff *skb, int attrtype, u32 value)
816 {
817 	return nla_put(skb, attrtype, sizeof(u32), &value);
818 }
819 
820 /**
821  * nla_put_64 - Add a u64 netlink attribute to a socket buffer
822  * @skb: socket buffer to add attribute to
823  * @attrtype: attribute type
824  * @value: numeric value
825  */
826 static inline int nla_put_u64(struct sk_buff *skb, int attrtype, u64 value)
827 {
828 	return nla_put(skb, attrtype, sizeof(u64), &value);
829 }
830 
831 /**
832  * nla_put_string - Add a string netlink attribute to a socket buffer
833  * @skb: socket buffer to add attribute to
834  * @attrtype: attribute type
835  * @str: NUL terminated string
836  */
837 static inline int nla_put_string(struct sk_buff *skb, int attrtype,
838 				 const char *str)
839 {
840 	return nla_put(skb, attrtype, strlen(str) + 1, str);
841 }
842 
843 /**
844  * nla_put_flag - Add a flag netlink attribute to a socket buffer
845  * @skb: socket buffer to add attribute to
846  * @attrtype: attribute type
847  */
848 static inline int nla_put_flag(struct sk_buff *skb, int attrtype)
849 {
850 	return nla_put(skb, attrtype, 0, NULL);
851 }
852 
853 /**
854  * nla_put_msecs - Add a msecs netlink attribute to a socket buffer
855  * @skb: socket buffer to add attribute to
856  * @attrtype: attribute type
857  * @jiffies: number of msecs in jiffies
858  */
859 static inline int nla_put_msecs(struct sk_buff *skb, int attrtype,
860 				unsigned long jiffies)
861 {
862 	u64 tmp = jiffies_to_msecs(jiffies);
863 	return nla_put(skb, attrtype, sizeof(u64), &tmp);
864 }
865 
866 #define NLA_PUT(skb, attrtype, attrlen, data) \
867 	do { \
868 		if (unlikely(nla_put(skb, attrtype, attrlen, data) < 0)) \
869 			goto nla_put_failure; \
870 	} while(0)
871 
872 #define NLA_PUT_TYPE(skb, type, attrtype, value) \
873 	do { \
874 		type __tmp = value; \
875 		NLA_PUT(skb, attrtype, sizeof(type), &__tmp); \
876 	} while(0)
877 
878 #define NLA_PUT_U8(skb, attrtype, value) \
879 	NLA_PUT_TYPE(skb, u8, attrtype, value)
880 
881 #define NLA_PUT_U16(skb, attrtype, value) \
882 	NLA_PUT_TYPE(skb, u16, attrtype, value)
883 
884 #define NLA_PUT_LE16(skb, attrtype, value) \
885 	NLA_PUT_TYPE(skb, __le16, attrtype, value)
886 
887 #define NLA_PUT_BE16(skb, attrtype, value) \
888 	NLA_PUT_TYPE(skb, __be16, attrtype, value)
889 
890 #define NLA_PUT_U32(skb, attrtype, value) \
891 	NLA_PUT_TYPE(skb, u32, attrtype, value)
892 
893 #define NLA_PUT_BE32(skb, attrtype, value) \
894 	NLA_PUT_TYPE(skb, __be32, attrtype, value)
895 
896 #define NLA_PUT_U64(skb, attrtype, value) \
897 	NLA_PUT_TYPE(skb, u64, attrtype, value)
898 
899 #define NLA_PUT_BE64(skb, attrtype, value) \
900 	NLA_PUT_TYPE(skb, __be64, attrtype, value)
901 
902 #define NLA_PUT_STRING(skb, attrtype, value) \
903 	NLA_PUT(skb, attrtype, strlen(value) + 1, value)
904 
905 #define NLA_PUT_FLAG(skb, attrtype) \
906 	NLA_PUT(skb, attrtype, 0, NULL)
907 
908 #define NLA_PUT_MSECS(skb, attrtype, jiffies) \
909 	NLA_PUT_U64(skb, attrtype, jiffies_to_msecs(jiffies))
910 
911 /**
912  * nla_get_u32 - return payload of u32 attribute
913  * @nla: u32 netlink attribute
914  */
915 static inline u32 nla_get_u32(struct nlattr *nla)
916 {
917 	return *(u32 *) nla_data(nla);
918 }
919 
920 /**
921  * nla_get_be32 - return payload of __be32 attribute
922  * @nla: __be32 netlink attribute
923  */
924 static inline __be32 nla_get_be32(struct nlattr *nla)
925 {
926 	return *(__be32 *) nla_data(nla);
927 }
928 
929 /**
930  * nla_get_u16 - return payload of u16 attribute
931  * @nla: u16 netlink attribute
932  */
933 static inline u16 nla_get_u16(struct nlattr *nla)
934 {
935 	return *(u16 *) nla_data(nla);
936 }
937 
938 /**
939  * nla_get_be16 - return payload of __be16 attribute
940  * @nla: __be16 netlink attribute
941  */
942 static inline __be16 nla_get_be16(struct nlattr *nla)
943 {
944 	return *(__be16 *) nla_data(nla);
945 }
946 
947 /**
948  * nla_get_le16 - return payload of __le16 attribute
949  * @nla: __le16 netlink attribute
950  */
951 static inline __le16 nla_get_le16(struct nlattr *nla)
952 {
953 	return *(__le16 *) nla_data(nla);
954 }
955 
956 /**
957  * nla_get_u8 - return payload of u8 attribute
958  * @nla: u8 netlink attribute
959  */
960 static inline u8 nla_get_u8(struct nlattr *nla)
961 {
962 	return *(u8 *) nla_data(nla);
963 }
964 
965 /**
966  * nla_get_u64 - return payload of u64 attribute
967  * @nla: u64 netlink attribute
968  */
969 static inline u64 nla_get_u64(struct nlattr *nla)
970 {
971 	u64 tmp;
972 
973 	nla_memcpy(&tmp, nla, sizeof(tmp));
974 
975 	return tmp;
976 }
977 
978 /**
979  * nla_get_flag - return payload of flag attribute
980  * @nla: flag netlink attribute
981  */
982 static inline int nla_get_flag(struct nlattr *nla)
983 {
984 	return !!nla;
985 }
986 
987 /**
988  * nla_get_msecs - return payload of msecs attribute
989  * @nla: msecs netlink attribute
990  *
991  * Returns the number of milliseconds in jiffies.
992  */
993 static inline unsigned long nla_get_msecs(struct nlattr *nla)
994 {
995 	u64 msecs = nla_get_u64(nla);
996 
997 	return msecs_to_jiffies((unsigned long) msecs);
998 }
999 
1000 /**
1001  * nla_nest_start - Start a new level of nested attributes
1002  * @skb: socket buffer to add attributes to
1003  * @attrtype: attribute type of container
1004  *
1005  * Returns the container attribute
1006  */
1007 static inline struct nlattr *nla_nest_start(struct sk_buff *skb, int attrtype)
1008 {
1009 	struct nlattr *start = (struct nlattr *)skb_tail_pointer(skb);
1010 
1011 	if (nla_put(skb, attrtype, 0, NULL) < 0)
1012 		return NULL;
1013 
1014 	return start;
1015 }
1016 
1017 /**
1018  * nla_nest_end - Finalize nesting of attributes
1019  * @skb: socket buffer the attributes are stored in
1020  * @start: container attribute
1021  *
1022  * Corrects the container attribute header to include the all
1023  * appeneded attributes.
1024  *
1025  * Returns the total data length of the skb.
1026  */
1027 static inline int nla_nest_end(struct sk_buff *skb, struct nlattr *start)
1028 {
1029 	start->nla_len = skb_tail_pointer(skb) - (unsigned char *)start;
1030 	return skb->len;
1031 }
1032 
1033 /**
1034  * nla_nest_compat_start - Start a new level of nested compat attributes
1035  * @skb: socket buffer to add attributes to
1036  * @attrtype: attribute type of container
1037  * @attrlen: length of structure
1038  * @data: pointer to structure
1039  *
1040  * Start a nested compat attribute that contains both a structure and
1041  * a set of nested attributes.
1042  *
1043  * Returns the container attribute
1044  */
1045 static inline struct nlattr *nla_nest_compat_start(struct sk_buff *skb,
1046 						   int attrtype, int attrlen,
1047 						   const void *data)
1048 {
1049 	struct nlattr *start = (struct nlattr *)skb_tail_pointer(skb);
1050 
1051 	if (nla_put(skb, attrtype, attrlen, data) < 0)
1052 		return NULL;
1053 	if (nla_nest_start(skb, attrtype) == NULL) {
1054 		nlmsg_trim(skb, start);
1055 		return NULL;
1056 	}
1057 	return start;
1058 }
1059 
1060 /**
1061  * nla_nest_compat_end - Finalize nesting of compat attributes
1062  * @skb: socket buffer the attributes are stored in
1063  * @start: container attribute
1064  *
1065  * Corrects the container attribute header to include the all
1066  * appeneded attributes.
1067  *
1068  * Returns the total data length of the skb.
1069  */
1070 static inline int nla_nest_compat_end(struct sk_buff *skb, struct nlattr *start)
1071 {
1072 	struct nlattr *nest = (void *)start + NLMSG_ALIGN(start->nla_len);
1073 
1074 	start->nla_len = skb_tail_pointer(skb) - (unsigned char *)start;
1075 	return nla_nest_end(skb, nest);
1076 }
1077 
1078 /**
1079  * nla_nest_cancel - Cancel nesting of attributes
1080  * @skb: socket buffer the message is stored in
1081  * @start: container attribute
1082  *
1083  * Removes the container attribute and including all nested
1084  * attributes. Returns -EMSGSIZE
1085  */
1086 static inline void nla_nest_cancel(struct sk_buff *skb, struct nlattr *start)
1087 {
1088 	nlmsg_trim(skb, start);
1089 }
1090 
1091 /**
1092  * nla_validate_nested - Validate a stream of nested attributes
1093  * @start: container attribute
1094  * @maxtype: maximum attribute type to be expected
1095  * @policy: validation policy
1096  *
1097  * Validates all attributes in the nested attribute stream against the
1098  * specified policy. Attributes with a type exceeding maxtype will be
1099  * ignored. See documenation of struct nla_policy for more details.
1100  *
1101  * Returns 0 on success or a negative error code.
1102  */
1103 static inline int nla_validate_nested(struct nlattr *start, int maxtype,
1104 				      const struct nla_policy *policy)
1105 {
1106 	return nla_validate(nla_data(start), nla_len(start), maxtype, policy);
1107 }
1108 
1109 /**
1110  * nla_for_each_attr - iterate over a stream of attributes
1111  * @pos: loop counter, set to current attribute
1112  * @head: head of attribute stream
1113  * @len: length of attribute stream
1114  * @rem: initialized to len, holds bytes currently remaining in stream
1115  */
1116 #define nla_for_each_attr(pos, head, len, rem) \
1117 	for (pos = head, rem = len; \
1118 	     nla_ok(pos, rem); \
1119 	     pos = nla_next(pos, &(rem)))
1120 
1121 /**
1122  * nla_for_each_nested - iterate over nested attributes
1123  * @pos: loop counter, set to current attribute
1124  * @nla: attribute containing the nested attributes
1125  * @rem: initialized to len, holds bytes currently remaining in stream
1126  */
1127 #define nla_for_each_nested(pos, nla, rem) \
1128 	nla_for_each_attr(pos, nla_data(nla), nla_len(nla), rem)
1129 
1130 #endif
1131