[XFRM] netlink: Use nlmsg_new() and type-safe size calculation helpers

Moves all complex message size calculation into own inlined helper
functions and makes use of the type-safe netlink interface.

Using nlmsg_new() simplifies the calculation itself as it takes care
of the netlink header length by itself.

Signed-off-by: Thomas Graf <tgraf@suug.ch>
Signed-off-by: David S. Miller <davem@davemloft.net>

diff --git a/net/xfrm/xfrm_user.c b/net/xfrm/xfrm_user.c
index 5efaf45..7833329 100644 (file)
--- a/net/xfrm/xfrm_user.c
+++ b/net/xfrm/xfrm_user.c
@@ -670,7 +670,7 @@ static struct sk_buff *xfrm_state_netlink(struct sk_buff *in_skb,
        struct xfrm_dump_info info;
        struct sk_buff *skb;
 
-       skb = alloc_skb(NLMSG_GOODSIZE, GFP_ATOMIC);
+       skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_ATOMIC);
        if (!skb)
                return ERR_PTR(-ENOMEM);
 
@@ -688,6 +688,13 @@ static struct sk_buff *xfrm_state_netlink(struct sk_buff *in_skb,
        return skb;
 }
 
+static inline size_t xfrm_spdinfo_msgsize(void)
+{
+       return NLMSG_ALIGN(4)
+              + nla_total_size(sizeof(struct xfrmu_spdinfo))
+              + nla_total_size(sizeof(struct xfrmu_spdhinfo));
+}
+
 static int build_spdinfo(struct sk_buff *skb, u32 pid, u32 seq, u32 flags)
 {
        struct xfrmk_spdinfo si;
@@ -729,12 +736,8 @@ static int xfrm_get_spdinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
        u32 *flags = nlmsg_data(nlh);
        u32 spid = NETLINK_CB(skb).pid;
        u32 seq = nlh->nlmsg_seq;
-       int len = NLMSG_LENGTH(sizeof(u32));
 
-       len += RTA_SPACE(sizeof(struct xfrmu_spdinfo));
-       len += RTA_SPACE(sizeof(struct xfrmu_spdhinfo));
-
-       r_skb = alloc_skb(len, GFP_ATOMIC);
+       r_skb = nlmsg_new(xfrm_spdinfo_msgsize(), GFP_ATOMIC);
        if (r_skb == NULL)
                return -ENOMEM;
 
@@ -744,6 +747,13 @@ static int xfrm_get_spdinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
        return nlmsg_unicast(xfrm_nl, r_skb, spid);
 }
 
+static inline size_t xfrm_sadinfo_msgsize(void)
+{
+       return NLMSG_ALIGN(4)
+              + nla_total_size(sizeof(struct xfrmu_sadhinfo))
+              + nla_total_size(4); /* XFRMA_SAD_CNT */
+}
+
 static int build_sadinfo(struct sk_buff *skb, u32 pid, u32 seq, u32 flags)
 {
        struct xfrmk_sadinfo si;
@@ -779,13 +789,8 @@ static int xfrm_get_sadinfo(struct sk_buff *skb, struct nlmsghdr *nlh,
        u32 *flags = nlmsg_data(nlh);
        u32 spid = NETLINK_CB(skb).pid;
        u32 seq = nlh->nlmsg_seq;
-       int len = NLMSG_LENGTH(sizeof(u32));
-
-       len += RTA_SPACE(sizeof(struct xfrmu_sadhinfo));
-       len += RTA_SPACE(sizeof(u32));
-
-       r_skb = alloc_skb(len, GFP_ATOMIC);
 
+       r_skb = nlmsg_new(xfrm_sadinfo_msgsize(), GFP_ATOMIC);
        if (r_skb == NULL)
                return -ENOMEM;
 
@@ -1311,7 +1316,7 @@ static struct sk_buff *xfrm_policy_netlink(struct sk_buff *in_skb,
        struct xfrm_dump_info info;
        struct sk_buff *skb;
 
-       skb = alloc_skb(NLMSG_GOODSIZE, GFP_KERNEL);
+       skb = nlmsg_new(NLMSG_DEFAULT_SIZE, GFP_KERNEL);
        if (!skb)
                return ERR_PTR(-ENOMEM);
 
@@ -1425,6 +1430,14 @@ static int xfrm_flush_sa(struct sk_buff *skb, struct nlmsghdr *nlh,
        return 0;
 }
 
+static inline size_t xfrm_aevent_msgsize(void)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_aevent_id))
+              + nla_total_size(sizeof(struct xfrm_replay_state))
+              + nla_total_size(sizeof(struct xfrm_lifetime_cur))
+              + nla_total_size(4) /* XFRM_AE_RTHR */
+              + nla_total_size(4); /* XFRM_AE_ETHR */
+}
 
 static int build_aevent(struct sk_buff *skb, struct xfrm_state *x, struct km_event *c)
 {
@@ -1469,19 +1482,9 @@ static int xfrm_get_ae(struct sk_buff *skb, struct nlmsghdr *nlh,
        int err;
        struct km_event c;
        struct xfrm_aevent_id *p = nlmsg_data(nlh);
-       int len = NLMSG_LENGTH(sizeof(struct xfrm_aevent_id));
        struct xfrm_usersa_id *id = &p->sa_id;
 
-       len += RTA_SPACE(sizeof(struct xfrm_replay_state));
-       len += RTA_SPACE(sizeof(struct xfrm_lifetime_cur));
-
-       if (p->flags&XFRM_AE_RTHR)
-               len+=RTA_SPACE(sizeof(u32));
-
-       if (p->flags&XFRM_AE_ETHR)
-               len+=RTA_SPACE(sizeof(u32));
-
-       r_skb = alloc_skb(len, GFP_ATOMIC);
+       r_skb = nlmsg_new(xfrm_aevent_msgsize(), GFP_ATOMIC);
        if (r_skb == NULL)
                return -ENOMEM;
 
@@ -1824,6 +1827,13 @@ static int copy_to_user_migrate(struct xfrm_migrate *m, struct sk_buff *skb)
        return nla_put(skb, XFRMA_MIGRATE, sizeof(um), &um);
 }
 
+static inline size_t xfrm_migrate_msgsize(int num_migrate)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_userpolicy_id))
+              + nla_total_size(sizeof(struct xfrm_user_migrate) * num_migrate)
+              + userpolicy_type_attrsize();
+}
+
 static int build_migrate(struct sk_buff *skb, struct xfrm_migrate *m,
                         int num_migrate, struct xfrm_selector *sel,
                         u8 dir, u8 type)
