include/net/netlink.h

   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. Returns -1.
 560  */
 561 static inline int nlmsg_trim(struct sk_buff *skb, const void *mark)
 562 {
 563         if (mark)
 564                 skb_trim(skb, (unsigned char *) mark - skb->data);
 565
 566         return -1;
 567 }
 568
 569 /**
 570  * nlmsg_cancel - Cancel construction of a netlink message
 571  * @skb: socket buffer the message is stored in
 572  * @nlh: netlink message header
 573  *
 574  * Removes the complete netlink message including all
 575  * attributes from the socket buffer again. Returns -1.
 576  */
 577 static inline int nlmsg_cancel(struct sk_buff *skb, struct nlmsghdr *nlh)
 578 {
 579         return nlmsg_trim(skb, nlh);
 580 }
 581
 582 /**
 583  * nlmsg_free - free a netlink message
 584  * @skb: socket buffer of netlink message
 585  */
 586 static inline void nlmsg_free(struct sk_buff *skb)
 587 {
 588         kfree_skb(skb);
 589 }
 590
 591 /**
 592  * nlmsg_multicast - multicast a netlink message
 593  * @sk: netlink socket to spread messages to
 594  * @skb: netlink message as socket buffer
 595  * @pid: own netlink pid to avoid sending to yourself
 596  * @group: multicast group id
 597  * @flags: allocation flags
 598  */
 599 static inline int nlmsg_multicast(struct sock *sk, struct sk_buff *skb,
 600                                   u32 pid, unsigned int group, gfp_t flags)
 601 {
 602         int err;
 603
 604         NETLINK_CB(skb).dst_group = group;
 605
 606         err = netlink_broadcast(sk, skb, pid, group, flags);
 607         if (err > 0)
 608                 err = 0;
 609
 610         return err;
 611 }
 612
 613 /**
 614  * nlmsg_unicast - unicast a netlink message
 615  * @sk: netlink socket to spread message to
 616  * @skb: netlink message as socket buffer
 617  * @pid: netlink pid of the destination socket
 618  */
 619 static inline int nlmsg_unicast(struct sock *sk, struct sk_buff *skb, u32 pid)
 620 {
 621         int err;
 622
 623         err = netlink_unicast(sk, skb, pid, MSG_DONTWAIT);
 624         if (err > 0)
 625                 err = 0;
 626
 627         return err;
 628 }
 629
 630 /**
 631  * nlmsg_for_each_msg - iterate over a stream of messages
 632  * @pos: loop counter, set to current message
 633  * @head: head of message stream
 634  * @len: length of message stream
 635  * @rem: initialized to len, holds bytes currently remaining in stream
 636  */
 637 #define nlmsg_for_each_msg(pos, head, len, rem) \
 638         for (pos = head, rem = len; \
 639              nlmsg_ok(pos, rem); \
 640              pos = nlmsg_next(pos, &(rem)))
 641
 642 /**************************************************************************
 643  * Netlink Attributes
 644  **************************************************************************/
 645
 646 /**
 647  * nla_attr_size - length of attribute not including padding
 648  * @payload: length of payload
 649  */
 650 static inline int nla_attr_size(int payload)
 651 {
 652         return NLA_HDRLEN + payload;
 653 }
 654
 655 /**
 656  * nla_total_size - total length of attribute including padding
 657  * @payload: length of payload
 658  */
 659 static inline int nla_total_size(int payload)
 660 {
 661         return NLA_ALIGN(nla_attr_size(payload));
 662 }
 663
 664 /**
 665  * nla_padlen - length of padding at the tail of attribute
 666  * @payload: length of payload
 667  */
 668 static inline int nla_padlen(int payload)
 669 {
 670         return nla_total_size(payload) - nla_attr_size(payload);
 671 }
 672
 673 /**
 674  * nla_type - attribute type
 675  * @nla: netlink attribute
 676  */
 677 static inline int nla_type(const struct nlattr *nla)
 678 {
 679         return nla->nla_type & NLA_TYPE_MASK;
 680 }
 681
 682 /**
 683  * nla_data - head of payload
 684  * @nla: netlink attribute
 685  */
 686 static inline void *nla_data(const struct nlattr *nla)
 687 {
 688         return (char *) nla + NLA_HDRLEN;
 689 }
 690
 691 /**
 692  * nla_len - length of payload
 693  * @nla: netlink attribute
 694  */
 695 static inline int nla_len(const struct nlattr *nla)
 696 {
 697         return nla->nla_len - NLA_HDRLEN;
 698 }
 699
 700 /**
 701  * nla_ok - check if the netlink attribute fits into the remaining bytes
 702  * @nla: netlink attribute
 703  * @remaining: number of bytes remaining in attribute stream
 704  */
 705 static inline int nla_ok(const struct nlattr *nla, int remaining)
 706 {
 707         return remaining >= sizeof(*nla) &&
 708                nla->nla_len >= sizeof(*nla) &&
 709                nla->nla_len <= remaining;
 710 }
 711
 712 /**
 713  * nla_next - next netlink attribute in attribute stream
 714  * @nla: netlink attribute
 715  * @remaining: number of bytes remaining in attribute stream
 716  *
 717  * Returns the next netlink attribute in the attribute stream and
 718  * decrements remaining by the size of the current attribute.
 719  */
 720 static inline struct nlattr *nla_next(const struct nlattr *nla, int *remaining)
 721 {
 722         int totlen = NLA_ALIGN(nla->nla_len);
 723
 724         *remaining -= totlen;
 725         return (struct nlattr *) ((char *) nla + totlen);
 726 }
 727
 728 /**
 729  * nla_find_nested - find attribute in a set of nested attributes
 730  * @nla: attribute containing the nested attributes
 731  * @attrtype: type of attribute to look for
 732  *
 733  * Returns the first attribute which matches the specified type.
 734  */
 735 static inline struct nlattr *nla_find_nested(struct nlattr *nla, int attrtype)
 736 {
 737         return nla_find(nla_data(nla), nla_len(nla), attrtype);
 738 }
 739
 740 /**
 741  * nla_parse_nested - parse nested attributes
 742  * @tb: destination array with maxtype+1 elements
 743  * @maxtype: maximum attribute type to be expected
 744  * @nla: attribute containing the nested attributes
 745  * @policy: validation policy
 746  *
 747  * See nla_parse()
 748  */
 749 static inline int nla_parse_nested(struct nlattr *tb[], int maxtype,
 750                                    struct nlattr *nla,
 751                                    const struct nla_policy *policy)
 752 {
 753         return nla_parse(tb, maxtype, nla_data(nla), nla_len(nla), policy);
 754 }
 755
 756 /**
 757  * nla_parse_nested_compat - parse nested compat attributes
 758  * @tb: destination array with maxtype+1 elements
 759  * @maxtype: maximum attribute type to be expected
 760  * @nla: attribute containing the nested attributes
 761  * @data: pointer to point to contained structure
 762  * @len: length of contained structure
 763  * @policy: validation policy
 764  *
 765  * Parse a nested compat attribute. The compat attribute contains a structure
 766  * and optionally a set of nested attributes. On success the data pointer
 767  * points to the nested data and tb contains the parsed attributes
 768  * (see nla_parse).
 769  */
 770 static inline int __nla_parse_nested_compat(struct nlattr *tb[], int maxtype,
 771                                             struct nlattr *nla,
 772                                             const struct nla_policy *policy,
 773                                             int len)
 774 {
 775         if (nla_len(nla) < len)
 776                 return -1;
 777         if (nla_len(nla) >= NLA_ALIGN(len) + sizeof(struct nlattr))
 778                 return nla_parse_nested(tb, maxtype,
 779                                         nla_data(nla) + NLA_ALIGN(len),
 780                                         policy);
 781         memset(tb, 0, sizeof(struct nlattr *) * (maxtype + 1));
 782         return 0;
 783 }
 784
 785 #define nla_parse_nested_compat(tb, maxtype, nla, policy, data, len) \
 786 ({      data = nla_len(nla) >= len ? nla_data(nla) : NULL; \
 787         __nla_parse_nested_compat(tb, maxtype, nla, policy, len); })
 788 /**
 789  * nla_put_u8 - Add a u8 netlink attribute to a socket buffer
 790  * @skb: socket buffer to add attribute to
 791  * @attrtype: attribute type
 792  * @value: numeric value
 793  */
 794 static inline int nla_put_u8(struct sk_buff *skb, int attrtype, u8 value)
 795 {
 796         return nla_put(skb, attrtype, sizeof(u8), &value);
 797 }
 798
 799 /**
 800  * nla_put_u16 - Add a u16 netlink attribute to a socket buffer
 801  * @skb: socket buffer to add attribute to
 802  * @attrtype: attribute type
 803  * @value: numeric value
 804  */
 805 static inline int nla_put_u16(struct sk_buff *skb, int attrtype, u16 value)
 806 {
 807         return nla_put(skb, attrtype, sizeof(u16), &value);
 808 }
 809
 810 /**
 811  * nla_put_u32 - Add a u32 netlink attribute to a socket buffer
 812  * @skb: socket buffer to add attribute to
 813  * @attrtype: attribute type
 814  * @value: numeric value
 815  */
 816 static inline int nla_put_u32(struct sk_buff *skb, int attrtype, u32 value)
 817 {
 818         return nla_put(skb, attrtype, sizeof(u32), &value);
 819 }
 820
 821 /**
 822  * nla_put_64 - Add a u64 netlink attribute to a socket buffer
 823  * @skb: socket buffer to add attribute to
 824  * @attrtype: attribute type
 825  * @value: numeric value
 826  */
 827 static inline int nla_put_u64(struct sk_buff *skb, int attrtype, u64 value)
 828 {
 829         return nla_put(skb, attrtype, sizeof(u64), &value);
 830 }
 831
 832 /**
 833  * nla_put_string - Add a string netlink attribute to a socket buffer
 834  * @skb: socket buffer to add attribute to
 835  * @attrtype: attribute type
 836  * @str: NUL terminated string
 837  */
 838 static inline int nla_put_string(struct sk_buff *skb, int attrtype,
 839                                  const char *str)
 840 {
 841         return nla_put(skb, attrtype, strlen(str) + 1, str);
 842 }
 843
 844 /**
 845  * nla_put_flag - Add a flag netlink attribute to a socket buffer
 846  * @skb: socket buffer to add attribute to
 847  * @attrtype: attribute type
 848  */
 849 static inline int nla_put_flag(struct sk_buff *skb, int attrtype)
 850 {
 851         return nla_put(skb, attrtype, 0, NULL);
 852 }
 853
 854 /**
 855  * nla_put_msecs - Add a msecs netlink attribute to a socket buffer
 856  * @skb: socket buffer to add attribute to
 857  * @attrtype: attribute type
 858  * @jiffies: number of msecs in jiffies
 859  */
 860 static inline int nla_put_msecs(struct sk_buff *skb, int attrtype,
 861                                 unsigned long jiffies)
 862 {
 863         u64 tmp = jiffies_to_msecs(jiffies);
 864         return nla_put(skb, attrtype, sizeof(u64), &tmp);
 865 }
 866
 867 #define NLA_PUT(skb, attrtype, attrlen, data) \
 868         do { \
 869                 if (unlikely(nla_put(skb, attrtype, attrlen, data) < 0)) \
 870                         goto nla_put_failure; \
 871         } while(0)
 872
 873 #define NLA_PUT_TYPE(skb, type, attrtype, value) \
 874         do { \
 875                 type __tmp = value; \
 876                 NLA_PUT(skb, attrtype, sizeof(type), &__tmp); \
 877         } while(0)
 878
 879 #define NLA_PUT_U8(skb, attrtype, value) \
 880         NLA_PUT_TYPE(skb, u8, attrtype, value)
 881
 882 #define NLA_PUT_U16(skb, attrtype, value) \
 883         NLA_PUT_TYPE(skb, u16, attrtype, value)
 884
 885 #define NLA_PUT_LE16(skb, attrtype, value) \
 886         NLA_PUT_TYPE(skb, __le16, attrtype, value)
 887
 888 #define NLA_PUT_BE16(skb, attrtype, value) \
 889         NLA_PUT_TYPE(skb, __be16, attrtype, value)
 890
 891 #define NLA_PUT_U32(skb, attrtype, value) \
 892         NLA_PUT_TYPE(skb, u32, attrtype, value)
 893
 894 #define NLA_PUT_BE32(skb, attrtype, value) \
 895         NLA_PUT_TYPE(skb, __be32, attrtype, value)
 896
 897 #define NLA_PUT_U64(skb, attrtype, value) \
 898         NLA_PUT_TYPE(skb, u64, attrtype, value)
 899
 900 #define NLA_PUT_STRING(skb, attrtype, value) \
 901         NLA_PUT(skb, attrtype, strlen(value) + 1, value)
 902
 903 #define NLA_PUT_FLAG(skb, attrtype) \
 904         NLA_PUT(skb, attrtype, 0, NULL)
 905
 906 #define NLA_PUT_MSECS(skb, attrtype, jiffies) \
 907         NLA_PUT_U64(skb, attrtype, jiffies_to_msecs(jiffies))
 908
 909 /**
 910  * nla_get_u32 - return payload of u32 attribute
 911  * @nla: u32 netlink attribute
 912  */
 913 static inline u32 nla_get_u32(struct nlattr *nla)
 914 {
 915         return *(u32 *) nla_data(nla);
 916 }
 917
 918 /**
 919  * nla_get_be32 - return payload of __be32 attribute
 920  * @nla: __be32 netlink attribute
 921  */
 922 static inline __be32 nla_get_be32(struct nlattr *nla)
 923 {
 924         return *(__be32 *) nla_data(nla);
 925 }
 926
 927 /**
 928  * nla_get_u16 - return payload of u16 attribute
 929  * @nla: u16 netlink attribute
 930  */
 931 static inline u16 nla_get_u16(struct nlattr *nla)
 932 {
 933         return *(u16 *) nla_data(nla);
 934 }
 935
 936 /**
 937  * nla_get_be16 - return payload of __be16 attribute
 938  * @nla: __be16 netlink attribute
 939  */
 940 static inline __be16 nla_get_be16(struct nlattr *nla)
 941 {
 942         return *(__be16 *) nla_data(nla);
 943 }
 944
 945 /**
 946  * nla_get_le16 - return payload of __le16 attribute
 947  * @nla: __le16 netlink attribute
 948  */
 949 static inline __le16 nla_get_le16(struct nlattr *nla)
 950 {
 951         return *(__le16 *) nla_data(nla);
 952 }
 953
 954 /**
 955  * nla_get_u8 - return payload of u8 attribute
 956  * @nla: u8 netlink attribute
 957  */
 958 static inline u8 nla_get_u8(struct nlattr *nla)
 959 {
 960         return *(u8 *) nla_data(nla);
 961 }
 962
 963 /**
 964  * nla_get_u64 - return payload of u64 attribute
 965  * @nla: u64 netlink attribute
 966  */
 967 static inline u64 nla_get_u64(struct nlattr *nla)
 968 {
 969         u64 tmp;
 970
 971         nla_memcpy(&tmp, nla, sizeof(tmp));
 972
 973         return tmp;
 974 }
 975
 976 /**
 977  * nla_get_flag - return payload of flag attribute
 978  * @nla: flag netlink attribute
 979  */
 980 static inline int nla_get_flag(struct nlattr *nla)
 981 {
 982         return !!nla;
 983 }
 984
 985 /**
 986  * nla_get_msecs - return payload of msecs attribute
 987  * @nla: msecs netlink attribute
 988  *
 989  * Returns the number of milliseconds in jiffies.
 990  */
 991 static inline unsigned long nla_get_msecs(struct nlattr *nla)
 992 {
 993         u64 msecs = nla_get_u64(nla);
 994
 995         return msecs_to_jiffies((unsigned long) msecs);
 996 }
 997
 998 /**
 999  * nla_nest_start - Start a new level of nested attributes
1000  * @skb: socket buffer to add attributes to
1001  * @attrtype: attribute type of container
1002  *
1003  * Returns the container attribute
1004  */
1005 static inline struct nlattr *nla_nest_start(struct sk_buff *skb, int attrtype)
1006 {
1007         struct nlattr *start = (struct nlattr *)skb_tail_pointer(skb);
1008
1009         if (nla_put(skb, attrtype, 0, NULL) < 0)
1010                 return NULL;
1011
1012         return start;
1013 }
1014
1015 /**
1016  * nla_nest_end - Finalize nesting of attributes
1017  * @skb: socket buffer the attributes are stored in
1018  * @start: container attribute
1019  *
1020  * Corrects the container attribute header to include the all
1021  * appeneded attributes.
1022  *
1023  * Returns the total data length of the skb.
1024  */
1025 static inline int nla_nest_end(struct sk_buff *skb, struct nlattr *start)
1026 {
1027         start->nla_len = skb_tail_pointer(skb) - (unsigned char *)start;
1028         return skb->len;
1029 }
1030
1031 /**
1032  * nla_nest_compat_start - Start a new level of nested compat attributes
1033  * @skb: socket buffer to add attributes to
1034  * @attrtype: attribute type of container
1035  * @attrlen: length of structure
1036  * @data: pointer to structure
1037  *
1038  * Start a nested compat attribute that contains both a structure and
1039  * a set of nested attributes.
1040  *
1041  * Returns the container attribute
1042  */
1043 static inline struct nlattr *nla_nest_compat_start(struct sk_buff *skb,
1044                                                    int attrtype, int attrlen,
1045                                                    const void *data)
1046 {
1047         struct nlattr *start = (struct nlattr *)skb_tail_pointer(skb);
1048
1049         if (nla_put(skb, attrtype, attrlen, data) < 0)
1050                 return NULL;
1051         if (nla_nest_start(skb, attrtype) == NULL) {
1052                 nlmsg_trim(skb, start);
1053                 return NULL;
1054         }
1055         return start;
1056 }
1057
1058 /**
1059  * nla_nest_compat_end - Finalize nesting of compat attributes
1060  * @skb: socket buffer the attributes are stored in
1061  * @start: container attribute
1062  *
1063  * Corrects the container attribute header to include the all
1064  * appeneded attributes.
1065  *
1066  * Returns the total data length of the skb.
1067  */
1068 static inline int nla_nest_compat_end(struct sk_buff *skb, struct nlattr *start)
1069 {
1070         struct nlattr *nest = (void *)start + NLMSG_ALIGN(start->nla_len);
1071
1072         start->nla_len = skb_tail_pointer(skb) - (unsigned char *)start;
1073         return nla_nest_end(skb, nest);
1074 }
1075
1076 /**
1077  * nla_nest_cancel - Cancel nesting of attributes
1078  * @skb: socket buffer the message is stored in
1079  * @start: container attribute
1080  *
1081  * Removes the container attribute and including all nested
1082  * attributes. Returns -1.
1083  */
1084 static inline int nla_nest_cancel(struct sk_buff *skb, struct nlattr *start)
1085 {
1086         return nlmsg_trim(skb, start);
1087 }
1088
1089 /**
1090  * nla_validate_nested - Validate a stream of nested attributes
1091  * @start: container attribute
1092  * @maxtype: maximum attribute type to be expected
1093  * @policy: validation policy
1094  *
1095  * Validates all attributes in the nested attribute stream against the
1096  * specified policy. Attributes with a type exceeding maxtype will be
1097  * ignored. See documenation of struct nla_policy for more details.
1098  *
1099  * Returns 0 on success or a negative error code.
1100  */
1101 static inline int nla_validate_nested(struct nlattr *start, int maxtype,
1102                                       const struct nla_policy *policy)
1103 {
1104         return nla_validate(nla_data(start), nla_len(start), maxtype, policy);
1105 }
1106
1107 /**
1108  * nla_for_each_attr - iterate over a stream of attributes
1109  * @pos: loop counter, set to current attribute
1110  * @head: head of attribute stream
1111  * @len: length of attribute stream
1112  * @rem: initialized to len, holds bytes currently remaining in stream
1113  */
1114 #define nla_for_each_attr(pos, head, len, rem) \
1115         for (pos = head, rem = len; \
1116              nla_ok(pos, rem); \
1117              pos = nla_next(pos, &(rem)))
1118
1119 /**
1120  * nla_for_each_nested - iterate over nested attributes
1121  * @pos: loop counter, set to current attribute
1122  * @nla: attribute containing the nested attributes
1123  * @rem: initialized to len, holds bytes currently remaining in stream
1124  */
1125 #define nla_for_each_nested(pos, nla, rem) \
1126         nla_for_each_attr(pos, nla_data(nla), nla_len(nla), rem)
1127
1128 #endif