ieee802154: add two nl802154 helpers

[karo-tx-linux.git] / net / ieee802154 / netlink.c

diff --git a/net/ieee802154/netlink.c b/net/ieee802154/netlink.c
index 8a221737f75c5c874e6caf13817c6917ff478ba7..33137b99e47137b8b589c8efbcf6d6912e4573f1 100644 (file)
--- a/net/ieee802154/netlink.c
+++ b/net/ieee802154/netlink.c
@@ -75,6 +75,39 @@ out:
        return -ENOBUFS;
 }
 
+struct sk_buff *ieee802154_nl_new_reply(struct genl_info *info,
+               int flags, u8 req)
+{
+       void *hdr;
+       struct sk_buff *msg = nlmsg_new(NLMSG_GOODSIZE, GFP_ATOMIC);
+
+       if (!msg)
+               return NULL;
+
+       hdr = genlmsg_put_reply(msg, info,
+                       &nl802154_family, flags, req);
+       if (!hdr) {
+               nlmsg_free(msg);
+               return NULL;
+       }
+
+       return msg;
+}
+
+int ieee802154_nl_reply(struct sk_buff *msg, struct genl_info *info)
+{
+       /* XXX: nlh is right at the start of msg */
+       void *hdr = genlmsg_data(NLMSG_DATA(msg->data));
+
+       if (genlmsg_end(msg, hdr) < 0)
+               goto out;
+
+       return genlmsg_reply(msg, info);
+out:
+       nlmsg_free(msg);
+       return -ENOBUFS;
+}
+
 int __init ieee802154_nl_init(void)
 {
        int rc;