@@ -1861,12 +1871,8 @@ static int xfrm_send_migrate(struct xfrm_selector *sel, u8 dir, u8 type,
                             struct xfrm_migrate *m, int num_migrate)
 {
        struct sk_buff *skb;
-       size_t len;
 
-       len = RTA_SPACE(sizeof(struct xfrm_user_migrate) * num_migrate);
-       len += NLMSG_SPACE(sizeof(struct xfrm_userpolicy_id));
-       len += userpolicy_type_attrsize();
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_migrate_msgsize(num_migrate), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2002,6 +2008,11 @@ static void xfrm_netlink_rcv(struct sock *sk, int len)
        } while (qlen);
 }
 
+static inline size_t xfrm_expire_msgsize(void)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_user_expire));
+}
+
 static int build_expire(struct sk_buff *skb, struct xfrm_state *x, struct km_event *c)
 {
        struct xfrm_user_expire *ue;
@@ -2021,9 +2032,8 @@ static int build_expire(struct sk_buff *skb, struct xfrm_state *x, struct km_eve
 static int xfrm_exp_state_notify(struct xfrm_state *x, struct km_event *c)
 {
        struct sk_buff *skb;
-       int len = NLMSG_LENGTH(sizeof(struct xfrm_user_expire));
 
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_expire_msgsize(), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2036,11 +2046,8 @@ static int xfrm_exp_state_notify(struct xfrm_state *x, struct km_event *c)
 static int xfrm_aevent_state_notify(struct xfrm_state *x, struct km_event *c)
 {
        struct sk_buff *skb;
-       int len = NLMSG_LENGTH(sizeof(struct xfrm_aevent_id));
 
-       len += RTA_SPACE(sizeof(struct xfrm_replay_state));
-       len += RTA_SPACE(sizeof(struct xfrm_lifetime_cur));
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_aevent_msgsize(), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2055,9 +2062,9 @@ static int xfrm_notify_sa_flush(struct km_event *c)
        struct xfrm_usersa_flush *p;
        struct nlmsghdr *nlh;
        struct sk_buff *skb;
-       int len = NLMSG_LENGTH(sizeof(struct xfrm_usersa_flush));
+       int len = NLMSG_ALIGN(sizeof(struct xfrm_usersa_flush));
 
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(len, GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2075,17 +2082,17 @@ static int xfrm_notify_sa_flush(struct km_event *c)
        return nlmsg_multicast(xfrm_nl, skb, 0, XFRMNLGRP_SA, GFP_ATOMIC);
 }
 
-static inline int xfrm_sa_len(struct xfrm_state *x)
+static inline size_t xfrm_sa_len(struct xfrm_state *x)
 {
-       int l = 0;
+       size_t l = 0;
        if (x->aalg)
-               l += RTA_SPACE(alg_len(x->aalg));
+               l += nla_total_size(alg_len(x->aalg));
        if (x->ealg)
-               l += RTA_SPACE(alg_len(x->ealg));
+               l += nla_total_size(alg_len(x->ealg));
        if (x->calg)
-               l += RTA_SPACE(sizeof(*x->calg));
+               l += nla_total_size(sizeof(*x->calg));
        if (x->encap)
-               l += RTA_SPACE(sizeof(*x->encap));
+               l += nla_total_size(sizeof(*x->encap));
 
        return l;
 }
@@ -2101,12 +2108,12 @@ static int xfrm_notify_sa(struct xfrm_state *x, struct km_event *c)
 
        headlen = sizeof(*p);
        if (c->event == XFRM_MSG_DELSA) {
-               len += RTA_SPACE(headlen);
+               len += nla_total_size(headlen);
                headlen = sizeof(*id);
        }
-       len += NLMSG_SPACE(headlen);
+       len += NLMSG_ALIGN(headlen);
 
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(len, GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2175,6 +2182,15 @@ static int xfrm_send_state_notify(struct xfrm_state *x, struct km_event *c)
 
 }
 
+static inline size_t xfrm_acquire_msgsize(struct xfrm_state *x,
+                                         struct xfrm_policy *xp)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_user_acquire))
+              + nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr)
+              + nla_total_size(xfrm_user_sec_ctx_size(x->security))
+              + userpolicy_type_attrsize();
+}
+
 static int build_acquire(struct sk_buff *skb, struct xfrm_state *x,
                         struct xfrm_tmpl *xt, struct xfrm_policy *xp,
                         int dir)
