LCOV - code coverage report
Current view: top level - mptcp/pm.c (source / functions) Coverage Total Hit
Test: export-net Lines: 93.5 % 582 544
Test Date: 2025-06-27 07:18:41 Functions: - 0 0
Legend: Lines: hit not hit | Branches: + taken - not taken # not executed Branches: 68.8 % 480 330

             Branch data     Line data    Source code
       1                 :             : // SPDX-License-Identifier: GPL-2.0
       2                 :             : /* Multipath TCP
       3                 :             :  *
       4                 :             :  * Copyright (c) 2019, Intel Corporation.
       5                 :             :  */
       6                 :             : #define pr_fmt(fmt) "MPTCP: " fmt
       7                 :             : 
       8                 :             : #include <linux/rculist.h>
       9                 :             : #include <linux/spinlock.h>
      10                 :             : #include "protocol.h"
      11                 :             : #include "mib.h"
      12                 :             : 
      13                 :             : #define ADD_ADDR_RETRANS_MAX    3
      14                 :             : 
      15                 :             : struct mptcp_pm_add_entry {
      16                 :             :         struct list_head        list;
      17                 :             :         struct mptcp_addr_info  addr;
      18                 :             :         u8                      retrans_times;
      19                 :             :         struct timer_list       add_timer;
      20                 :             :         struct mptcp_sock       *sock;
      21                 :             : };
      22                 :             : 
      23                 :             : static DEFINE_SPINLOCK(mptcp_pm_list_lock);
      24                 :             : static LIST_HEAD(mptcp_pm_list);
      25                 :             : 
      26                 :             : /* path manager helpers */
      27                 :             : 
      28                 :             : /* if sk is ipv4 or ipv6_only allows only same-family local and remote addresses,
      29                 :             :  * otherwise allow any matching local/remote pair
      30                 :             :  */
      31                 :         561 : bool mptcp_pm_addr_families_match(const struct sock *sk,
      32                 :             :                                   const struct mptcp_addr_info *loc,
      33                 :             :                                   const struct mptcp_addr_info *rem)
      34                 :             : {
      35                 :         561 :         bool mptcp_is_v4 = sk->sk_family == AF_INET;
      36                 :             : 
      37                 :             : #if IS_ENABLED(CONFIG_MPTCP_IPV6)
      38   [ +  +  +  + ]:         561 :         bool loc_is_v4 = loc->family == AF_INET || ipv6_addr_v4mapped(&loc->addr6);
      39   [ +  +  +  + ]:         561 :         bool rem_is_v4 = rem->family == AF_INET || ipv6_addr_v4mapped(&rem->addr6);
      40                 :             : 
      41         [ +  + ]:         561 :         if (mptcp_is_v4)
      42                 :         432 :                 return loc_is_v4 && rem_is_v4;
      43                 :             : 
      44         [ -  + ]:         129 :         if (ipv6_only_sock(sk))
      45                 :           0 :                 return !loc_is_v4 && !rem_is_v4;
      46                 :             : 
      47                 :         129 :         return loc_is_v4 == rem_is_v4;
      48                 :             : #else
      49                 :             :         return mptcp_is_v4 && loc->family == AF_INET && rem->family == AF_INET;
      50                 :             : #endif
      51                 :             : }
      52                 :             : 
      53                 :        8403 : bool mptcp_addresses_equal(const struct mptcp_addr_info *a,
      54                 :             :                            const struct mptcp_addr_info *b, bool use_port)
      55                 :             : {
      56                 :        8403 :         bool addr_equals = false;
      57                 :             : 
      58         [ +  + ]:        8403 :         if (a->family == b->family) {
      59         [ +  + ]:        7017 :                 if (a->family == AF_INET)
      60                 :        6041 :                         addr_equals = a->addr.s_addr == b->addr.s_addr;
      61                 :             : #if IS_ENABLED(CONFIG_MPTCP_IPV6)
      62                 :             :                 else
      63                 :         976 :                         addr_equals = ipv6_addr_equal(&a->addr6, &b->addr6);
      64         [ +  + ]:        1386 :         } else if (a->family == AF_INET) {
      65         [ +  + ]:         986 :                 if (ipv6_addr_v4mapped(&b->addr6))
      66                 :         670 :                         addr_equals = a->addr.s_addr == b->addr6.s6_addr32[3];
      67         [ +  - ]:         400 :         } else if (b->family == AF_INET) {
      68         [ +  + ]:         400 :                 if (ipv6_addr_v4mapped(&a->addr6))
      69                 :         185 :                         addr_equals = a->addr6.s6_addr32[3] == b->addr.s_addr;
      70                 :             : #endif
      71                 :             :         }
      72                 :             : 
      73         [ +  + ]:        7872 :         if (!addr_equals)
      74                 :             :                 return false;
      75         [ +  + ]:        1724 :         if (!use_port)
      76                 :             :                 return true;
      77                 :             : 
      78                 :         598 :         return a->port == b->port;
      79                 :             : }
      80                 :             : 
      81                 :        3201 : void mptcp_local_address(const struct sock_common *skc,
      82                 :             :                          struct mptcp_addr_info *addr)
      83                 :             : {
      84                 :        3201 :         addr->family = skc->skc_family;
      85                 :        3201 :         addr->port = htons(skc->skc_num);
      86         [ +  + ]:        3201 :         if (addr->family == AF_INET)
      87                 :        1430 :                 addr->addr.s_addr = skc->skc_rcv_saddr;
      88                 :             : #if IS_ENABLED(CONFIG_MPTCP_IPV6)
      89         [ +  - ]:        1771 :         else if (addr->family == AF_INET6)
      90                 :        1771 :                 addr->addr6 = skc->skc_v6_rcv_saddr;
      91                 :             : #endif
      92                 :        3201 : }
      93                 :             : 
      94                 :         782 : void mptcp_remote_address(const struct sock_common *skc,
      95                 :             :                           struct mptcp_addr_info *addr)
      96                 :             : {
      97                 :         788 :         addr->family = skc->skc_family;
      98                 :         788 :         addr->port = skc->skc_dport;
      99         [ +  + ]:         794 :         if (addr->family == AF_INET)
     100                 :         596 :                 addr->addr.s_addr = skc->skc_daddr;
     101                 :             : #if IS_ENABLED(CONFIG_MPTCP_IPV6)
     102   [ -  -  -  -  :         192 :         else if (addr->family == AF_INET6)
                   +  - ]
     103                 :           0 :                 addr->addr6 = skc->skc_v6_daddr;
     104                 :             : #endif
     105                 :         794 : }
     106                 :             : 
     107                 :           4 : static bool mptcp_pm_is_init_remote_addr(struct mptcp_sock *msk,
     108                 :             :                                          const struct mptcp_addr_info *remote)
     109                 :             : {
     110                 :           4 :         struct mptcp_addr_info mpc_remote;
     111                 :             : 
     112         [ +  - ]:           4 :         mptcp_remote_address((struct sock_common *)msk, &mpc_remote);
     113                 :           4 :         return mptcp_addresses_equal(&mpc_remote, remote, remote->port);
     114                 :             : }
     115                 :             : 
     116                 :         102 : bool mptcp_lookup_subflow_by_saddr(const struct list_head *list,
     117                 :             :                                    const struct mptcp_addr_info *saddr)
     118                 :             : {
     119                 :         102 :         struct mptcp_subflow_context *subflow;
     120                 :         102 :         struct mptcp_addr_info cur;
     121                 :         102 :         struct sock_common *skc;
     122                 :             : 
     123         [ +  + ]:         222 :         list_for_each_entry(subflow, list, node) {
     124                 :         198 :                 skc = (struct sock_common *)mptcp_subflow_tcp_sock(subflow);
     125                 :             : 
     126                 :         198 :                 mptcp_local_address(skc, &cur);
     127         [ +  + ]:         198 :                 if (mptcp_addresses_equal(&cur, saddr, saddr->port))
     128                 :             :                         return true;
     129                 :             :         }
     130                 :             : 
     131                 :             :         return false;
     132                 :             : }
     133                 :             : 
     134                 :             : static struct mptcp_pm_add_entry *
     135                 :         894 : mptcp_lookup_anno_list_by_saddr(const struct mptcp_sock *msk,
     136                 :             :                                 const struct mptcp_addr_info *addr)
     137                 :             : {
     138                 :         894 :         struct mptcp_pm_add_entry *entry;
     139                 :             : 
     140   [ +  -  -  + ]:         894 :         lockdep_assert_held(&msk->pm.lock);
     141                 :             : 
     142         [ +  + ]:        1188 :         list_for_each_entry(entry, &msk->pm.anno_list, list) {
     143         [ +  + ]:         784 :                 if (mptcp_addresses_equal(&entry->addr, addr, true))
     144                 :             :                         return entry;
     145                 :             :         }
     146                 :             : 
     147                 :             :         return NULL;
     148                 :             : }
     149                 :             : 
     150                 :         130 : bool mptcp_remove_anno_list_by_saddr(struct mptcp_sock *msk,
     151                 :             :                                      const struct mptcp_addr_info *addr)
     152                 :             : {
     153                 :         130 :         struct mptcp_pm_add_entry *entry;
     154                 :         130 :         bool ret;
     155                 :             : 
     156                 :         130 :         entry = mptcp_pm_del_add_timer(msk, addr, false);
     157                 :         130 :         ret = entry;
     158                 :         130 :         kfree(entry);
     159                 :             : 
     160                 :         130 :         return ret;
     161                 :             : }
     162                 :             : 
     163                 :          48 : bool mptcp_pm_sport_in_anno_list(struct mptcp_sock *msk, const struct sock *sk)
     164                 :             : {
     165                 :          48 :         struct mptcp_pm_add_entry *entry;
     166                 :          48 :         struct mptcp_addr_info saddr;
     167                 :          48 :         bool ret = false;
     168                 :             : 
     169                 :          48 :         mptcp_local_address((struct sock_common *)sk, &saddr);
     170                 :             : 
     171                 :          48 :         spin_lock_bh(&msk->pm.lock);
     172         [ +  - ]:          48 :         list_for_each_entry(entry, &msk->pm.anno_list, list) {
     173         [ +  - ]:          48 :                 if (mptcp_addresses_equal(&entry->addr, &saddr, true)) {
     174                 :          48 :                         ret = true;
     175                 :          48 :                         goto out;
     176                 :             :                 }
     177                 :             :         }
     178                 :             : 
     179                 :           0 : out:
     180                 :          48 :         spin_unlock_bh(&msk->pm.lock);
     181                 :          48 :         return ret;
     182                 :             : }
     183                 :             : 
     184                 :         892 : static void __mptcp_pm_send_ack(struct mptcp_sock *msk,
     185                 :             :                                 struct mptcp_subflow_context *subflow,
     186                 :             :                                 bool prio, bool backup)
     187                 :             : {
     188         [ -  + ]:         892 :         struct sock *ssk = mptcp_subflow_tcp_sock(subflow);
     189                 :         892 :         bool slow;
     190                 :             : 
     191   [ -  +  -  -  :         892 :         pr_debug("send ack for %s\n",
                   -  - ]
     192                 :             :                  prio ? "mp_prio" :
     193                 :             :                  (mptcp_pm_should_add_signal(msk) ? "add_addr" : "rm_addr"));
     194                 :             : 
     195                 :         892 :         slow = lock_sock_fast(ssk);
     196         [ +  + ]:         892 :         if (prio) {
     197                 :          28 :                 subflow->send_mp_prio = 1;
     198                 :          28 :                 subflow->request_bkup = backup;
     199                 :             :         }
     200                 :             : 
     201                 :         892 :         __mptcp_subflow_send_ack(ssk);
     202                 :         892 :         unlock_sock_fast(ssk, slow);
     203                 :         892 : }
     204                 :             : 
     205                 :         870 : void mptcp_pm_send_ack(struct mptcp_sock *msk,
     206                 :             :                        struct mptcp_subflow_context *subflow,
     207                 :             :                        bool prio, bool backup)
     208                 :             : {
     209                 :         870 :         spin_unlock_bh(&msk->pm.lock);
     210                 :         870 :         __mptcp_pm_send_ack(msk, subflow, prio, backup);
     211                 :         870 :         spin_lock_bh(&msk->pm.lock);
     212                 :         870 : }
     213                 :             : 
     214                 :         867 : void mptcp_pm_addr_send_ack(struct mptcp_sock *msk)
     215                 :             : {
     216                 :         867 :         struct mptcp_subflow_context *subflow, *alt = NULL;
     217                 :             : 
     218                 :         867 :         msk_owned_by_me(msk);
     219   [ +  -  -  + ]:         867 :         lockdep_assert_held(&msk->pm.lock);
     220                 :             : 
     221   [ +  +  +  + ]:         867 :         if (!mptcp_pm_should_add_signal(msk) &&
     222         [ #  # ]:           0 :             !mptcp_pm_should_rm_signal(msk))
     223                 :             :                 return;
     224                 :             : 
     225         [ +  - ]:         878 :         mptcp_for_each_subflow(msk, subflow) {
     226         [ +  + ]:         878 :                 if (__mptcp_subflow_active(subflow)) {
     227         [ +  - ]:         864 :                         if (!subflow->stale) {
     228                 :         864 :                                 mptcp_pm_send_ack(msk, subflow, false, false);
     229                 :         864 :                                 return;
     230                 :             :                         }
     231                 :             : 
     232         [ #  # ]:           0 :                         if (!alt)
     233                 :           0 :                                 alt = subflow;
     234                 :             :                 }
     235                 :             :         }
     236                 :             : 
     237         [ #  # ]:           0 :         if (alt)
     238                 :           0 :                 mptcp_pm_send_ack(msk, alt, false, false);
     239                 :             : }
     240                 :             : 
     241                 :          26 : int mptcp_pm_mp_prio_send_ack(struct mptcp_sock *msk,
     242                 :             :                               struct mptcp_addr_info *addr,
     243                 :             :                               struct mptcp_addr_info *rem,
     244                 :             :                               u8 bkup)
     245                 :             : {
     246                 :          26 :         struct mptcp_subflow_context *subflow;
     247                 :             : 
     248         [ -  + ]:          26 :         pr_debug("bkup=%d\n", bkup);
     249                 :             : 
     250         [ +  + ]:          46 :         mptcp_for_each_subflow(msk, subflow) {
     251                 :          42 :                 struct sock *ssk = mptcp_subflow_tcp_sock(subflow);
     252                 :          42 :                 struct mptcp_addr_info local, remote;
     253                 :             : 
     254                 :          42 :                 mptcp_local_address((struct sock_common *)ssk, &local);
     255         [ +  + ]:          42 :                 if (!mptcp_addresses_equal(&local, addr, addr->port))
     256                 :          20 :                         continue;
     257                 :             : 
     258   [ +  +  +  - ]:          22 :                 if (rem && rem->family != AF_UNSPEC) {
     259         [ +  - ]:           2 :                         mptcp_remote_address((struct sock_common *)ssk, &remote);
     260         [ -  + ]:           2 :                         if (!mptcp_addresses_equal(&remote, rem, rem->port))
     261                 :           0 :                                 continue;
     262                 :             :                 }
     263                 :             : 
     264                 :          22 :                 __mptcp_pm_send_ack(msk, subflow, true, bkup);
     265                 :          22 :                 return 0;
     266                 :             :         }
     267                 :             : 
     268                 :             :         return -EINVAL;
     269                 :             : }
     270                 :             : 
     271                 :          62 : static void mptcp_pm_add_timer(struct timer_list *timer)
     272                 :             : {
     273                 :          62 :         struct mptcp_pm_add_entry *entry = timer_container_of(entry, timer,
     274                 :             :                                                               add_timer);
     275                 :          62 :         struct mptcp_sock *msk = entry->sock;
     276                 :          62 :         struct sock *sk = (struct sock *)msk;
     277                 :             : 
     278         [ -  + ]:          62 :         pr_debug("msk=%p\n", msk);
     279                 :             : 
     280         [ +  - ]:          62 :         if (!msk)
     281                 :             :                 return;
     282                 :             : 
     283         [ +  - ]:          62 :         if (inet_sk_state_load(sk) == TCP_CLOSE)
     284                 :             :                 return;
     285                 :             : 
     286         [ +  - ]:          62 :         if (!entry->addr.id)
     287                 :             :                 return;
     288                 :             : 
     289         [ +  + ]:          62 :         if (mptcp_pm_should_add_signal_addr(msk)) {
     290                 :           2 :                 sk_reset_timer(sk, timer, jiffies + TCP_RTO_MAX / 8);
     291                 :           2 :                 goto out;
     292                 :             :         }
     293                 :             : 
     294                 :          60 :         spin_lock_bh(&msk->pm.lock);
     295                 :             : 
     296         [ +  - ]:          60 :         if (!mptcp_pm_should_add_signal_addr(msk)) {
     297         [ -  + ]:          60 :                 pr_debug("retransmit ADD_ADDR id=%d\n", entry->addr.id);
     298                 :          60 :                 mptcp_pm_announce_addr(msk, &entry->addr, false);
     299                 :          60 :                 mptcp_pm_add_addr_send_ack(msk);
     300                 :          60 :                 entry->retrans_times++;
     301                 :             :         }
     302                 :             : 
     303         [ +  + ]:          60 :         if (entry->retrans_times < ADD_ADDR_RETRANS_MAX)
     304                 :          48 :                 sk_reset_timer(sk, timer,
     305                 :          48 :                                jiffies + mptcp_get_add_addr_timeout(sock_net(sk)));
     306                 :             : 
     307                 :          60 :         spin_unlock_bh(&msk->pm.lock);
     308                 :             : 
     309         [ +  + ]:          60 :         if (entry->retrans_times == ADD_ADDR_RETRANS_MAX)
     310                 :          12 :                 mptcp_pm_subflow_established(msk);
     311                 :             : 
     312                 :          48 : out:
     313                 :          62 :         __sock_put(sk);
     314                 :             : }
     315                 :             : 
     316                 :             : struct mptcp_pm_add_entry *
     317                 :         461 : mptcp_pm_del_add_timer(struct mptcp_sock *msk,
     318                 :             :                        const struct mptcp_addr_info *addr, bool check_id)
     319                 :             : {
     320                 :         461 :         struct mptcp_pm_add_entry *entry;
     321                 :         461 :         struct sock *sk = (struct sock *)msk;
     322                 :         461 :         struct timer_list *add_timer = NULL;
     323                 :             : 
     324                 :         461 :         spin_lock_bh(&msk->pm.lock);
     325                 :         461 :         entry = mptcp_lookup_anno_list_by_saddr(msk, addr);
     326   [ +  +  +  +  :         461 :         if (entry && (!check_id || entry->addr.id == addr->id)) {
                   +  + ]
     327                 :         393 :                 entry->retrans_times = ADD_ADDR_RETRANS_MAX;
     328                 :         393 :                 add_timer = &entry->add_timer;
     329                 :             :         }
     330         [ +  + ]:         461 :         if (!check_id && entry)
     331                 :          78 :                 list_del(&entry->list);
     332                 :         461 :         spin_unlock_bh(&msk->pm.lock);
     333                 :             : 
     334                 :             :         /* no lock, because sk_stop_timer_sync() is calling timer_delete_sync() */
     335         [ +  + ]:         461 :         if (add_timer)
     336                 :         393 :                 sk_stop_timer_sync(sk, add_timer);
     337                 :             : 
     338                 :         461 :         return entry;
     339                 :             : }
     340                 :             : 
     341                 :         344 : bool mptcp_pm_alloc_anno_list(struct mptcp_sock *msk,
     342                 :             :                               const struct mptcp_addr_info *addr)
     343                 :             : {
     344                 :         344 :         struct mptcp_pm_add_entry *add_entry = NULL;
     345                 :         344 :         struct sock *sk = (struct sock *)msk;
     346                 :         344 :         struct net *net = sock_net(sk);
     347                 :             : 
     348   [ +  -  -  + ]:         344 :         lockdep_assert_held(&msk->pm.lock);
     349                 :             : 
     350                 :         344 :         add_entry = mptcp_lookup_anno_list_by_saddr(msk, addr);
     351                 :             : 
     352         [ -  + ]:         344 :         if (add_entry) {
     353         [ #  # ]:           0 :                 if (WARN_ON_ONCE(mptcp_pm_is_kernel(msk)))
     354                 :           0 :                         return false;
     355                 :             : 
     356                 :           0 :                 sk_reset_timer(sk, &add_entry->add_timer,
     357                 :           0 :                                jiffies + mptcp_get_add_addr_timeout(net));
     358                 :           0 :                 return true;
     359                 :             :         }
     360                 :             : 
     361                 :         344 :         add_entry = kmalloc(sizeof(*add_entry), GFP_ATOMIC);
     362         [ -  + ]:         344 :         if (!add_entry)
     363                 :             :                 return false;
     364                 :             : 
     365                 :         344 :         list_add(&add_entry->list, &msk->pm.anno_list);
     366                 :             : 
     367                 :         344 :         add_entry->addr = *addr;
     368                 :         344 :         add_entry->sock = msk;
     369                 :         344 :         add_entry->retrans_times = 0;
     370                 :             : 
     371                 :         344 :         timer_setup(&add_entry->add_timer, mptcp_pm_add_timer, 0);
     372                 :         688 :         sk_reset_timer(sk, &add_entry->add_timer,
     373                 :         344 :                        jiffies + mptcp_get_add_addr_timeout(net));
     374                 :             : 
     375                 :         344 :         return true;
     376                 :             : }
     377                 :             : 
     378                 :        3569 : static void mptcp_pm_free_anno_list(struct mptcp_sock *msk)
     379                 :             : {
     380                 :        3569 :         struct mptcp_pm_add_entry *entry, *tmp;
     381                 :        3569 :         struct sock *sk = (struct sock *)msk;
     382                 :        3569 :         LIST_HEAD(free_list);
     383                 :             : 
     384         [ -  + ]:        3569 :         pr_debug("msk=%p\n", msk);
     385                 :             : 
     386                 :        3569 :         spin_lock_bh(&msk->pm.lock);
     387         [ +  + ]:        3569 :         list_splice_init(&msk->pm.anno_list, &free_list);
     388                 :        3569 :         spin_unlock_bh(&msk->pm.lock);
     389                 :             : 
     390         [ +  + ]:        3835 :         list_for_each_entry_safe(entry, tmp, &free_list, list) {
     391                 :         266 :                 sk_stop_timer_sync(sk, &entry->add_timer);
     392                 :         266 :                 kfree(entry);
     393                 :             :         }
     394                 :        3569 : }
     395                 :             : 
     396                 :             : /* path manager command handlers */
     397                 :             : 
     398                 :         761 : int mptcp_pm_announce_addr(struct mptcp_sock *msk,
     399                 :             :                            const struct mptcp_addr_info *addr,
     400                 :             :                            bool echo)
     401                 :             : {
     402                 :         761 :         u8 add_addr = READ_ONCE(msk->pm.addr_signal);
     403                 :             : 
     404         [ -  + ]:         761 :         pr_debug("msk=%p, local_id=%d, echo=%d\n", msk, addr->id, echo);
     405                 :             : 
     406   [ +  -  -  + ]:         761 :         lockdep_assert_held(&msk->pm.lock);
     407                 :             : 
     408         [ -  + ]:         761 :         if (add_addr &
     409         [ +  + ]:         761 :             (echo ? BIT(MPTCP_ADD_ADDR_ECHO) : BIT(MPTCP_ADD_ADDR_SIGNAL))) {
     410   [ #  #  #  # ]:           0 :                 MPTCP_INC_STATS(sock_net((struct sock *)msk),
     411                 :             :                                 echo ? MPTCP_MIB_ECHOADDTXDROP : MPTCP_MIB_ADDADDRTXDROP);
     412                 :           0 :                 return -EINVAL;
     413                 :             :         }
     414                 :             : 
     415         [ +  + ]:         761 :         if (echo) {
     416                 :         357 :                 msk->pm.remote = *addr;
     417                 :         357 :                 add_addr |= BIT(MPTCP_ADD_ADDR_ECHO);
     418                 :             :         } else {
     419                 :         404 :                 msk->pm.local = *addr;
     420                 :         404 :                 add_addr |= BIT(MPTCP_ADD_ADDR_SIGNAL);
     421                 :             :         }
     422                 :         761 :         WRITE_ONCE(msk->pm.addr_signal, add_addr);
     423                 :         761 :         return 0;
     424                 :             : }
     425                 :             : 
     426                 :         106 : int mptcp_pm_remove_addr(struct mptcp_sock *msk, const struct mptcp_rm_list *rm_list)
     427                 :             : {
     428                 :         106 :         u8 rm_addr = READ_ONCE(msk->pm.addr_signal);
     429                 :             : 
     430         [ -  + ]:         106 :         pr_debug("msk=%p, rm_list_nr=%d\n", msk, rm_list->nr);
     431                 :             : 
     432         [ -  + ]:         106 :         if (rm_addr) {
     433                 :           0 :                 MPTCP_ADD_STATS(sock_net((struct sock *)msk),
     434                 :           0 :                                 MPTCP_MIB_RMADDRTXDROP, rm_list->nr);
     435                 :           0 :                 return -EINVAL;
     436                 :             :         }
     437                 :             : 
     438                 :         106 :         msk->pm.rm_list_tx = *rm_list;
     439                 :         106 :         rm_addr |= BIT(MPTCP_RM_ADDR_SIGNAL);
     440                 :         106 :         WRITE_ONCE(msk->pm.addr_signal, rm_addr);
     441                 :         106 :         mptcp_pm_addr_send_ack(msk);
     442                 :         106 :         return 0;
     443                 :             : }
     444                 :             : 
     445                 :             : /* path manager event handlers */
     446                 :             : 
     447                 :        2214 : void mptcp_pm_new_connection(struct mptcp_sock *msk, const struct sock *ssk, int server_side)
     448                 :             : {
     449                 :        2214 :         struct mptcp_pm_data *pm = &msk->pm;
     450                 :             : 
     451         [ -  + ]:        2214 :         pr_debug("msk=%p, token=%u side=%d\n", msk, READ_ONCE(msk->token), server_side);
     452                 :             : 
     453                 :        2214 :         WRITE_ONCE(pm->server_side, server_side);
     454                 :        2214 :         mptcp_event(MPTCP_EVENT_CREATED, msk, ssk, GFP_ATOMIC);
     455                 :        2214 : }
     456                 :             : 
     457                 :         457 : bool mptcp_pm_allow_new_subflow(struct mptcp_sock *msk)
     458                 :             : {
     459                 :         457 :         struct mptcp_pm_data *pm = &msk->pm;
     460                 :         457 :         unsigned int subflows_max;
     461                 :         457 :         int ret = 0;
     462                 :             : 
     463         [ +  + ]:         457 :         if (mptcp_pm_is_userspace(msk)) {
     464         [ +  - ]:          22 :                 if (mptcp_userspace_pm_active(msk)) {
     465                 :          22 :                         spin_lock_bh(&pm->lock);
     466                 :          22 :                         pm->subflows++;
     467                 :          22 :                         spin_unlock_bh(&pm->lock);
     468                 :          22 :                         return true;
     469                 :             :                 }
     470                 :             :                 return false;
     471                 :             :         }
     472                 :             : 
     473                 :         435 :         subflows_max = mptcp_pm_get_subflows_max(msk);
     474                 :             : 
     475   [ -  +  -  - ]:         435 :         pr_debug("msk=%p subflows=%d max=%d allow=%d\n", msk, pm->subflows,
     476                 :             :                  subflows_max, READ_ONCE(pm->accept_subflow));
     477                 :             : 
     478                 :             :         /* try to avoid acquiring the lock below */
     479   [ -  +  -  + ]:         435 :         if (!READ_ONCE(pm->accept_subflow))
     480                 :             :                 return false;
     481                 :             : 
     482                 :         435 :         spin_lock_bh(&pm->lock);
     483   [ +  +  +  - ]:         435 :         if (READ_ONCE(pm->accept_subflow)) {
     484                 :         435 :                 ret = pm->subflows < subflows_max;
     485   [ -  +  +  + ]:         435 :                 if (ret && ++pm->subflows == subflows_max)
     486                 :         182 :                         WRITE_ONCE(pm->accept_subflow, false);
     487                 :             :         }
     488                 :         435 :         spin_unlock_bh(&pm->lock);
     489                 :             : 
     490                 :         435 :         return ret;
     491                 :             : }
     492                 :             : 
     493                 :             : /* return true if the new status bit is currently cleared, that is, this event
     494                 :             :  * can be server, eventually by an already scheduled work
     495                 :             :  */
     496                 :        1253 : static bool mptcp_pm_schedule_work(struct mptcp_sock *msk,
     497                 :             :                                    enum mptcp_pm_status new_status)
     498                 :             : {
     499   [ -  +  -  - ]:        1253 :         pr_debug("msk=%p status=%x new=%lx\n", msk, msk->pm.status,
     500                 :             :                  BIT(new_status));
     501   [ +  +  +  + ]:        1253 :         if (msk->pm.status & BIT(new_status))
     502                 :             :                 return false;
     503                 :             : 
     504         [ -  + ]:        1115 :         msk->pm.status |= BIT(new_status);
     505                 :        1115 :         mptcp_schedule_work((struct sock *)msk);
     506                 :        1115 :         return true;
     507                 :             : }
     508                 :             : 
     509                 :        2148 : void mptcp_pm_fully_established(struct mptcp_sock *msk, const struct sock *ssk)
     510                 :             : {
     511                 :        2148 :         struct mptcp_pm_data *pm = &msk->pm;
     512                 :        2148 :         bool announce = false;
     513                 :             : 
     514         [ -  + ]:        2148 :         pr_debug("msk=%p\n", msk);
     515                 :             : 
     516                 :        2148 :         spin_lock_bh(&pm->lock);
     517                 :             : 
     518                 :             :         /* mptcp_pm_fully_established() can be invoked by multiple
     519                 :             :          * racing paths - accept() and check_fully_established()
     520                 :             :          * be sure to serve this event only once.
     521                 :             :          */
     522   [ +  +  +  + ]:        2148 :         if (READ_ONCE(pm->work_pending) &&
     523         [ +  - ]:         352 :             !(pm->status & BIT(MPTCP_PM_ALREADY_ESTABLISHED)))
     524                 :         352 :                 mptcp_pm_schedule_work(msk, MPTCP_PM_ESTABLISHED);
     525                 :             : 
     526         [ +  - ]:        2148 :         if ((pm->status & BIT(MPTCP_PM_ALREADY_ESTABLISHED)) == 0)
     527                 :        2148 :                 announce = true;
     528                 :             : 
     529                 :        2148 :         pm->status |= BIT(MPTCP_PM_ALREADY_ESTABLISHED);
     530                 :        2148 :         spin_unlock_bh(&pm->lock);
     531                 :             : 
     532         [ +  - ]:        2148 :         if (announce)
     533                 :        2148 :                 mptcp_event(MPTCP_EVENT_ESTABLISHED, msk, ssk, GFP_ATOMIC);
     534                 :        2148 : }
     535                 :             : 
     536                 :        3590 : void mptcp_pm_connection_closed(struct mptcp_sock *msk)
     537                 :             : {
     538         [ -  + ]:        3590 :         pr_debug("msk=%p\n", msk);
     539                 :             : 
     540         [ +  + ]:        3590 :         if (msk->token)
     541                 :        2204 :                 mptcp_event(MPTCP_EVENT_CLOSED, msk, NULL, GFP_KERNEL);
     542                 :        3590 : }
     543                 :             : 
     544                 :         900 : void mptcp_pm_subflow_established(struct mptcp_sock *msk)
     545                 :             : {
     546                 :         900 :         struct mptcp_pm_data *pm = &msk->pm;
     547                 :             : 
     548         [ -  + ]:         900 :         pr_debug("msk=%p\n", msk);
     549                 :             : 
     550   [ +  +  +  + ]:         900 :         if (!READ_ONCE(pm->work_pending))
     551                 :             :                 return;
     552                 :             : 
     553                 :         206 :         spin_lock_bh(&pm->lock);
     554                 :             : 
     555   [ +  +  +  - ]:         206 :         if (READ_ONCE(pm->work_pending))
     556                 :         206 :                 mptcp_pm_schedule_work(msk, MPTCP_PM_SUBFLOW_ESTABLISHED);
     557                 :             : 
     558                 :         206 :         spin_unlock_bh(&pm->lock);
     559                 :             : }
     560                 :             : 
     561                 :         728 : void mptcp_pm_subflow_check_next(struct mptcp_sock *msk,
     562                 :             :                                  const struct mptcp_subflow_context *subflow)
     563                 :             : {
     564                 :         728 :         struct mptcp_pm_data *pm = &msk->pm;
     565                 :         728 :         bool update_subflows;
     566                 :             : 
     567                 :         728 :         update_subflows = subflow->request_join || subflow->mp_join;
     568         [ +  + ]:         728 :         if (mptcp_pm_is_userspace(msk)) {
     569         [ +  + ]:          48 :                 if (update_subflows) {
     570                 :          38 :                         spin_lock_bh(&pm->lock);
     571                 :          38 :                         pm->subflows--;
     572                 :          38 :                         spin_unlock_bh(&pm->lock);
     573                 :             :                 }
     574                 :          48 :                 return;
     575                 :             :         }
     576                 :             : 
     577   [ +  +  +  +  :         680 :         if (!READ_ONCE(pm->work_pending) && !update_subflows)
                   +  + ]
     578                 :             :                 return;
     579                 :             : 
     580                 :         275 :         spin_lock_bh(&pm->lock);
     581         [ +  - ]:         275 :         if (update_subflows)
     582                 :         275 :                 __mptcp_pm_close_subflow(msk);
     583                 :             : 
     584                 :             :         /* Even if this subflow is not really established, tell the PM to try
     585                 :             :          * to pick the next ones, if possible.
     586                 :             :          */
     587         [ +  + ]:         275 :         if (mptcp_pm_nl_check_work_pending(msk))
     588                 :          78 :                 mptcp_pm_schedule_work(msk, MPTCP_PM_SUBFLOW_ESTABLISHED);
     589                 :             : 
     590                 :         275 :         spin_unlock_bh(&pm->lock);
     591                 :             : }
     592                 :             : 
     593                 :         366 : void mptcp_pm_add_addr_received(const struct sock *ssk,
     594                 :             :                                 const struct mptcp_addr_info *addr)
     595                 :             : {
     596         [ -  + ]:         366 :         struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(ssk);
     597         [ -  + ]:         366 :         struct mptcp_sock *msk = mptcp_sk(subflow->conn);
     598                 :         366 :         struct mptcp_pm_data *pm = &msk->pm;
     599                 :             : 
     600   [ -  +  -  - ]:         366 :         pr_debug("msk=%p remote_id=%d accept=%d\n", msk, addr->id,
     601                 :             :                  READ_ONCE(pm->accept_addr));
     602                 :             : 
     603                 :         366 :         mptcp_event_addr_announced(ssk, addr);
     604                 :             : 
     605                 :         366 :         spin_lock_bh(&pm->lock);
     606                 :             : 
     607         [ +  + ]:         366 :         if (mptcp_pm_is_userspace(msk)) {
     608         [ +  + ]:          30 :                 if (mptcp_userspace_pm_active(msk)) {
     609                 :          28 :                         mptcp_pm_announce_addr(msk, addr, true);
     610                 :          28 :                         mptcp_pm_add_addr_send_ack(msk);
     611                 :             :                 } else {
     612         [ +  - ]:           2 :                         __MPTCP_INC_STATS(sock_net((struct sock *)msk), MPTCP_MIB_ADDADDRDROP);
     613                 :             :                 }
     614                 :             :         /* id0 should not have a different address */
     615   [ +  +  +  -  :         336 :         } else if ((addr->id == 0 && !mptcp_pm_is_init_remote_addr(msk, addr)) ||
                   +  + ]
     616   [ +  +  +  + ]:         332 :                    (addr->id > 0 && !READ_ONCE(pm->accept_addr))) {
     617                 :          34 :                 mptcp_pm_announce_addr(msk, addr, true);
     618                 :          34 :                 mptcp_pm_add_addr_send_ack(msk);
     619         [ +  + ]:         302 :         } else if (mptcp_pm_schedule_work(msk, MPTCP_PM_ADD_ADDR_RECEIVED)) {
     620                 :         295 :                 pm->remote = *addr;
     621                 :             :         } else {
     622         [ +  - ]:           7 :                 __MPTCP_INC_STATS(sock_net((struct sock *)msk), MPTCP_MIB_ADDADDRDROP);
     623                 :             :         }
     624                 :             : 
     625                 :         366 :         spin_unlock_bh(&pm->lock);
     626                 :         366 : }
     627                 :             : 
     628                 :         331 : void mptcp_pm_add_addr_echoed(struct mptcp_sock *msk,
     629                 :             :                               const struct mptcp_addr_info *addr)
     630                 :             : {
     631                 :         331 :         struct mptcp_pm_data *pm = &msk->pm;
     632                 :             : 
     633         [ -  + ]:         331 :         pr_debug("msk=%p\n", msk);
     634                 :             : 
     635   [ +  +  +  + ]:         331 :         if (!READ_ONCE(pm->work_pending))
     636                 :             :                 return;
     637                 :             : 
     638                 :          89 :         spin_lock_bh(&pm->lock);
     639                 :             : 
     640   [ +  +  +  +  :          89 :         if (mptcp_lookup_anno_list_by_saddr(msk, addr) && READ_ONCE(pm->work_pending))
                   +  - ]
     641                 :          87 :                 mptcp_pm_schedule_work(msk, MPTCP_PM_SUBFLOW_ESTABLISHED);
     642                 :             : 
     643                 :          89 :         spin_unlock_bh(&pm->lock);
     644                 :             : }
     645                 :             : 
     646                 :         122 : void mptcp_pm_add_addr_send_ack(struct mptcp_sock *msk)
     647                 :             : {
     648         [ +  - ]:         122 :         if (!mptcp_pm_should_add_signal(msk))
     649                 :             :                 return;
     650                 :             : 
     651                 :         122 :         mptcp_pm_schedule_work(msk, MPTCP_PM_ADD_ADDR_SEND_ACK);
     652                 :             : }
     653                 :             : 
     654                 :         192 : static void mptcp_pm_rm_addr_or_subflow(struct mptcp_sock *msk,
     655                 :             :                                         const struct mptcp_rm_list *rm_list,
     656                 :             :                                         enum linux_mptcp_mib_field rm_type)
     657                 :             : {
     658                 :         192 :         struct mptcp_subflow_context *subflow, *tmp;
     659                 :         192 :         struct sock *sk = (struct sock *)msk;
     660                 :         192 :         u8 i;
     661                 :             : 
     662   [ -  +  -  - ]:         192 :         pr_debug("%s rm_list_nr %d\n",
     663                 :             :                  rm_type == MPTCP_MIB_RMADDR ? "address" : "subflow", rm_list->nr);
     664                 :             : 
     665                 :         192 :         msk_owned_by_me(msk);
     666                 :             : 
     667         [ +  - ]:         192 :         if (sk->sk_state == TCP_LISTEN)
     668                 :             :                 return;
     669                 :             : 
     670         [ +  - ]:         192 :         if (!rm_list->nr)
     671                 :             :                 return;
     672                 :             : 
     673         [ +  - ]:         192 :         if (list_empty(&msk->conn_list))
     674                 :             :                 return;
     675                 :             : 
     676         [ +  + ]:         402 :         for (i = 0; i < rm_list->nr; i++) {
     677                 :         210 :                 u8 rm_id = rm_list->ids[i];
     678                 :         210 :                 bool removed = false;
     679                 :             : 
     680         [ +  + ]:         720 :                 mptcp_for_each_subflow_safe(msk, subflow, tmp) {
     681                 :         510 :                         struct sock *ssk = mptcp_subflow_tcp_sock(subflow);
     682                 :         510 :                         u8 remote_id = READ_ONCE(subflow->remote_id);
     683                 :         510 :                         int how = RCV_SHUTDOWN | SEND_SHUTDOWN;
     684                 :         510 :                         u8 id = subflow_get_local_id(subflow);
     685                 :             : 
     686   [ +  +  +  + ]:         510 :                         if ((1 << inet_sk_state_load(ssk)) &
     687                 :             :                             (TCPF_FIN_WAIT1 | TCPF_FIN_WAIT2 | TCPF_CLOSING | TCPF_CLOSE))
     688                 :          12 :                                 continue;
     689         [ +  + ]:         498 :                         if (rm_type == MPTCP_MIB_RMADDR && remote_id != rm_id)
     690                 :         170 :                                 continue;
     691         [ +  + ]:         328 :                         if (rm_type == MPTCP_MIB_RMSUBFLOW && id != rm_id)
     692                 :         156 :                                 continue;
     693                 :             : 
     694   [ -  +  -  - ]:         172 :                         pr_debug(" -> %s rm_list_ids[%d]=%u local_id=%u remote_id=%u mpc_id=%u\n",
     695                 :             :                                  rm_type == MPTCP_MIB_RMADDR ? "address" : "subflow",
     696                 :             :                                  i, rm_id, id, remote_id, msk->mpc_endpoint_id);
     697                 :         172 :                         spin_unlock_bh(&msk->pm.lock);
     698                 :         172 :                         mptcp_subflow_shutdown(sk, ssk, how);
     699                 :         172 :                         removed |= subflow->request_join;
     700                 :             : 
     701                 :             :                         /* the following takes care of updating the subflows counter */
     702                 :         172 :                         mptcp_close_ssk(sk, ssk, subflow);
     703                 :         172 :                         spin_lock_bh(&msk->pm.lock);
     704                 :             : 
     705         [ +  + ]:         172 :                         if (rm_type == MPTCP_MIB_RMSUBFLOW)
     706         [ -  + ]:          90 :                                 __MPTCP_INC_STATS(sock_net(sk), rm_type);
     707                 :             :                 }
     708                 :             : 
     709         [ +  + ]:         210 :                 if (rm_type == MPTCP_MIB_RMADDR) {
     710         [ +  - ]:         114 :                         __MPTCP_INC_STATS(sock_net(sk), rm_type);
     711   [ +  +  +  - ]:         114 :                         if (removed && mptcp_pm_is_kernel(msk))
     712                 :          46 :                                 mptcp_pm_nl_rm_addr(msk, rm_id);
     713                 :             :                 }
     714                 :             :         }
     715                 :             : }
     716                 :             : 
     717                 :           0 : static void mptcp_pm_rm_addr_recv(struct mptcp_sock *msk)
     718                 :             : {
     719                 :         106 :         mptcp_pm_rm_addr_or_subflow(msk, &msk->pm.rm_list_rx, MPTCP_MIB_RMADDR);
     720                 :         106 : }
     721                 :             : 
     722                 :          86 : void mptcp_pm_rm_subflow(struct mptcp_sock *msk,
     723                 :             :                          const struct mptcp_rm_list *rm_list)
     724                 :             : {
     725                 :          86 :         mptcp_pm_rm_addr_or_subflow(msk, rm_list, MPTCP_MIB_RMSUBFLOW);
     726                 :          86 : }
     727                 :             : 
     728                 :         106 : void mptcp_pm_rm_addr_received(struct mptcp_sock *msk,
     729                 :             :                                const struct mptcp_rm_list *rm_list)
     730                 :             : {
     731                 :         106 :         struct mptcp_pm_data *pm = &msk->pm;
     732                 :         106 :         u8 i;
     733                 :             : 
     734         [ -  + ]:         106 :         pr_debug("msk=%p remote_ids_nr=%d\n", msk, rm_list->nr);
     735                 :             : 
     736         [ +  + ]:         220 :         for (i = 0; i < rm_list->nr; i++)
     737                 :         114 :                 mptcp_event_addr_removed(msk, rm_list->ids[i]);
     738                 :             : 
     739                 :         106 :         spin_lock_bh(&pm->lock);
     740         [ +  - ]:         106 :         if (mptcp_pm_schedule_work(msk, MPTCP_PM_RM_ADDR_RECEIVED))
     741                 :         106 :                 pm->rm_list_rx = *rm_list;
     742                 :             :         else
     743         [ #  # ]:           0 :                 __MPTCP_INC_STATS(sock_net((struct sock *)msk), MPTCP_MIB_RMADDRDROP);
     744                 :         106 :         spin_unlock_bh(&pm->lock);
     745                 :         106 : }
     746                 :             : 
     747                 :          40 : void mptcp_pm_mp_prio_received(struct sock *ssk, u8 bkup)
     748                 :             : {
     749         [ -  + ]:          40 :         struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(ssk);
     750                 :          40 :         struct sock *sk = subflow->conn;
     751                 :          40 :         struct mptcp_sock *msk;
     752                 :             : 
     753         [ -  + ]:          40 :         pr_debug("subflow->backup=%d, bkup=%d\n", subflow->backup, bkup);
     754         [ -  + ]:          40 :         msk = mptcp_sk(sk);
     755         [ +  - ]:          40 :         if (subflow->backup != bkup)
     756                 :          40 :                 subflow->backup = bkup;
     757                 :             : 
     758                 :          40 :         mptcp_event(MPTCP_EVENT_SUB_PRIORITY, msk, ssk, GFP_ATOMIC);
     759                 :          40 : }
     760                 :             : 
     761                 :           6 : void mptcp_pm_mp_fail_received(struct sock *sk, u64 fail_seq)
     762                 :             : {
     763         [ -  + ]:           6 :         struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
     764         [ -  + ]:           6 :         struct mptcp_sock *msk = mptcp_sk(subflow->conn);
     765                 :             : 
     766         [ -  + ]:           6 :         pr_debug("fail_seq=%llu\n", fail_seq);
     767                 :             : 
     768   [ +  +  +  + ]:           6 :         if (!READ_ONCE(msk->allow_infinite_fallback))
     769                 :             :                 return;
     770                 :             : 
     771         [ +  + ]:           4 :         if (!subflow->fail_tout) {
     772         [ -  + ]:           2 :                 pr_debug("send MP_FAIL response and infinite map\n");
     773                 :             : 
     774                 :           2 :                 subflow->send_mp_fail = 1;
     775                 :           2 :                 subflow->send_infinite_map = 1;
     776                 :           2 :                 tcp_send_ack(sk);
     777                 :             :         } else {
     778         [ -  + ]:           2 :                 pr_debug("MP_FAIL response received\n");
     779                 :           2 :                 WRITE_ONCE(subflow->fail_tout, 0);
     780                 :             :         }
     781                 :             : }
     782                 :             : 
     783                 :         761 : bool mptcp_pm_add_addr_signal(struct mptcp_sock *msk, const struct sk_buff *skb,
     784                 :             :                               unsigned int opt_size, unsigned int remaining,
     785                 :             :                               struct mptcp_addr_info *addr, bool *echo,
     786                 :             :                               bool *drop_other_suboptions)
     787                 :             : {
     788                 :         761 :         int ret = false;
     789                 :         761 :         u8 add_addr;
     790                 :         761 :         u8 family;
     791                 :         761 :         bool port;
     792                 :             : 
     793                 :         761 :         spin_lock_bh(&msk->pm.lock);
     794                 :             : 
     795                 :             :         /* double check after the lock is acquired */
     796         [ -  + ]:         761 :         if (!mptcp_pm_should_add_signal(msk))
     797                 :           0 :                 goto out_unlock;
     798                 :             : 
     799                 :             :         /* always drop every other options for pure ack ADD_ADDR; this is a
     800                 :             :          * plain dup-ack from TCP perspective. The other MPTCP-relevant info,
     801                 :             :          * if any, will be carried by the 'original' TCP ack
     802                 :             :          */
     803   [ +  -  +  - ]:         761 :         if (skb && skb_is_tcp_pure_ack(skb)) {
     804                 :         761 :                 remaining += opt_size;
     805                 :         761 :                 *drop_other_suboptions = true;
     806                 :             :         }
     807                 :             : 
     808         [ +  + ]:         761 :         *echo = mptcp_pm_should_add_signal_echo(msk);
     809   [ +  +  +  + ]:         761 :         port = !!(*echo ? msk->pm.remote.port : msk->pm.local.port);
     810                 :             : 
     811   [ +  +  +  + ]:         761 :         family = *echo ? msk->pm.remote.family : msk->pm.local.family;
     812   [ +  +  +  +  :        1522 :         if (remaining < mptcp_add_addr_len(family, *echo, port))
                   -  + ]
     813                 :           0 :                 goto out_unlock;
     814                 :             : 
     815   [ +  +  +  + ]:         761 :         if (*echo) {
     816                 :         357 :                 *addr = msk->pm.remote;
     817                 :         357 :                 add_addr = msk->pm.addr_signal & ~BIT(MPTCP_ADD_ADDR_ECHO);
     818                 :             :         } else {
     819                 :         404 :                 *addr = msk->pm.local;
     820                 :         404 :                 add_addr = msk->pm.addr_signal & ~BIT(MPTCP_ADD_ADDR_SIGNAL);
     821                 :             :         }
     822                 :         761 :         WRITE_ONCE(msk->pm.addr_signal, add_addr);
     823                 :         761 :         ret = true;
     824                 :             : 
     825                 :         761 : out_unlock:
     826                 :         761 :         spin_unlock_bh(&msk->pm.lock);
     827                 :         761 :         return ret;
     828                 :             : }
     829                 :             : 
     830                 :         106 : bool mptcp_pm_rm_addr_signal(struct mptcp_sock *msk, unsigned int remaining,
     831                 :             :                              struct mptcp_rm_list *rm_list)
     832                 :             : {
     833                 :         106 :         int ret = false, len;
     834                 :         106 :         u8 rm_addr;
     835                 :             : 
     836                 :         106 :         spin_lock_bh(&msk->pm.lock);
     837                 :             : 
     838                 :             :         /* double check after the lock is acquired */
     839         [ -  + ]:         106 :         if (!mptcp_pm_should_rm_signal(msk))
     840                 :           0 :                 goto out_unlock;
     841                 :             : 
     842                 :         106 :         rm_addr = msk->pm.addr_signal & ~BIT(MPTCP_RM_ADDR_SIGNAL);
     843         [ -  + ]:         106 :         len = mptcp_rm_addr_len(&msk->pm.rm_list_tx);
     844                 :           0 :         if (len < 0) {
     845                 :           0 :                 WRITE_ONCE(msk->pm.addr_signal, rm_addr);
     846                 :           0 :                 goto out_unlock;
     847                 :             :         }
     848         [ -  + ]:         106 :         if (remaining < len)
     849                 :           0 :                 goto out_unlock;
     850                 :             : 
     851                 :         106 :         *rm_list = msk->pm.rm_list_tx;
     852                 :         106 :         WRITE_ONCE(msk->pm.addr_signal, rm_addr);
     853                 :         106 :         ret = true;
     854                 :             : 
     855                 :         106 : out_unlock:
     856                 :         106 :         spin_unlock_bh(&msk->pm.lock);
     857                 :         106 :         return ret;
     858                 :             : }
     859                 :             : 
     860                 :         724 : int mptcp_pm_get_local_id(struct mptcp_sock *msk, struct sock_common *skc)
     861                 :             : {
     862                 :         724 :         struct mptcp_pm_addr_entry skc_local = { 0 };
     863                 :         724 :         struct mptcp_addr_info msk_local;
     864                 :             : 
     865         [ -  + ]:         724 :         if (WARN_ON_ONCE(!msk))
     866                 :           0 :                 return -1;
     867                 :             : 
     868                 :             :         /* The 0 ID mapping is defined by the first subflow, copied into the msk
     869                 :             :          * addr
     870                 :             :          */
     871                 :         724 :         mptcp_local_address((struct sock_common *)msk, &msk_local);
     872                 :         724 :         mptcp_local_address((struct sock_common *)skc, &skc_local.addr);
     873         [ +  + ]:         724 :         if (mptcp_addresses_equal(&msk_local, &skc_local.addr, false))
     874                 :             :                 return 0;
     875                 :             : 
     876                 :         384 :         skc_local.addr.id = 0;
     877                 :         384 :         skc_local.flags = MPTCP_PM_ADDR_FLAG_IMPLICIT;
     878                 :             : 
     879         [ +  + ]:         384 :         if (mptcp_pm_is_userspace(msk))
     880                 :          22 :                 return mptcp_userspace_pm_get_local_id(msk, &skc_local);
     881                 :         362 :         return mptcp_pm_nl_get_local_id(msk, &skc_local);
     882                 :             : }
     883                 :             : 
     884                 :         724 : bool mptcp_pm_is_backup(struct mptcp_sock *msk, struct sock_common *skc)
     885                 :             : {
     886                 :         724 :         struct mptcp_addr_info skc_local;
     887                 :             : 
     888                 :         724 :         mptcp_local_address((struct sock_common *)skc, &skc_local);
     889                 :             : 
     890         [ +  + ]:         724 :         if (mptcp_pm_is_userspace(msk))
     891                 :          26 :                 return mptcp_userspace_pm_is_backup(msk, &skc_local);
     892                 :             : 
     893                 :         698 :         return mptcp_pm_nl_is_backup(msk, &skc_local);
     894                 :             : }
     895                 :             : 
     896                 :        1660 : static void mptcp_pm_subflows_chk_stale(const struct mptcp_sock *msk, struct sock *ssk)
     897                 :             : {
     898                 :        1660 :         struct mptcp_subflow_context *iter, *subflow = mptcp_subflow_ctx(ssk);
     899                 :        1660 :         struct sock *sk = (struct sock *)msk;
     900                 :        1660 :         unsigned int active_max_loss_cnt;
     901                 :        1660 :         struct net *net = sock_net(sk);
     902                 :        1660 :         unsigned int stale_loss_cnt;
     903                 :        1660 :         bool slow;
     904                 :             : 
     905                 :        1660 :         stale_loss_cnt = mptcp_stale_loss_cnt(net);
     906   [ +  +  +  -  :        1660 :         if (subflow->stale || !stale_loss_cnt || subflow->stale_count <= stale_loss_cnt)
                   +  + ]
     907                 :             :                 return;
     908                 :             : 
     909                 :             :         /* look for another available subflow not in loss state */
     910                 :        1539 :         active_max_loss_cnt = max_t(int, stale_loss_cnt - 1, 1);
     911         [ +  + ]:        4470 :         mptcp_for_each_subflow(msk, iter) {
     912   [ +  +  +  + ]:        2947 :                 if (iter != subflow && mptcp_subflow_active(iter) &&
     913         [ +  + ]:          20 :                     iter->stale_count < active_max_loss_cnt) {
     914                 :             :                         /* we have some alternatives, try to mark this subflow as idle ...*/
     915                 :          16 :                         slow = lock_sock_fast(ssk);
     916         [ -  + ]:          16 :                         if (!tcp_rtx_and_write_queues_empty(ssk)) {
     917                 :          16 :                                 subflow->stale = 1;
     918                 :          16 :                                 __mptcp_retransmit_pending_data(sk);
     919         [ +  - ]:          16 :                                 MPTCP_INC_STATS(net, MPTCP_MIB_SUBFLOWSTALE);
     920                 :             :                         }
     921                 :          16 :                         unlock_sock_fast(ssk, slow);
     922                 :             : 
     923                 :             :                         /* always try to push the pending data regardless of re-injections:
     924                 :             :                          * we can possibly use backup subflows now, and subflow selection
     925                 :             :                          * is cheap under the msk socket lock
     926                 :             :                          */
     927                 :          16 :                         __mptcp_push_pending(sk, 0);
     928                 :          16 :                         return;
     929                 :             :                 }
     930                 :             :         }
     931                 :             : }
     932                 :             : 
     933                 :        2181 : void mptcp_pm_subflow_chk_stale(const struct mptcp_sock *msk, struct sock *ssk)
     934                 :             : {
     935         [ -  + ]:        2181 :         struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(ssk);
     936         [ -  + ]:        2181 :         u32 rcv_tstamp = READ_ONCE(tcp_sk(ssk)->rcv_tstamp);
     937                 :             : 
     938                 :             :         /* keep track of rtx periods with no progress */
     939         [ +  + ]:        2181 :         if (!subflow->stale_count) {
     940                 :         350 :                 subflow->stale_rcv_tstamp = rcv_tstamp;
     941                 :         350 :                 subflow->stale_count++;
     942         [ +  + ]:        1831 :         } else if (subflow->stale_rcv_tstamp == rcv_tstamp) {
     943         [ +  + ]:        1660 :                 if (subflow->stale_count < U8_MAX)
     944                 :        1570 :                         subflow->stale_count++;
     945                 :        1660 :                 mptcp_pm_subflows_chk_stale(msk, ssk);
     946                 :             :         } else {
     947                 :         171 :                 subflow->stale_count = 0;
     948                 :         171 :                 mptcp_subflow_set_active(subflow);
     949                 :             :         }
     950                 :        2181 : }
     951                 :             : 
     952                 :       11774 : void mptcp_pm_worker(struct mptcp_sock *msk)
     953                 :             : {
     954                 :       11774 :         struct mptcp_pm_data *pm = &msk->pm;
     955                 :             : 
     956                 :       11774 :         msk_owned_by_me(msk);
     957                 :             : 
     958         [ +  + ]:       11774 :         if (!(pm->status & MPTCP_PM_WORK_MASK))
     959                 :             :                 return;
     960                 :             : 
     961                 :         878 :         spin_lock_bh(&msk->pm.lock);
     962                 :             : 
     963         [ -  + ]:         878 :         pr_debug("msk=%p status=%x\n", msk, pm->status);
     964         [ +  + ]:         878 :         if (pm->status & BIT(MPTCP_PM_ADD_ADDR_SEND_ACK)) {
     965                 :         122 :                 pm->status &= ~BIT(MPTCP_PM_ADD_ADDR_SEND_ACK);
     966                 :         122 :                 mptcp_pm_addr_send_ack(msk);
     967                 :             :         }
     968         [ +  + ]:         878 :         if (pm->status & BIT(MPTCP_PM_RM_ADDR_RECEIVED)) {
     969                 :         106 :                 pm->status &= ~BIT(MPTCP_PM_RM_ADDR_RECEIVED);
     970                 :         106 :                 mptcp_pm_rm_addr_recv(msk);
     971                 :             :         }
     972                 :         878 :         __mptcp_pm_kernel_worker(msk);
     973                 :             : 
     974                 :         878 :         spin_unlock_bh(&msk->pm.lock);
     975                 :             : }
     976                 :             : 
     977                 :        3569 : void mptcp_pm_destroy(struct mptcp_sock *msk)
     978                 :             : {
     979                 :        3569 :         mptcp_pm_free_anno_list(msk);
     980                 :             : 
     981         [ +  + ]:        3569 :         if (mptcp_pm_is_userspace(msk))
     982                 :          64 :                 mptcp_userspace_pm_free_local_addr_list(msk);
     983                 :        3569 : }
     984                 :             : 
     985                 :        3646 : void mptcp_pm_data_reset(struct mptcp_sock *msk)
     986                 :             : {
     987                 :        3646 :         u8 pm_type = mptcp_get_pm_type(sock_net((struct sock *)msk));
     988                 :        3646 :         struct mptcp_pm_data *pm = &msk->pm;
     989                 :             : 
     990                 :        3646 :         memset(&pm->reset, 0, sizeof(pm->reset));
     991                 :        3646 :         pm->rm_list_tx.nr = 0;
     992                 :        3646 :         pm->rm_list_rx.nr = 0;
     993                 :        3646 :         WRITE_ONCE(pm->pm_type, pm_type);
     994                 :             : 
     995         [ +  + ]:        3646 :         if (pm_type == MPTCP_PM_TYPE_KERNEL) {
     996                 :        3582 :                 bool subflows_allowed = !!mptcp_pm_get_subflows_max(msk);
     997                 :             : 
     998                 :             :                 /* pm->work_pending must be only be set to 'true' when
     999                 :             :                  * pm->pm_type is set to MPTCP_PM_TYPE_KERNEL
    1000                 :             :                  */
    1001   [ +  +  +  +  :        3582 :                 WRITE_ONCE(pm->work_pending,
                   +  + ]
    1002                 :             :                            (!!mptcp_pm_get_local_addr_max(msk) &&
    1003                 :             :                             subflows_allowed) ||
    1004                 :             :                            !!mptcp_pm_get_add_addr_signal_max(msk));
    1005   [ +  +  -  + ]:        3582 :                 WRITE_ONCE(pm->accept_addr,
    1006                 :             :                            !!mptcp_pm_get_add_addr_accept_max(msk) &&
    1007                 :             :                            subflows_allowed);
    1008                 :        3582 :                 WRITE_ONCE(pm->accept_subflow, subflows_allowed);
    1009                 :             : 
    1010                 :        3582 :                 bitmap_fill(pm->id_avail_bitmap, MPTCP_PM_MAX_ADDR_ID + 1);
    1011                 :             :         }
    1012                 :        3646 : }
    1013                 :             : 
    1014                 :        3588 : void mptcp_pm_data_init(struct mptcp_sock *msk)
    1015                 :             : {
    1016                 :        3588 :         spin_lock_init(&msk->pm.lock);
    1017                 :        3588 :         INIT_LIST_HEAD(&msk->pm.anno_list);
    1018                 :        3588 :         INIT_LIST_HEAD(&msk->pm.userspace_pm_local_addr_list);
    1019                 :        3588 :         mptcp_pm_data_reset(msk);
    1020                 :        3588 : }
    1021                 :             : 
    1022                 :           4 : void __init mptcp_pm_init(void)
    1023                 :             : {
    1024                 :           4 :         mptcp_pm_kernel_register();
    1025                 :           4 :         mptcp_pm_userspace_register();
    1026                 :           4 :         mptcp_pm_nl_init();
    1027                 :           4 : }
    1028                 :             : 
    1029                 :             : /* Must be called with rcu read lock held */
    1030                 :         534 : struct mptcp_pm_ops *mptcp_pm_find(const char *name)
    1031                 :             : {
    1032                 :         534 :         struct mptcp_pm_ops *pm_ops;
    1033                 :             : 
    1034   [ +  +  -  +  :         572 :         list_for_each_entry_rcu(pm_ops, &mptcp_pm_list, list) {
          -  -  -  -  -  
                -  +  + ]
    1035         [ +  + ]:         562 :                 if (!strcmp(pm_ops->name, name))
    1036                 :             :                         return pm_ops;
    1037                 :             :         }
    1038                 :             : 
    1039                 :             :         return NULL;
    1040                 :             : }
    1041                 :             : 
    1042                 :           0 : int mptcp_pm_validate(struct mptcp_pm_ops *pm_ops)
    1043                 :             : {
    1044                 :           0 :         return 0;
    1045                 :             : }
    1046                 :             : 
    1047                 :           8 : int mptcp_pm_register(struct mptcp_pm_ops *pm_ops)
    1048                 :             : {
    1049                 :           8 :         int ret;
    1050                 :             : 
    1051                 :           8 :         ret = mptcp_pm_validate(pm_ops);
    1052                 :           8 :         if (ret)
    1053                 :             :                 return ret;
    1054                 :             : 
    1055                 :           8 :         spin_lock(&mptcp_pm_list_lock);
    1056         [ -  + ]:           8 :         if (mptcp_pm_find(pm_ops->name)) {
    1057                 :           0 :                 spin_unlock(&mptcp_pm_list_lock);
    1058                 :           0 :                 return -EEXIST;
    1059                 :             :         }
    1060                 :           8 :         list_add_tail_rcu(&pm_ops->list, &mptcp_pm_list);
    1061                 :           8 :         spin_unlock(&mptcp_pm_list_lock);
    1062                 :             : 
    1063         [ -  + ]:           8 :         pr_debug("%s registered\n", pm_ops->name);
    1064                 :             :         return 0;
    1065                 :             : }
    1066                 :             : 
    1067                 :           0 : void mptcp_pm_unregister(struct mptcp_pm_ops *pm_ops)
    1068                 :             : {
    1069                 :             :         /* skip unregistering the default path manager */
    1070   [ #  #  #  # ]:           0 :         if (WARN_ON_ONCE(pm_ops == &mptcp_pm_kernel))
    1071                 :             :                 return;
    1072                 :             : 
    1073                 :           0 :         spin_lock(&mptcp_pm_list_lock);
    1074                 :           0 :         list_del_rcu(&pm_ops->list);
    1075                 :           0 :         spin_unlock(&mptcp_pm_list_lock);
    1076                 :             : }
    1077                 :             : 
    1078                 :             : /* Build string with list of available path manager values.
    1079                 :             :  * Similar to tcp_get_available_congestion_control()
    1080                 :             :  */
    1081                 :           8 : void mptcp_pm_get_available(char *buf, size_t maxlen)
    1082                 :             : {
    1083                 :           8 :         struct mptcp_pm_ops *pm_ops;
    1084                 :           8 :         size_t offs = 0;
    1085                 :             : 
    1086                 :           8 :         rcu_read_lock();
    1087   [ +  +  -  +  :          24 :         list_for_each_entry_rcu(pm_ops, &mptcp_pm_list, list) {
          -  -  -  -  -  
                -  +  + ]
    1088                 :          32 :                 offs += snprintf(buf + offs, maxlen - offs, "%s%s",
    1089         [ +  + ]:          16 :                                  offs == 0 ? "" : " ", pm_ops->name);
    1090                 :             : 
    1091   [ -  +  +  - ]:          16 :                 if (WARN_ON_ONCE(offs >= maxlen))
    1092                 :             :                         break;
    1093                 :             :         }
    1094                 :           8 :         rcu_read_unlock();
    1095                 :           8 : }
        

Generated by: LCOV version 2.0-1