Merge tag 'for-5.13/parisc' of git://git.kernel.org/pub/scm/linux/kernel/git/deller...
[linux-2.6-microblaze.git] / net / mptcp / pm_netlink.c
index 73b9245..6ba0408 100644 (file)
@@ -25,6 +25,8 @@ static int pm_nl_pernet_id;
 struct mptcp_pm_addr_entry {
        struct list_head        list;
        struct mptcp_addr_info  addr;
+       u8                      flags;
+       int                     ifindex;
        struct rcu_head         rcu;
        struct socket           *lsk;
 };
@@ -168,7 +170,7 @@ select_local_address(const struct pm_nl_pernet *pernet,
        rcu_read_lock();
        __mptcp_flush_join_list(msk);
        list_for_each_entry_rcu(entry, &pernet->local_addr_list, list) {
-               if (!(entry->addr.flags & MPTCP_PM_ADDR_FLAG_SUBFLOW))
+               if (!(entry->flags & MPTCP_PM_ADDR_FLAG_SUBFLOW))
                        continue;
 
                if (entry->addr.family != sk->sk_family) {
@@ -206,7 +208,7 @@ select_signal_address(struct pm_nl_pernet *pernet, unsigned int pos)
         * can lead to additional addresses not being announced.
         */
        list_for_each_entry_rcu(entry, &pernet->local_addr_list, list) {
-               if (!(entry->addr.flags & MPTCP_PM_ADDR_FLAG_SIGNAL))
+               if (!(entry->flags & MPTCP_PM_ADDR_FLAG_SIGNAL))
                        continue;
                if (i++ == pos) {
                        ret = entry;
@@ -459,7 +461,8 @@ static void mptcp_pm_create_subflow_or_signal_addr(struct mptcp_sock *msk)
                        check_work_pending(msk);
                        remote_address((struct sock_common *)sk, &remote);
                        spin_unlock_bh(&msk->pm.lock);
-                       __mptcp_subflow_connect(sk, &local->addr, &remote);
+                       __mptcp_subflow_connect(sk, &local->addr, &remote,
+                                               local->flags, local->ifindex);
                        spin_lock_bh(&msk->pm.lock);
                        return;
                }
@@ -514,7 +517,7 @@ static void mptcp_pm_nl_add_addr_received(struct mptcp_sock *msk)
        local.family = remote.family;
 
        spin_unlock_bh(&msk->pm.lock);
-       __mptcp_subflow_connect(sk, &local, &remote);
+       __mptcp_subflow_connect(sk, &local, &remote, 0, 0);
        spin_lock_bh(&msk->pm.lock);
 
 add_addr_echo:
@@ -586,47 +589,68 @@ int mptcp_pm_nl_mp_prio_send_ack(struct mptcp_sock *msk,
        return -EINVAL;
 }
 
-static void mptcp_pm_nl_rm_addr_received(struct mptcp_sock *msk)
+static void mptcp_pm_nl_rm_addr_or_subflow(struct mptcp_sock *msk,
+                                          const struct mptcp_rm_list *rm_list,
+                                          enum linux_mptcp_mib_field rm_type)
 {
        struct mptcp_subflow_context *subflow, *tmp;
        struct sock *sk = (struct sock *)msk;
        u8 i;
 
-       pr_debug("address rm_list_nr %d", msk->pm.rm_list_rx.nr);
+       pr_debug("%s rm_list_nr %d",
+                rm_type == MPTCP_MIB_RMADDR ? "address" : "subflow", rm_list->nr);
 
        msk_owned_by_me(msk);
 
-       if (!msk->pm.rm_list_rx.nr)
+       if (!rm_list->nr)
                return;
 
        if (list_empty(&msk->conn_list))
                return;
 
-       for (i = 0; i < msk->pm.rm_list_rx.nr; i++) {
+       for (i = 0; i < rm_list->nr; i++) {
                list_for_each_entry_safe(subflow, tmp, &msk->conn_list, node) {
                        struct sock *ssk = mptcp_subflow_tcp_sock(subflow);
                        int how = RCV_SHUTDOWN | SEND_SHUTDOWN;
+                       u8 id = subflow->local_id;
 
-                       if (msk->pm.rm_list_rx.ids[i] != subflow->remote_id)
+                       if (rm_type == MPTCP_MIB_RMADDR)
+                               id = subflow->remote_id;
+
+                       if (rm_list->ids[i] != id)
                                continue;
 
-                       pr_debug(" -> address rm_list_ids[%d]=%u", i, msk->pm.rm_list_rx.ids[i]);
+                       pr_debug(" -> %s rm_list_ids[%d]=%u local_id=%u remote_id=%u",
+                                rm_type == MPTCP_MIB_RMADDR ? "address" : "subflow",
+                                i, rm_list->ids[i], subflow->local_id, subflow->remote_id);
                        spin_unlock_bh(&msk->pm.lock);
                        mptcp_subflow_shutdown(sk, ssk, how);
                        mptcp_close_ssk(sk, ssk, subflow);
                        spin_lock_bh(&msk->pm.lock);
 
-                       msk->pm.add_addr_accepted--;
+                       if (rm_type == MPTCP_MIB_RMADDR) {
+                               msk->pm.add_addr_accepted--;
+                               WRITE_ONCE(msk->pm.accept_addr, true);
+                       } else if (rm_type == MPTCP_MIB_RMSUBFLOW) {
+                               msk->pm.local_addr_used--;
+                       }
                        msk->pm.subflows--;
-                       WRITE_ONCE(msk->pm.accept_addr, true);
-
-                       __MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_RMADDR);
-
-                       break;
+                       __MPTCP_INC_STATS(sock_net(sk), rm_type);
                }
        }
 }
 
+static void mptcp_pm_nl_rm_addr_received(struct mptcp_sock *msk)
+{
+       mptcp_pm_nl_rm_addr_or_subflow(msk, &msk->pm.rm_list_rx, MPTCP_MIB_RMADDR);
+}
+
+void mptcp_pm_nl_rm_subflow_received(struct mptcp_sock *msk,
+                                    const struct mptcp_rm_list *rm_list)
+{
+       mptcp_pm_nl_rm_addr_or_subflow(msk, rm_list, MPTCP_MIB_RMSUBFLOW);
+}
+
 void mptcp_pm_nl_work(struct mptcp_sock *msk)
 {
        struct mptcp_pm_data *pm = &msk->pm;
@@ -660,50 +684,9 @@ void mptcp_pm_nl_work(struct mptcp_sock *msk)
        spin_unlock_bh(&msk->pm.lock);
 }
 
-void mptcp_pm_nl_rm_subflow_received(struct mptcp_sock *msk,
-                                    const struct mptcp_rm_list *rm_list)
-{
-       struct mptcp_subflow_context *subflow, *tmp;
-       struct sock *sk = (struct sock *)msk;
-       u8 i;
-
-       pr_debug("subflow rm_list_nr %d", rm_list->nr);
-
-       msk_owned_by_me(msk);
-
-       if (!rm_list->nr)
-               return;
-
-       if (list_empty(&msk->conn_list))
-               return;
-
-       for (i = 0; i < rm_list->nr; i++) {
-               list_for_each_entry_safe(subflow, tmp, &msk->conn_list, node) {
-                       struct sock *ssk = mptcp_subflow_tcp_sock(subflow);
-                       int how = RCV_SHUTDOWN | SEND_SHUTDOWN;
-
-                       if (rm_list->ids[i] != subflow->local_id)
-                               continue;
-
-                       pr_debug(" -> subflow rm_list_ids[%d]=%u", i, rm_list->ids[i]);
-                       spin_unlock_bh(&msk->pm.lock);
-                       mptcp_subflow_shutdown(sk, ssk, how);
-                       mptcp_close_ssk(sk, ssk, subflow);
-                       spin_lock_bh(&msk->pm.lock);
-
-                       msk->pm.local_addr_used--;
-                       msk->pm.subflows--;
-
-                       __MPTCP_INC_STATS(sock_net(sk), MPTCP_MIB_RMSUBFLOW);
-
-                       break;
-               }
-       }
-}
-
 static bool address_use_port(struct mptcp_pm_addr_entry *entry)
 {
-       return (entry->addr.flags &
+       return (entry->flags &
                (MPTCP_PM_ADDR_FLAG_SIGNAL | MPTCP_PM_ADDR_FLAG_SUBFLOW)) ==
                MPTCP_PM_ADDR_FLAG_SIGNAL;
 }
@@ -755,11 +738,11 @@ find_next:
        if (entry->addr.id > pernet->next_id)
                pernet->next_id = entry->addr.id;
 
-       if (entry->addr.flags & MPTCP_PM_ADDR_FLAG_SIGNAL) {
+       if (entry->flags & MPTCP_PM_ADDR_FLAG_SIGNAL) {
                addr_max = pernet->add_addr_signal_max;
                WRITE_ONCE(pernet->add_addr_signal_max, addr_max + 1);
        }
-       if (entry->addr.flags & MPTCP_PM_ADDR_FLAG_SUBFLOW) {
+       if (entry->flags & MPTCP_PM_ADDR_FLAG_SUBFLOW) {
                addr_max = pernet->local_addr_max;
                WRITE_ONCE(pernet->local_addr_max, addr_max + 1);
        }
@@ -861,10 +844,10 @@ int mptcp_pm_nl_get_local_id(struct mptcp_sock *msk, struct sock_common *skc)
                return -ENOMEM;
 
        entry->addr = skc_local;
-       entry->addr.ifindex = 0;
-       entry->addr.flags = 0;
        entry->addr.id = 0;
        entry->addr.port = 0;
+       entry->ifindex = 0;
+       entry->flags = 0;
        entry->lsk = NULL;
        ret = mptcp_pm_nl_append_new_local_addr(pernet, entry);
        if (ret < 0)
@@ -979,14 +962,14 @@ skip_family:
        if (tb[MPTCP_PM_ADDR_ATTR_IF_IDX]) {
                u32 val = nla_get_s32(tb[MPTCP_PM_ADDR_ATTR_IF_IDX]);
 
-               entry->addr.ifindex = val;
+               entry->ifindex = val;
        }
 
        if (tb[MPTCP_PM_ADDR_ATTR_ID])
                entry->addr.id = nla_get_u8(tb[MPTCP_PM_ADDR_ATTR_ID]);
 
        if (tb[MPTCP_PM_ADDR_ATTR_FLAGS])
-               entry->addr.flags = nla_get_u32(tb[MPTCP_PM_ADDR_ATTR_FLAGS]);
+               entry->flags = nla_get_u32(tb[MPTCP_PM_ADDR_ATTR_FLAGS]);
 
        if (tb[MPTCP_PM_ADDR_ATTR_PORT])
                entry->addr.port = htons(nla_get_u16(tb[MPTCP_PM_ADDR_ATTR_PORT]));
@@ -1176,6 +1159,41 @@ static void mptcp_pm_free_addr_entry(struct mptcp_pm_addr_entry *entry)
        }
 }
 
+static int mptcp_nl_remove_id_zero_address(struct net *net,
+                                          struct mptcp_addr_info *addr)
+{
+       struct mptcp_rm_list list = { .nr = 0 };
+       long s_slot = 0, s_num = 0;
+       struct mptcp_sock *msk;
+
+       list.ids[list.nr++] = 0;
+
+       while ((msk = mptcp_token_iter_next(net, &s_slot, &s_num)) != NULL) {
+               struct sock *sk = (struct sock *)msk;
+               struct mptcp_addr_info msk_local;
+
+               if (list_empty(&msk->conn_list))
+                       goto next;
+
+               local_address((struct sock_common *)msk, &msk_local);
+               if (!addresses_equal(&msk_local, addr, addr->port))
+                       goto next;
+
+               lock_sock(sk);
+               spin_lock_bh(&msk->pm.lock);
+               mptcp_pm_remove_addr(msk, &list);
+               mptcp_pm_nl_rm_subflow_received(msk, &list);
+               spin_unlock_bh(&msk->pm.lock);
+               release_sock(sk);
+
+next:
+               sock_put(sk);
+               cond_resched();
+       }
+
+       return 0;
+}
+
 static int mptcp_nl_cmd_del_addr(struct sk_buff *skb, struct genl_info *info)
 {
        struct nlattr *attr = info->attrs[MPTCP_PM_ATTR_ADDR];
@@ -1188,6 +1206,14 @@ static int mptcp_nl_cmd_del_addr(struct sk_buff *skb, struct genl_info *info)
        if (ret < 0)
                return ret;
 
+       /* the zero id address is special: the first address used by the msk
+        * always gets such an id, so different subflows can have different zero
+        * id addresses. Additionally zero id is not accounted for in id_bitmap.
+        * Let's use an 'mptcp_rm_list' instead of the common remove code.
+        */
+       if (addr.addr.id == 0)
+               return mptcp_nl_remove_id_zero_address(sock_net(skb->sk), &addr.addr);
+
        spin_lock_bh(&pernet->lock);
        entry = __lookup_addr_by_id(pernet, addr.addr.id);
        if (!entry) {
@@ -1195,11 +1221,11 @@ static int mptcp_nl_cmd_del_addr(struct sk_buff *skb, struct genl_info *info)
                spin_unlock_bh(&pernet->lock);
                return -EINVAL;
        }
-       if (entry->addr.flags & MPTCP_PM_ADDR_FLAG_SIGNAL) {
+       if (entry->flags & MPTCP_PM_ADDR_FLAG_SIGNAL) {
                addr_max = pernet->add_addr_signal_max;
                WRITE_ONCE(pernet->add_addr_signal_max, addr_max - 1);
        }
-       if (entry->addr.flags & MPTCP_PM_ADDR_FLAG_SUBFLOW) {
+       if (entry->flags & MPTCP_PM_ADDR_FLAG_SUBFLOW) {
                addr_max = pernet->local_addr_max;
                WRITE_ONCE(pernet->local_addr_max, addr_max - 1);
        }
@@ -1315,10 +1341,10 @@ static int mptcp_nl_fill_addr(struct sk_buff *skb,
                goto nla_put_failure;
        if (nla_put_u8(skb, MPTCP_PM_ADDR_ATTR_ID, addr->id))
                goto nla_put_failure;
-       if (nla_put_u32(skb, MPTCP_PM_ADDR_ATTR_FLAGS, entry->addr.flags))
+       if (nla_put_u32(skb, MPTCP_PM_ADDR_ATTR_FLAGS, entry->flags))
                goto nla_put_failure;
-       if (entry->addr.ifindex &&
-           nla_put_s32(skb, MPTCP_PM_ADDR_ATTR_IF_IDX, entry->addr.ifindex))
+       if (entry->ifindex &&
+           nla_put_s32(skb, MPTCP_PM_ADDR_ATTR_IF_IDX, entry->ifindex))
                goto nla_put_failure;
 
        if (addr->family == AF_INET &&
@@ -1546,7 +1572,7 @@ static int mptcp_nl_cmd_set_flags(struct sk_buff *skb, struct genl_info *info)
        if (ret < 0)
                return ret;
 
-       if (addr.addr.flags & MPTCP_PM_ADDR_FLAG_BACKUP)
+       if (addr.flags & MPTCP_PM_ADDR_FLAG_BACKUP)
                bkup = 1;
 
        list_for_each_entry(entry, &pernet->local_addr_list, list) {
@@ -1556,9 +1582,9 @@ static int mptcp_nl_cmd_set_flags(struct sk_buff *skb, struct genl_info *info)
                                return ret;
 
                        if (bkup)
-                               entry->addr.flags |= MPTCP_PM_ADDR_FLAG_BACKUP;
+                               entry->flags |= MPTCP_PM_ADDR_FLAG_BACKUP;
                        else
-                               entry->addr.flags &= ~MPTCP_PM_ADDR_FLAG_BACKUP;
+                               entry->flags &= ~MPTCP_PM_ADDR_FLAG_BACKUP;
                }
        }
 
@@ -1664,9 +1690,21 @@ static int mptcp_event_sub_closed(struct sk_buff *skb,
                                  const struct mptcp_sock *msk,
                                  const struct sock *ssk)
 {
+       const struct mptcp_subflow_context *sf;
+
        if (mptcp_event_put_token_and_ssk(skb, msk, ssk))
                return -EMSGSIZE;
 
+       sf = mptcp_subflow_ctx(ssk);
+       if (!sf->reset_seen)
+               return 0;
+
+       if (nla_put_u32(skb, MPTCP_ATTR_RESET_REASON, sf->reset_reason))
+               return -EMSGSIZE;
+
+       if (nla_put_u32(skb, MPTCP_ATTR_RESET_FLAGS, sf->reset_transient))
+               return -EMSGSIZE;
+
        return 0;
 }