@@ -2215,13 +2231,8 @@ static int xfrm_send_acquire(struct xfrm_state *x, struct xfrm_tmpl *xt,
                             struct xfrm_policy *xp, int dir)
 {
        struct sk_buff *skb;
-       size_t len;
 
-       len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
-       len += NLMSG_SPACE(sizeof(struct xfrm_user_acquire));
-       len += RTA_SPACE(xfrm_user_sec_ctx_size(x->security));
-       len += userpolicy_type_attrsize();
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_acquire_msgsize(x, xp), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2290,6 +2301,14 @@ static struct xfrm_policy *xfrm_compile_policy(struct sock *sk, int opt,
        return xp;
 }
 
+static inline size_t xfrm_polexpire_msgsize(struct xfrm_policy *xp)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_user_polexpire))
+              + nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr)
+              + nla_total_size(xfrm_user_sec_ctx_size(xp->security))
+              + userpolicy_type_attrsize();
+}
+
 static int build_polexpire(struct sk_buff *skb, struct xfrm_policy *xp,
                           int dir, struct km_event *c)
 {
@@ -2321,13 +2340,8 @@ nlmsg_failure:
 static int xfrm_exp_policy_notify(struct xfrm_policy *xp, int dir, struct km_event *c)
 {
        struct sk_buff *skb;
-       size_t len;
 
-       len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
-       len += NLMSG_SPACE(sizeof(struct xfrm_user_polexpire));
-       len += RTA_SPACE(xfrm_user_sec_ctx_size(xp->security));
-       len += userpolicy_type_attrsize();
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_polexpire_msgsize(xp), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2343,18 +2357,18 @@ static int xfrm_notify_policy(struct xfrm_policy *xp, int dir, struct km_event *
        struct xfrm_userpolicy_id *id;
        struct nlmsghdr *nlh;
        struct sk_buff *skb;
-       int len = RTA_SPACE(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
+       int len = nla_total_size(sizeof(struct xfrm_user_tmpl) * xp->xfrm_nr);
        int headlen;
 
        headlen = sizeof(*p);
        if (c->event == XFRM_MSG_DELPOLICY) {
-               len += RTA_SPACE(headlen);
+               len += nla_total_size(headlen);
                headlen = sizeof(*id);
        }
        len += userpolicy_type_attrsize();
-       len += NLMSG_SPACE(headlen);
+       len += NLMSG_ALIGN(headlen);
 
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(len, GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2400,11 +2414,8 @@ static int xfrm_notify_policy_flush(struct km_event *c)
 {
        struct nlmsghdr *nlh;
        struct sk_buff *skb;
-       int len = 0;
-       len += userpolicy_type_attrsize();
-       len += NLMSG_LENGTH(0);
 
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(userpolicy_type_attrsize(), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;
 
@@ -2443,6 +2454,11 @@ static int xfrm_send_policy_notify(struct xfrm_policy *xp, int dir, struct km_ev
 
 }
 
+static inline size_t xfrm_report_msgsize(void)
+{
+       return NLMSG_ALIGN(sizeof(struct xfrm_user_report));
+}
+
 static int build_report(struct sk_buff *skb, u8 proto,
                        struct xfrm_selector *sel, xfrm_address_t *addr)
 {
@@ -2471,10 +2487,8 @@ static int xfrm_send_report(u8 proto, struct xfrm_selector *sel,
                            xfrm_address_t *addr)
 {
        struct sk_buff *skb;
-       size_t len;
 
-       len = NLMSG_ALIGN(NLMSG_LENGTH(sizeof(struct xfrm_user_report)));
-       skb = alloc_skb(len, GFP_ATOMIC);
+       skb = nlmsg_new(xfrm_report_msgsize(), GFP_ATOMIC);
        if (skb == NULL)
                return -ENOMEM;