linux/net/batman-adv/tp_meter.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0
   2/* Copyright (C) 2012-2018  B.A.T.M.A.N. contributors:
   3 *
   4 * Edo Monticelli, Antonio Quartulli
   5 *
   6 * This program is free software; you can redistribute it and/or
   7 * modify it under the terms of version 2 of the GNU General Public
   8 * License as published by the Free Software Foundation.
   9 *
  10 * This program is distributed in the hope that it will be useful, but
  11 * WITHOUT ANY WARRANTY; without even the implied warranty of
  12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  13 * General Public License for more details.
  14 *
  15 * You should have received a copy of the GNU General Public License
  16 * along with this program; if not, see <http://www.gnu.org/licenses/>.
  17 */
  18
  19#include "tp_meter.h"
  20#include "main.h"
  21
  22#include <linux/atomic.h>
  23#include <linux/build_bug.h>
  24#include <linux/byteorder/generic.h>
  25#include <linux/cache.h>
  26#include <linux/compiler.h>
  27#include <linux/err.h>
  28#include <linux/etherdevice.h>
  29#include <linux/gfp.h>
  30#include <linux/if_ether.h>
  31#include <linux/init.h>
  32#include <linux/jiffies.h>
  33#include <linux/kernel.h>
  34#include <linux/kref.h>
  35#include <linux/kthread.h>
  36#include <linux/list.h>
  37#include <linux/netdevice.h>
  38#include <linux/param.h>
  39#include <linux/printk.h>
  40#include <linux/random.h>
  41#include <linux/rculist.h>
  42#include <linux/rcupdate.h>
  43#include <linux/sched.h>
  44#include <linux/skbuff.h>
  45#include <linux/slab.h>
  46#include <linux/spinlock.h>
  47#include <linux/stddef.h>
  48#include <linux/string.h>
  49#include <linux/timer.h>
  50#include <linux/wait.h>
  51#include <linux/workqueue.h>
  52#include <uapi/linux/batadv_packet.h>
  53#include <uapi/linux/batman_adv.h>
  54
  55#include "hard-interface.h"
  56#include "log.h"
  57#include "netlink.h"
  58#include "originator.h"
  59#include "send.h"
  60
  61/**
  62 * BATADV_TP_DEF_TEST_LENGTH - Default test length if not specified by the user
  63 *  in milliseconds
  64 */
  65#define BATADV_TP_DEF_TEST_LENGTH 10000
  66
  67/**
  68 * BATADV_TP_AWND - Advertised window by the receiver (in bytes)
  69 */
  70#define BATADV_TP_AWND 0x20000000
  71
  72/**
  73 * BATADV_TP_RECV_TIMEOUT - Receiver activity timeout. If the receiver does not
  74 *  get anything for such amount of milliseconds, the connection is killed
  75 */
  76#define BATADV_TP_RECV_TIMEOUT 1000
  77
  78/**
  79 * BATADV_TP_MAX_RTO - Maximum sender timeout. If the sender RTO gets beyond
  80 * such amound of milliseconds, the receiver is considered unreachable and the
  81 * connection is killed
  82 */
  83#define BATADV_TP_MAX_RTO 30000
  84
  85/**
  86 * BATADV_TP_FIRST_SEQ - First seqno of each session. The number is rather high
  87 *  in order to immediately trigger a wrap around (test purposes)
  88 */
  89#define BATADV_TP_FIRST_SEQ ((u32)-1 - 2000)
  90
  91/**
  92 * BATADV_TP_PLEN - length of the payload (data after the batadv_unicast header)
  93 *  to simulate
  94 */
  95#define BATADV_TP_PLEN (BATADV_TP_PACKET_LEN - ETH_HLEN - \
  96                        sizeof(struct batadv_unicast_packet))
  97
  98static u8 batadv_tp_prerandom[4096] __read_mostly;
  99
 100/**
 101 * batadv_tp_session_cookie() - generate session cookie based on session ids
 102 * @session: TP session identifier
 103 * @icmp_uid: icmp pseudo uid of the tp session
 104 *
 105 * Return: 32 bit tp_meter session cookie
 106 */
 107static u32 batadv_tp_session_cookie(const u8 session[2], u8 icmp_uid)
 108{
 109        u32 cookie;
 110
 111        cookie = icmp_uid << 16;
 112        cookie |= session[0] << 8;
 113        cookie |= session[1];
 114
 115        return cookie;
 116}
 117
 118/**
 119 * batadv_tp_cwnd() - compute the new cwnd size
 120 * @base: base cwnd size value
 121 * @increment: the value to add to base to get the new size
 122 * @min: minumim cwnd value (usually MSS)
 123 *
 124 * Return the new cwnd size and ensures it does not exceed the Advertised
 125 * Receiver Window size. It is wrap around safe.
 126 * For details refer to Section 3.1 of RFC5681
 127 *
 128 * Return: new congestion window size in bytes
 129 */
 130static u32 batadv_tp_cwnd(u32 base, u32 increment, u32 min)
 131{
 132        u32 new_size = base + increment;
 133
 134        /* check for wrap-around */
 135        if (new_size < base)
 136                new_size = (u32)ULONG_MAX;
 137
 138        new_size = min_t(u32, new_size, BATADV_TP_AWND);
 139
 140        return max_t(u32, new_size, min);
 141}
 142
 143/**
 144 * batadv_tp_updated_cwnd() - update the Congestion Windows
 145 * @tp_vars: the private data of the current TP meter session
 146 * @mss: maximum segment size of transmission
 147 *
 148 * 1) if the session is in Slow Start, the CWND has to be increased by 1
 149 * MSS every unique received ACK
 150 * 2) if the session is in Congestion Avoidance, the CWND has to be
 151 * increased by MSS * MSS / CWND for every unique received ACK
 152 */
 153static void batadv_tp_update_cwnd(struct batadv_tp_vars *tp_vars, u32 mss)
 154{
 155        spin_lock_bh(&tp_vars->cwnd_lock);
 156
 157        /* slow start... */
 158        if (tp_vars->cwnd <= tp_vars->ss_threshold) {
 159                tp_vars->dec_cwnd = 0;
 160                tp_vars->cwnd = batadv_tp_cwnd(tp_vars->cwnd, mss, mss);
 161                spin_unlock_bh(&tp_vars->cwnd_lock);
 162                return;
 163        }
 164
 165        /* increment CWND at least of 1 (section 3.1 of RFC5681) */
 166        tp_vars->dec_cwnd += max_t(u32, 1U << 3,
 167                                   ((mss * mss) << 6) / (tp_vars->cwnd << 3));
 168        if (tp_vars->dec_cwnd < (mss << 3)) {
 169                spin_unlock_bh(&tp_vars->cwnd_lock);
 170                return;
 171        }
 172
 173        tp_vars->cwnd = batadv_tp_cwnd(tp_vars->cwnd, mss, mss);
 174        tp_vars->dec_cwnd = 0;
 175
 176        spin_unlock_bh(&tp_vars->cwnd_lock);
 177}
 178
 179/**
 180 * batadv_tp_update_rto() - calculate new retransmission timeout
 181 * @tp_vars: the private data of the current TP meter session
 182 * @new_rtt: new roundtrip time in msec
 183 */
 184static void batadv_tp_update_rto(struct batadv_tp_vars *tp_vars,
 185                                 u32 new_rtt)
 186{
 187        long m = new_rtt;
 188
 189        /* RTT update
 190         * Details in Section 2.2 and 2.3 of RFC6298
 191         *
 192         * It's tricky to understand. Don't lose hair please.
 193         * Inspired by tcp_rtt_estimator() tcp_input.c
 194         */
 195        if (tp_vars->srtt != 0) {
 196                m -= (tp_vars->srtt >> 3); /* m is now error in rtt est */
 197                tp_vars->srtt += m; /* rtt = 7/8 srtt + 1/8 new */
 198                if (m < 0)
 199                        m = -m;
 200
 201                m -= (tp_vars->rttvar >> 2);
 202                tp_vars->rttvar += m; /* mdev ~= 3/4 rttvar + 1/4 new */
 203        } else {
 204                /* first measure getting in */
 205                tp_vars->srtt = m << 3; /* take the measured time to be srtt */
 206                tp_vars->rttvar = m << 1; /* new_rtt / 2 */
 207        }
 208
 209        /* rto = srtt + 4 * rttvar.
 210         * rttvar is scaled by 4, therefore doesn't need to be multiplied
 211         */
 212        tp_vars->rto = (tp_vars->srtt >> 3) + tp_vars->rttvar;
 213}
 214
 215/**
 216 * batadv_tp_batctl_notify() - send client status result to client
 217 * @reason: reason for tp meter session stop
 218 * @dst: destination of tp_meter session
 219 * @bat_priv: the bat priv with all the soft interface information
 220 * @start_time: start of transmission in jiffies
 221 * @total_sent: bytes acked to the receiver
 222 * @cookie: cookie of tp_meter session
 223 */
 224static void batadv_tp_batctl_notify(enum batadv_tp_meter_reason reason,
 225                                    const u8 *dst, struct batadv_priv *bat_priv,
 226                                    unsigned long start_time, u64 total_sent,
 227                                    u32 cookie)
 228{
 229        u32 test_time;
 230        u8 result;
 231        u32 total_bytes;
 232
 233        if (!batadv_tp_is_error(reason)) {
 234                result = BATADV_TP_REASON_COMPLETE;
 235                test_time = jiffies_to_msecs(jiffies - start_time);
 236                total_bytes = total_sent;
 237        } else {
 238                result = reason;
 239                test_time = 0;
 240                total_bytes = 0;
 241        }
 242
 243        batadv_netlink_tpmeter_notify(bat_priv, dst, result, test_time,
 244                                      total_bytes, cookie);
 245}
 246
 247/**
 248 * batadv_tp_batctl_error_notify() - send client error result to client
 249 * @reason: reason for tp meter session stop
 250 * @dst: destination of tp_meter session
 251 * @bat_priv: the bat priv with all the soft interface information
 252 * @cookie: cookie of tp_meter session
 253 */
 254static void batadv_tp_batctl_error_notify(enum batadv_tp_meter_reason reason,
 255                                          const u8 *dst,
 256                                          struct batadv_priv *bat_priv,
 257                                          u32 cookie)
 258{
 259        batadv_tp_batctl_notify(reason, dst, bat_priv, 0, 0, cookie);
 260}
 261
 262/**
 263 * batadv_tp_list_find() - find a tp_vars object in the global list
 264 * @bat_priv: the bat priv with all the soft interface information
 265 * @dst: the other endpoint MAC address to look for
 266 *
 267 * Look for a tp_vars object matching dst as end_point and return it after
 268 * having incremented the refcounter. Return NULL is not found
 269 *
 270 * Return: matching tp_vars or NULL when no tp_vars with @dst was found
 271 */
 272static struct batadv_tp_vars *batadv_tp_list_find(struct batadv_priv *bat_priv,
 273                                                  const u8 *dst)
 274{
 275        struct batadv_tp_vars *pos, *tp_vars = NULL;
 276
 277        rcu_read_lock();
 278        hlist_for_each_entry_rcu(pos, &bat_priv->tp_list, list) {
 279                if (!batadv_compare_eth(pos->other_end, dst))
 280                        continue;
 281
 282                /* most of the time this function is invoked during the normal
 283                 * process..it makes sens to pay more when the session is
 284                 * finished and to speed the process up during the measurement
 285                 */
 286                if (unlikely(!kref_get_unless_zero(&pos->refcount)))
 287                        continue;
 288
 289                tp_vars = pos;
 290                break;
 291        }
 292        rcu_read_unlock();
 293
 294        return tp_vars;
 295}
 296
 297/**
 298 * batadv_tp_list_find_session() - find tp_vars session object in the global
 299 *  list
 300 * @bat_priv: the bat priv with all the soft interface information
 301 * @dst: the other endpoint MAC address to look for
 302 * @session: session identifier
 303 *
 304 * Look for a tp_vars object matching dst as end_point, session as tp meter
 305 * session and return it after having incremented the refcounter. Return NULL
 306 * is not found
 307 *
 308 * Return: matching tp_vars or NULL when no tp_vars was found
 309 */
 310static struct batadv_tp_vars *
 311batadv_tp_list_find_session(struct batadv_priv *bat_priv, const u8 *dst,
 312                            const u8 *session)
 313{
 314        struct batadv_tp_vars *pos, *tp_vars = NULL;
 315
 316        rcu_read_lock();
 317        hlist_for_each_entry_rcu(pos, &bat_priv->tp_list, list) {
 318                if (!batadv_compare_eth(pos->other_end, dst))
 319                        continue;
 320
 321                if (memcmp(pos->session, session, sizeof(pos->session)) != 0)
 322                        continue;
 323
 324                /* most of the time this function is invoked during the normal
 325                 * process..it makes sense to pay more when the session is
 326                 * finished and to speed the process up during the measurement
 327                 */
 328                if (unlikely(!kref_get_unless_zero(&pos->refcount)))
 329                        continue;
 330
 331                tp_vars = pos;
 332                break;
 333        }
 334        rcu_read_unlock();
 335
 336        return tp_vars;
 337}
 338
 339/**
 340 * batadv_tp_vars_release() - release batadv_tp_vars from lists and queue for
 341 *  free after rcu grace period
 342 * @ref: kref pointer of the batadv_tp_vars
 343 */
 344static void batadv_tp_vars_release(struct kref *ref)
 345{
 346        struct batadv_tp_vars *tp_vars;
 347        struct batadv_tp_unacked *un, *safe;
 348
 349        tp_vars = container_of(ref, struct batadv_tp_vars, refcount);
 350
 351        /* lock should not be needed because this object is now out of any
 352         * context!
 353         */
 354        spin_lock_bh(&tp_vars->unacked_lock);
 355        list_for_each_entry_safe(un, safe, &tp_vars->unacked_list, list) {
 356                list_del(&un->list);
 357                kfree(un);
 358        }
 359        spin_unlock_bh(&tp_vars->unacked_lock);
 360
 361        kfree_rcu(tp_vars, rcu);
 362}
 363
 364/**
 365 * batadv_tp_vars_put() - decrement the batadv_tp_vars refcounter and possibly
 366 *  release it
 367 * @tp_vars: the private data of the current TP meter session to be free'd
 368 */
 369static void batadv_tp_vars_put(struct batadv_tp_vars *tp_vars)
 370{
 371        kref_put(&tp_vars->refcount, batadv_tp_vars_release);
 372}
 373
 374/**
 375 * batadv_tp_sender_cleanup() - cleanup sender data and drop and timer
 376 * @bat_priv: the bat priv with all the soft interface information
 377 * @tp_vars: the private data of the current TP meter session to cleanup
 378 */
 379static void batadv_tp_sender_cleanup(struct batadv_priv *bat_priv,
 380                                     struct batadv_tp_vars *tp_vars)
 381{
 382        cancel_delayed_work(&tp_vars->finish_work);
 383
 384        spin_lock_bh(&tp_vars->bat_priv->tp_list_lock);
 385        hlist_del_rcu(&tp_vars->list);
 386        spin_unlock_bh(&tp_vars->bat_priv->tp_list_lock);
 387
 388        /* drop list reference */
 389        batadv_tp_vars_put(tp_vars);
 390
 391        atomic_dec(&tp_vars->bat_priv->tp_num);
 392
 393        /* kill the timer and remove its reference */
 394        del_timer_sync(&tp_vars->timer);
 395        /* the worker might have rearmed itself therefore we kill it again. Note
 396         * that if the worker should run again before invoking the following
 397         * del_timer(), it would not re-arm itself once again because the status
 398         * is OFF now
 399         */
 400        del_timer(&tp_vars->timer);
 401        batadv_tp_vars_put(tp_vars);
 402}
 403
 404/**
 405 * batadv_tp_sender_end() - print info about ended session and inform client
 406 * @bat_priv: the bat priv with all the soft interface information
 407 * @tp_vars: the private data of the current TP meter session
 408 */
 409static void batadv_tp_sender_end(struct batadv_priv *bat_priv,
 410                                 struct batadv_tp_vars *tp_vars)
 411{
 412        u32 session_cookie;
 413
 414        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 415                   "Test towards %pM finished..shutting down (reason=%d)\n",
 416                   tp_vars->other_end, tp_vars->reason);
 417
 418        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 419                   "Last timing stats: SRTT=%ums RTTVAR=%ums RTO=%ums\n",
 420                   tp_vars->srtt >> 3, tp_vars->rttvar >> 2, tp_vars->rto);
 421
 422        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 423                   "Final values: cwnd=%u ss_threshold=%u\n",
 424                   tp_vars->cwnd, tp_vars->ss_threshold);
 425
 426        session_cookie = batadv_tp_session_cookie(tp_vars->session,
 427                                                  tp_vars->icmp_uid);
 428
 429        batadv_tp_batctl_notify(tp_vars->reason,
 430                                tp_vars->other_end,
 431                                bat_priv,
 432                                tp_vars->start_time,
 433                                atomic64_read(&tp_vars->tot_sent),
 434                                session_cookie);
 435}
 436
 437/**
 438 * batadv_tp_sender_shutdown() - let sender thread/timer stop gracefully
 439 * @tp_vars: the private data of the current TP meter session
 440 * @reason: reason for tp meter session stop
 441 */
 442static void batadv_tp_sender_shutdown(struct batadv_tp_vars *tp_vars,
 443                                      enum batadv_tp_meter_reason reason)
 444{
 445        if (!atomic_dec_and_test(&tp_vars->sending))
 446                return;
 447
 448        tp_vars->reason = reason;
 449}
 450
 451/**
 452 * batadv_tp_sender_finish() - stop sender session after test_length was reached
 453 * @work: delayed work reference of the related tp_vars
 454 */
 455static void batadv_tp_sender_finish(struct work_struct *work)
 456{
 457        struct delayed_work *delayed_work;
 458        struct batadv_tp_vars *tp_vars;
 459
 460        delayed_work = to_delayed_work(work);
 461        tp_vars = container_of(delayed_work, struct batadv_tp_vars,
 462                               finish_work);
 463
 464        batadv_tp_sender_shutdown(tp_vars, BATADV_TP_REASON_COMPLETE);
 465}
 466
 467/**
 468 * batadv_tp_reset_sender_timer() - reschedule the sender timer
 469 * @tp_vars: the private TP meter data for this session
 470 *
 471 * Reschedule the timer using tp_vars->rto as delay
 472 */
 473static void batadv_tp_reset_sender_timer(struct batadv_tp_vars *tp_vars)
 474{
 475        /* most of the time this function is invoked while normal packet
 476         * reception...
 477         */
 478        if (unlikely(atomic_read(&tp_vars->sending) == 0))
 479                /* timer ref will be dropped in batadv_tp_sender_cleanup */
 480                return;
 481
 482        mod_timer(&tp_vars->timer, jiffies + msecs_to_jiffies(tp_vars->rto));
 483}
 484
 485/**
 486 * batadv_tp_sender_timeout() - timer that fires in case of packet loss
 487 * @t: address to timer_list inside tp_vars
 488 *
 489 * If fired it means that there was packet loss.
 490 * Switch to Slow Start, set the ss_threshold to half of the current cwnd and
 491 * reset the cwnd to 3*MSS
 492 */
 493static void batadv_tp_sender_timeout(struct timer_list *t)
 494{
 495        struct batadv_tp_vars *tp_vars = from_timer(tp_vars, t, timer);
 496        struct batadv_priv *bat_priv = tp_vars->bat_priv;
 497
 498        if (atomic_read(&tp_vars->sending) == 0)
 499                return;
 500
 501        /* if the user waited long enough...shutdown the test */
 502        if (unlikely(tp_vars->rto >= BATADV_TP_MAX_RTO)) {
 503                batadv_tp_sender_shutdown(tp_vars,
 504                                          BATADV_TP_REASON_DST_UNREACHABLE);
 505                return;
 506        }
 507
 508        /* RTO exponential backoff
 509         * Details in Section 5.5 of RFC6298
 510         */
 511        tp_vars->rto <<= 1;
 512
 513        spin_lock_bh(&tp_vars->cwnd_lock);
 514
 515        tp_vars->ss_threshold = tp_vars->cwnd >> 1;
 516        if (tp_vars->ss_threshold < BATADV_TP_PLEN * 2)
 517                tp_vars->ss_threshold = BATADV_TP_PLEN * 2;
 518
 519        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 520                   "Meter: RTO fired during test towards %pM! cwnd=%u new ss_thr=%u, resetting last_sent to %u\n",
 521                   tp_vars->other_end, tp_vars->cwnd, tp_vars->ss_threshold,
 522                   atomic_read(&tp_vars->last_acked));
 523
 524        tp_vars->cwnd = BATADV_TP_PLEN * 3;
 525
 526        spin_unlock_bh(&tp_vars->cwnd_lock);
 527
 528        /* resend the non-ACKed packets.. */
 529        tp_vars->last_sent = atomic_read(&tp_vars->last_acked);
 530        wake_up(&tp_vars->more_bytes);
 531
 532        batadv_tp_reset_sender_timer(tp_vars);
 533}
 534
 535/**
 536 * batadv_tp_fill_prerandom() - Fill buffer with prefetched random bytes
 537 * @tp_vars: the private TP meter data for this session
 538 * @buf: Buffer to fill with bytes
 539 * @nbytes: amount of pseudorandom bytes
 540 */
 541static void batadv_tp_fill_prerandom(struct batadv_tp_vars *tp_vars,
 542                                     u8 *buf, size_t nbytes)
 543{
 544        u32 local_offset;
 545        size_t bytes_inbuf;
 546        size_t to_copy;
 547        size_t pos = 0;
 548
 549        spin_lock_bh(&tp_vars->prerandom_lock);
 550        local_offset = tp_vars->prerandom_offset;
 551        tp_vars->prerandom_offset += nbytes;
 552        tp_vars->prerandom_offset %= sizeof(batadv_tp_prerandom);
 553        spin_unlock_bh(&tp_vars->prerandom_lock);
 554
 555        while (nbytes) {
 556                local_offset %= sizeof(batadv_tp_prerandom);
 557                bytes_inbuf = sizeof(batadv_tp_prerandom) - local_offset;
 558                to_copy = min(nbytes, bytes_inbuf);
 559
 560                memcpy(&buf[pos], &batadv_tp_prerandom[local_offset], to_copy);
 561                pos += to_copy;
 562                nbytes -= to_copy;
 563                local_offset = 0;
 564        }
 565}
 566
 567/**
 568 * batadv_tp_send_msg() - send a single message
 569 * @tp_vars: the private TP meter data for this session
 570 * @src: source mac address
 571 * @orig_node: the originator of the destination
 572 * @seqno: sequence number of this packet
 573 * @len: length of the entire packet
 574 * @session: session identifier
 575 * @uid: local ICMP "socket" index
 576 * @timestamp: timestamp in jiffies which is replied in ack
 577 *
 578 * Create and send a single TP Meter message.
 579 *
 580 * Return: 0 on success, BATADV_TP_REASON_DST_UNREACHABLE if the destination is
 581 * not reachable, BATADV_TP_REASON_MEMORY_ERROR if the packet couldn't be
 582 * allocated
 583 */
 584static int batadv_tp_send_msg(struct batadv_tp_vars *tp_vars, const u8 *src,
 585                              struct batadv_orig_node *orig_node,
 586                              u32 seqno, size_t len, const u8 *session,
 587                              int uid, u32 timestamp)
 588{
 589        struct batadv_icmp_tp_packet *icmp;
 590        struct sk_buff *skb;
 591        int r;
 592        u8 *data;
 593        size_t data_len;
 594
 595        skb = netdev_alloc_skb_ip_align(NULL, len + ETH_HLEN);
 596        if (unlikely(!skb))
 597                return BATADV_TP_REASON_MEMORY_ERROR;
 598
 599        skb_reserve(skb, ETH_HLEN);
 600        icmp = skb_put(skb, sizeof(*icmp));
 601
 602        /* fill the icmp header */
 603        ether_addr_copy(icmp->dst, orig_node->orig);
 604        ether_addr_copy(icmp->orig, src);
 605        icmp->version = BATADV_COMPAT_VERSION;
 606        icmp->packet_type = BATADV_ICMP;
 607        icmp->ttl = BATADV_TTL;
 608        icmp->msg_type = BATADV_TP;
 609        icmp->uid = uid;
 610
 611        icmp->subtype = BATADV_TP_MSG;
 612        memcpy(icmp->session, session, sizeof(icmp->session));
 613        icmp->seqno = htonl(seqno);
 614        icmp->timestamp = htonl(timestamp);
 615
 616        data_len = len - sizeof(*icmp);
 617        data = skb_put(skb, data_len);
 618        batadv_tp_fill_prerandom(tp_vars, data, data_len);
 619
 620        r = batadv_send_skb_to_orig(skb, orig_node, NULL);
 621        if (r == NET_XMIT_SUCCESS)
 622                return 0;
 623
 624        return BATADV_TP_REASON_CANT_SEND;
 625}
 626
 627/**
 628 * batadv_tp_recv_ack() - ACK receiving function
 629 * @bat_priv: the bat priv with all the soft interface information
 630 * @skb: the buffer containing the received packet
 631 *
 632 * Process a received TP ACK packet
 633 */
 634static void batadv_tp_recv_ack(struct batadv_priv *bat_priv,
 635                               const struct sk_buff *skb)
 636{
 637        struct batadv_hard_iface *primary_if = NULL;
 638        struct batadv_orig_node *orig_node = NULL;
 639        const struct batadv_icmp_tp_packet *icmp;
 640        struct batadv_tp_vars *tp_vars;
 641        size_t packet_len, mss;
 642        u32 rtt, recv_ack, cwnd;
 643        unsigned char *dev_addr;
 644
 645        packet_len = BATADV_TP_PLEN;
 646        mss = BATADV_TP_PLEN;
 647        packet_len += sizeof(struct batadv_unicast_packet);
 648
 649        icmp = (struct batadv_icmp_tp_packet *)skb->data;
 650
 651        /* find the tp_vars */
 652        tp_vars = batadv_tp_list_find_session(bat_priv, icmp->orig,
 653                                              icmp->session);
 654        if (unlikely(!tp_vars))
 655                return;
 656
 657        if (unlikely(atomic_read(&tp_vars->sending) == 0))
 658                goto out;
 659
 660        /* old ACK? silently drop it.. */
 661        if (batadv_seq_before(ntohl(icmp->seqno),
 662                              (u32)atomic_read(&tp_vars->last_acked)))
 663                goto out;
 664
 665        primary_if = batadv_primary_if_get_selected(bat_priv);
 666        if (unlikely(!primary_if))
 667                goto out;
 668
 669        orig_node = batadv_orig_hash_find(bat_priv, icmp->orig);
 670        if (unlikely(!orig_node))
 671                goto out;
 672
 673        /* update RTO with the new sampled RTT, if any */
 674        rtt = jiffies_to_msecs(jiffies) - ntohl(icmp->timestamp);
 675        if (icmp->timestamp && rtt)
 676                batadv_tp_update_rto(tp_vars, rtt);
 677
 678        /* ACK for new data... reset the timer */
 679        batadv_tp_reset_sender_timer(tp_vars);
 680
 681        recv_ack = ntohl(icmp->seqno);
 682
 683        /* check if this ACK is a duplicate */
 684        if (atomic_read(&tp_vars->last_acked) == recv_ack) {
 685                atomic_inc(&tp_vars->dup_acks);
 686                if (atomic_read(&tp_vars->dup_acks) != 3)
 687                        goto out;
 688
 689                if (recv_ack >= tp_vars->recover)
 690                        goto out;
 691
 692                /* if this is the third duplicate ACK do Fast Retransmit */
 693                batadv_tp_send_msg(tp_vars, primary_if->net_dev->dev_addr,
 694                                   orig_node, recv_ack, packet_len,
 695                                   icmp->session, icmp->uid,
 696                                   jiffies_to_msecs(jiffies));
 697
 698                spin_lock_bh(&tp_vars->cwnd_lock);
 699
 700                /* Fast Recovery */
 701                tp_vars->fast_recovery = true;
 702                /* Set recover to the last outstanding seqno when Fast Recovery
 703                 * is entered. RFC6582, Section 3.2, step 1
 704                 */
 705                tp_vars->recover = tp_vars->last_sent;
 706                tp_vars->ss_threshold = tp_vars->cwnd >> 1;
 707                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 708                           "Meter: Fast Recovery, (cur cwnd=%u) ss_thr=%u last_sent=%u recv_ack=%u\n",
 709                           tp_vars->cwnd, tp_vars->ss_threshold,
 710                           tp_vars->last_sent, recv_ack);
 711                tp_vars->cwnd = batadv_tp_cwnd(tp_vars->ss_threshold, 3 * mss,
 712                                               mss);
 713                tp_vars->dec_cwnd = 0;
 714                tp_vars->last_sent = recv_ack;
 715
 716                spin_unlock_bh(&tp_vars->cwnd_lock);
 717        } else {
 718                /* count the acked data */
 719                atomic64_add(recv_ack - atomic_read(&tp_vars->last_acked),
 720                             &tp_vars->tot_sent);
 721                /* reset the duplicate ACKs counter */
 722                atomic_set(&tp_vars->dup_acks, 0);
 723
 724                if (tp_vars->fast_recovery) {
 725                        /* partial ACK */
 726                        if (batadv_seq_before(recv_ack, tp_vars->recover)) {
 727                                /* this is another hole in the window. React
 728                                 * immediately as specified by NewReno (see
 729                                 * Section 3.2 of RFC6582 for details)
 730                                 */
 731                                dev_addr = primary_if->net_dev->dev_addr;
 732                                batadv_tp_send_msg(tp_vars, dev_addr,
 733                                                   orig_node, recv_ack,
 734                                                   packet_len, icmp->session,
 735                                                   icmp->uid,
 736                                                   jiffies_to_msecs(jiffies));
 737                                tp_vars->cwnd = batadv_tp_cwnd(tp_vars->cwnd,
 738                                                               mss, mss);
 739                        } else {
 740                                tp_vars->fast_recovery = false;
 741                                /* set cwnd to the value of ss_threshold at the
 742                                 * moment that Fast Recovery was entered.
 743                                 * RFC6582, Section 3.2, step 3
 744                                 */
 745                                cwnd = batadv_tp_cwnd(tp_vars->ss_threshold, 0,
 746                                                      mss);
 747                                tp_vars->cwnd = cwnd;
 748                        }
 749                        goto move_twnd;
 750                }
 751
 752                if (recv_ack - atomic_read(&tp_vars->last_acked) >= mss)
 753                        batadv_tp_update_cwnd(tp_vars, mss);
 754move_twnd:
 755                /* move the Transmit Window */
 756                atomic_set(&tp_vars->last_acked, recv_ack);
 757        }
 758
 759        wake_up(&tp_vars->more_bytes);
 760out:
 761        if (likely(primary_if))
 762                batadv_hardif_put(primary_if);
 763        if (likely(orig_node))
 764                batadv_orig_node_put(orig_node);
 765        if (likely(tp_vars))
 766                batadv_tp_vars_put(tp_vars);
 767}
 768
 769/**
 770 * batadv_tp_avail() - check if congestion window is not full
 771 * @tp_vars: the private data of the current TP meter session
 772 * @payload_len: size of the payload of a single message
 773 *
 774 * Return: true when congestion window is not full, false otherwise
 775 */
 776static bool batadv_tp_avail(struct batadv_tp_vars *tp_vars,
 777                            size_t payload_len)
 778{
 779        u32 win_left, win_limit;
 780
 781        win_limit = atomic_read(&tp_vars->last_acked) + tp_vars->cwnd;
 782        win_left = win_limit - tp_vars->last_sent;
 783
 784        return win_left >= payload_len;
 785}
 786
 787/**
 788 * batadv_tp_wait_available() - wait until congestion window becomes free or
 789 *  timeout is reached
 790 * @tp_vars: the private data of the current TP meter session
 791 * @plen: size of the payload of a single message
 792 *
 793 * Return: 0 if the condition evaluated to false after the timeout elapsed,
 794 *  1 if the condition evaluated to true after the timeout elapsed, the
 795 *  remaining jiffies (at least 1) if the condition evaluated to true before
 796 *  the timeout elapsed, or -ERESTARTSYS if it was interrupted by a signal.
 797 */
 798static int batadv_tp_wait_available(struct batadv_tp_vars *tp_vars, size_t plen)
 799{
 800        int ret;
 801
 802        ret = wait_event_interruptible_timeout(tp_vars->more_bytes,
 803                                               batadv_tp_avail(tp_vars, plen),
 804                                               HZ / 10);
 805
 806        return ret;
 807}
 808
 809/**
 810 * batadv_tp_send() - main sending thread of a tp meter session
 811 * @arg: address of the related tp_vars
 812 *
 813 * Return: nothing, this function never returns
 814 */
 815static int batadv_tp_send(void *arg)
 816{
 817        struct batadv_tp_vars *tp_vars = arg;
 818        struct batadv_priv *bat_priv = tp_vars->bat_priv;
 819        struct batadv_hard_iface *primary_if = NULL;
 820        struct batadv_orig_node *orig_node = NULL;
 821        size_t payload_len, packet_len;
 822        int err = 0;
 823
 824        if (unlikely(tp_vars->role != BATADV_TP_SENDER)) {
 825                err = BATADV_TP_REASON_DST_UNREACHABLE;
 826                tp_vars->reason = err;
 827                goto out;
 828        }
 829
 830        orig_node = batadv_orig_hash_find(bat_priv, tp_vars->other_end);
 831        if (unlikely(!orig_node)) {
 832                err = BATADV_TP_REASON_DST_UNREACHABLE;
 833                tp_vars->reason = err;
 834                goto out;
 835        }
 836
 837        primary_if = batadv_primary_if_get_selected(bat_priv);
 838        if (unlikely(!primary_if)) {
 839                err = BATADV_TP_REASON_DST_UNREACHABLE;
 840                tp_vars->reason = err;
 841                goto out;
 842        }
 843
 844        /* assume that all the hard_interfaces have a correctly
 845         * configured MTU, so use the soft_iface MTU as MSS.
 846         * This might not be true and in that case the fragmentation
 847         * should be used.
 848         * Now, try to send the packet as it is
 849         */
 850        payload_len = BATADV_TP_PLEN;
 851        BUILD_BUG_ON(sizeof(struct batadv_icmp_tp_packet) > BATADV_TP_PLEN);
 852
 853        batadv_tp_reset_sender_timer(tp_vars);
 854
 855        /* queue the worker in charge of terminating the test */
 856        queue_delayed_work(batadv_event_workqueue, &tp_vars->finish_work,
 857                           msecs_to_jiffies(tp_vars->test_length));
 858
 859        while (atomic_read(&tp_vars->sending) != 0) {
 860                if (unlikely(!batadv_tp_avail(tp_vars, payload_len))) {
 861                        batadv_tp_wait_available(tp_vars, payload_len);
 862                        continue;
 863                }
 864
 865                /* to emulate normal unicast traffic, add to the payload len
 866                 * the size of the unicast header
 867                 */
 868                packet_len = payload_len + sizeof(struct batadv_unicast_packet);
 869
 870                err = batadv_tp_send_msg(tp_vars, primary_if->net_dev->dev_addr,
 871                                         orig_node, tp_vars->last_sent,
 872                                         packet_len,
 873                                         tp_vars->session, tp_vars->icmp_uid,
 874                                         jiffies_to_msecs(jiffies));
 875
 876                /* something went wrong during the preparation/transmission */
 877                if (unlikely(err && err != BATADV_TP_REASON_CANT_SEND)) {
 878                        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 879                                   "Meter: %s() cannot send packets (%d)\n",
 880                                   __func__, err);
 881                        /* ensure nobody else tries to stop the thread now */
 882                        if (atomic_dec_and_test(&tp_vars->sending))
 883                                tp_vars->reason = err;
 884                        break;
 885                }
 886
 887                /* right-shift the TWND */
 888                if (!err)
 889                        tp_vars->last_sent += payload_len;
 890
 891                cond_resched();
 892        }
 893
 894out:
 895        if (likely(primary_if))
 896                batadv_hardif_put(primary_if);
 897        if (likely(orig_node))
 898                batadv_orig_node_put(orig_node);
 899
 900        batadv_tp_sender_end(bat_priv, tp_vars);
 901        batadv_tp_sender_cleanup(bat_priv, tp_vars);
 902
 903        batadv_tp_vars_put(tp_vars);
 904
 905        do_exit(0);
 906}
 907
 908/**
 909 * batadv_tp_start_kthread() - start new thread which manages the tp meter
 910 *  sender
 911 * @tp_vars: the private data of the current TP meter session
 912 */
 913static void batadv_tp_start_kthread(struct batadv_tp_vars *tp_vars)
 914{
 915        struct task_struct *kthread;
 916        struct batadv_priv *bat_priv = tp_vars->bat_priv;
 917        u32 session_cookie;
 918
 919        kref_get(&tp_vars->refcount);
 920        kthread = kthread_create(batadv_tp_send, tp_vars, "kbatadv_tp_meter");
 921        if (IS_ERR(kthread)) {
 922                session_cookie = batadv_tp_session_cookie(tp_vars->session,
 923                                                          tp_vars->icmp_uid);
 924                pr_err("batadv: cannot create tp meter kthread\n");
 925                batadv_tp_batctl_error_notify(BATADV_TP_REASON_MEMORY_ERROR,
 926                                              tp_vars->other_end,
 927                                              bat_priv, session_cookie);
 928
 929                /* drop reserved reference for kthread */
 930                batadv_tp_vars_put(tp_vars);
 931
 932                /* cleanup of failed tp meter variables */
 933                batadv_tp_sender_cleanup(bat_priv, tp_vars);
 934                return;
 935        }
 936
 937        wake_up_process(kthread);
 938}
 939
 940/**
 941 * batadv_tp_start() - start a new tp meter session
 942 * @bat_priv: the bat priv with all the soft interface information
 943 * @dst: the receiver MAC address
 944 * @test_length: test length in milliseconds
 945 * @cookie: session cookie
 946 */
 947void batadv_tp_start(struct batadv_priv *bat_priv, const u8 *dst,
 948                     u32 test_length, u32 *cookie)
 949{
 950        struct batadv_tp_vars *tp_vars;
 951        u8 session_id[2];
 952        u8 icmp_uid;
 953        u32 session_cookie;
 954
 955        get_random_bytes(session_id, sizeof(session_id));
 956        get_random_bytes(&icmp_uid, 1);
 957        session_cookie = batadv_tp_session_cookie(session_id, icmp_uid);
 958        *cookie = session_cookie;
 959
 960        /* look for an already existing test towards this node */
 961        spin_lock_bh(&bat_priv->tp_list_lock);
 962        tp_vars = batadv_tp_list_find(bat_priv, dst);
 963        if (tp_vars) {
 964                spin_unlock_bh(&bat_priv->tp_list_lock);
 965                batadv_tp_vars_put(tp_vars);
 966                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 967                           "Meter: test to or from the same node already ongoing, aborting\n");
 968                batadv_tp_batctl_error_notify(BATADV_TP_REASON_ALREADY_ONGOING,
 969                                              dst, bat_priv, session_cookie);
 970                return;
 971        }
 972
 973        if (!atomic_add_unless(&bat_priv->tp_num, 1, BATADV_TP_MAX_NUM)) {
 974                spin_unlock_bh(&bat_priv->tp_list_lock);
 975                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 976                           "Meter: too many ongoing sessions, aborting (SEND)\n");
 977                batadv_tp_batctl_error_notify(BATADV_TP_REASON_TOO_MANY, dst,
 978                                              bat_priv, session_cookie);
 979                return;
 980        }
 981
 982        tp_vars = kmalloc(sizeof(*tp_vars), GFP_ATOMIC);
 983        if (!tp_vars) {
 984                spin_unlock_bh(&bat_priv->tp_list_lock);
 985                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
 986                           "Meter: %s cannot allocate list elements\n",
 987                           __func__);
 988                batadv_tp_batctl_error_notify(BATADV_TP_REASON_MEMORY_ERROR,
 989                                              dst, bat_priv, session_cookie);
 990                return;
 991        }
 992
 993        /* initialize tp_vars */
 994        ether_addr_copy(tp_vars->other_end, dst);
 995        kref_init(&tp_vars->refcount);
 996        tp_vars->role = BATADV_TP_SENDER;
 997        atomic_set(&tp_vars->sending, 1);
 998        memcpy(tp_vars->session, session_id, sizeof(session_id));
 999        tp_vars->icmp_uid = icmp_uid;
1000
1001        tp_vars->last_sent = BATADV_TP_FIRST_SEQ;
1002        atomic_set(&tp_vars->last_acked, BATADV_TP_FIRST_SEQ);
1003        tp_vars->fast_recovery = false;
1004        tp_vars->recover = BATADV_TP_FIRST_SEQ;
1005
1006        /* initialise the CWND to 3*MSS (Section 3.1 in RFC5681).
1007         * For batman-adv the MSS is the size of the payload received by the
1008         * soft_interface, hence its MTU
1009         */
1010        tp_vars->cwnd = BATADV_TP_PLEN * 3;
1011        /* at the beginning initialise the SS threshold to the biggest possible
1012         * window size, hence the AWND size
1013         */
1014        tp_vars->ss_threshold = BATADV_TP_AWND;
1015
1016        /* RTO initial value is 3 seconds.
1017         * Details in Section 2.1 of RFC6298
1018         */
1019        tp_vars->rto = 1000;
1020        tp_vars->srtt = 0;
1021        tp_vars->rttvar = 0;
1022
1023        atomic64_set(&tp_vars->tot_sent, 0);
1024
1025        kref_get(&tp_vars->refcount);
1026        timer_setup(&tp_vars->timer, batadv_tp_sender_timeout, 0);
1027
1028        tp_vars->bat_priv = bat_priv;
1029        tp_vars->start_time = jiffies;
1030
1031        init_waitqueue_head(&tp_vars->more_bytes);
1032
1033        spin_lock_init(&tp_vars->unacked_lock);
1034        INIT_LIST_HEAD(&tp_vars->unacked_list);
1035
1036        spin_lock_init(&tp_vars->cwnd_lock);
1037
1038        tp_vars->prerandom_offset = 0;
1039        spin_lock_init(&tp_vars->prerandom_lock);
1040
1041        kref_get(&tp_vars->refcount);
1042        hlist_add_head_rcu(&tp_vars->list, &bat_priv->tp_list);
1043        spin_unlock_bh(&bat_priv->tp_list_lock);
1044
1045        tp_vars->test_length = test_length;
1046        if (!tp_vars->test_length)
1047                tp_vars->test_length = BATADV_TP_DEF_TEST_LENGTH;
1048
1049        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1050                   "Meter: starting throughput meter towards %pM (length=%ums)\n",
1051                   dst, test_length);
1052
1053        /* init work item for finished tp tests */
1054        INIT_DELAYED_WORK(&tp_vars->finish_work, batadv_tp_sender_finish);
1055
1056        /* start tp kthread. This way the write() call issued from userspace can
1057         * happily return and avoid to block
1058         */
1059        batadv_tp_start_kthread(tp_vars);
1060
1061        /* don't return reference to new tp_vars */
1062        batadv_tp_vars_put(tp_vars);
1063}
1064
1065/**
1066 * batadv_tp_stop() - stop currently running tp meter session
1067 * @bat_priv: the bat priv with all the soft interface information
1068 * @dst: the receiver MAC address
1069 * @return_value: reason for tp meter session stop
1070 */
1071void batadv_tp_stop(struct batadv_priv *bat_priv, const u8 *dst,
1072                    u8 return_value)
1073{
1074        struct batadv_orig_node *orig_node;
1075        struct batadv_tp_vars *tp_vars;
1076
1077        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1078                   "Meter: stopping test towards %pM\n", dst);
1079
1080        orig_node = batadv_orig_hash_find(bat_priv, dst);
1081        if (!orig_node)
1082                return;
1083
1084        tp_vars = batadv_tp_list_find(bat_priv, orig_node->orig);
1085        if (!tp_vars) {
1086                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1087                           "Meter: trying to interrupt an already over connection\n");
1088                goto out;
1089        }
1090
1091        batadv_tp_sender_shutdown(tp_vars, return_value);
1092        batadv_tp_vars_put(tp_vars);
1093out:
1094        batadv_orig_node_put(orig_node);
1095}
1096
1097/**
1098 * batadv_tp_reset_receiver_timer() - reset the receiver shutdown timer
1099 * @tp_vars: the private data of the current TP meter session
1100 *
1101 * start the receiver shutdown timer or reset it if already started
1102 */
1103static void batadv_tp_reset_receiver_timer(struct batadv_tp_vars *tp_vars)
1104{
1105        mod_timer(&tp_vars->timer,
1106                  jiffies + msecs_to_jiffies(BATADV_TP_RECV_TIMEOUT));
1107}
1108
1109/**
1110 * batadv_tp_receiver_shutdown() - stop a tp meter receiver when timeout is
1111 *  reached without received ack
1112 * @t: address to timer_list inside tp_vars
1113 */
1114static void batadv_tp_receiver_shutdown(struct timer_list *t)
1115{
1116        struct batadv_tp_vars *tp_vars = from_timer(tp_vars, t, timer);
1117        struct batadv_tp_unacked *un, *safe;
1118        struct batadv_priv *bat_priv;
1119
1120        bat_priv = tp_vars->bat_priv;
1121
1122        /* if there is recent activity rearm the timer */
1123        if (!batadv_has_timed_out(tp_vars->last_recv_time,
1124                                  BATADV_TP_RECV_TIMEOUT)) {
1125                /* reset the receiver shutdown timer */
1126                batadv_tp_reset_receiver_timer(tp_vars);
1127                return;
1128        }
1129
1130        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1131                   "Shutting down for inactivity (more than %dms) from %pM\n",
1132                   BATADV_TP_RECV_TIMEOUT, tp_vars->other_end);
1133
1134        spin_lock_bh(&tp_vars->bat_priv->tp_list_lock);
1135        hlist_del_rcu(&tp_vars->list);
1136        spin_unlock_bh(&tp_vars->bat_priv->tp_list_lock);
1137
1138        /* drop list reference */
1139        batadv_tp_vars_put(tp_vars);
1140
1141        atomic_dec(&bat_priv->tp_num);
1142
1143        spin_lock_bh(&tp_vars->unacked_lock);
1144        list_for_each_entry_safe(un, safe, &tp_vars->unacked_list, list) {
1145                list_del(&un->list);
1146                kfree(un);
1147        }
1148        spin_unlock_bh(&tp_vars->unacked_lock);
1149
1150        /* drop reference of timer */
1151        batadv_tp_vars_put(tp_vars);
1152}
1153
1154/**
1155 * batadv_tp_send_ack() - send an ACK packet
1156 * @bat_priv: the bat priv with all the soft interface information
1157 * @dst: the mac address of the destination originator
1158 * @seq: the sequence number to ACK
1159 * @timestamp: the timestamp to echo back in the ACK
1160 * @session: session identifier
1161 * @socket_index: local ICMP socket identifier
1162 *
1163 * Return: 0 on success, a positive integer representing the reason of the
1164 * failure otherwise
1165 */
1166static int batadv_tp_send_ack(struct batadv_priv *bat_priv, const u8 *dst,
1167                              u32 seq, __be32 timestamp, const u8 *session,
1168                              int socket_index)
1169{
1170        struct batadv_hard_iface *primary_if = NULL;
1171        struct batadv_orig_node *orig_node;
1172        struct batadv_icmp_tp_packet *icmp;
1173        struct sk_buff *skb;
1174        int r, ret;
1175
1176        orig_node = batadv_orig_hash_find(bat_priv, dst);
1177        if (unlikely(!orig_node)) {
1178                ret = BATADV_TP_REASON_DST_UNREACHABLE;
1179                goto out;
1180        }
1181
1182        primary_if = batadv_primary_if_get_selected(bat_priv);
1183        if (unlikely(!primary_if)) {
1184                ret = BATADV_TP_REASON_DST_UNREACHABLE;
1185                goto out;
1186        }
1187
1188        skb = netdev_alloc_skb_ip_align(NULL, sizeof(*icmp) + ETH_HLEN);
1189        if (unlikely(!skb)) {
1190                ret = BATADV_TP_REASON_MEMORY_ERROR;
1191                goto out;
1192        }
1193
1194        skb_reserve(skb, ETH_HLEN);
1195        icmp = skb_put(skb, sizeof(*icmp));
1196        icmp->packet_type = BATADV_ICMP;
1197        icmp->version = BATADV_COMPAT_VERSION;
1198        icmp->ttl = BATADV_TTL;
1199        icmp->msg_type = BATADV_TP;
1200        ether_addr_copy(icmp->dst, orig_node->orig);
1201        ether_addr_copy(icmp->orig, primary_if->net_dev->dev_addr);
1202        icmp->uid = socket_index;
1203
1204        icmp->subtype = BATADV_TP_ACK;
1205        memcpy(icmp->session, session, sizeof(icmp->session));
1206        icmp->seqno = htonl(seq);
1207        icmp->timestamp = timestamp;
1208
1209        /* send the ack */
1210        r = batadv_send_skb_to_orig(skb, orig_node, NULL);
1211        if (unlikely(r < 0) || r == NET_XMIT_DROP) {
1212                ret = BATADV_TP_REASON_DST_UNREACHABLE;
1213                goto out;
1214        }
1215        ret = 0;
1216
1217out:
1218        if (likely(orig_node))
1219                batadv_orig_node_put(orig_node);
1220        if (likely(primary_if))
1221                batadv_hardif_put(primary_if);
1222
1223        return ret;
1224}
1225
1226/**
1227 * batadv_tp_handle_out_of_order() - store an out of order packet
1228 * @tp_vars: the private data of the current TP meter session
1229 * @skb: the buffer containing the received packet
1230 *
1231 * Store the out of order packet in the unacked list for late processing. This
1232 * packets are kept in this list so that they can be ACKed at once as soon as
1233 * all the previous packets have been received
1234 *
1235 * Return: true if the packed has been successfully processed, false otherwise
1236 */
1237static bool batadv_tp_handle_out_of_order(struct batadv_tp_vars *tp_vars,
1238                                          const struct sk_buff *skb)
1239{
1240        const struct batadv_icmp_tp_packet *icmp;
1241        struct batadv_tp_unacked *un, *new;
1242        u32 payload_len;
1243        bool added = false;
1244
1245        new = kmalloc(sizeof(*new), GFP_ATOMIC);
1246        if (unlikely(!new))
1247                return false;
1248
1249        icmp = (struct batadv_icmp_tp_packet *)skb->data;
1250
1251        new->seqno = ntohl(icmp->seqno);
1252        payload_len = skb->len - sizeof(struct batadv_unicast_packet);
1253        new->len = payload_len;
1254
1255        spin_lock_bh(&tp_vars->unacked_lock);
1256        /* if the list is empty immediately attach this new object */
1257        if (list_empty(&tp_vars->unacked_list)) {
1258                list_add(&new->list, &tp_vars->unacked_list);
1259                goto out;
1260        }
1261
1262        /* otherwise loop over the list and either drop the packet because this
1263         * is a duplicate or store it at the right position.
1264         *
1265         * The iteration is done in the reverse way because it is likely that
1266         * the last received packet (the one being processed now) has a bigger
1267         * seqno than all the others already stored.
1268         */
1269        list_for_each_entry_reverse(un, &tp_vars->unacked_list, list) {
1270                /* check for duplicates */
1271                if (new->seqno == un->seqno) {
1272                        if (new->len > un->len)
1273                                un->len = new->len;
1274                        kfree(new);
1275                        added = true;
1276                        break;
1277                }
1278
1279                /* look for the right position */
1280                if (batadv_seq_before(new->seqno, un->seqno))
1281                        continue;
1282
1283                /* as soon as an entry having a bigger seqno is found, the new
1284                 * one is attached _after_ it. In this way the list is kept in
1285                 * ascending order
1286                 */
1287                list_add_tail(&new->list, &un->list);
1288                added = true;
1289                break;
1290        }
1291
1292        /* received packet with smallest seqno out of order; add it to front */
1293        if (!added)
1294                list_add(&new->list, &tp_vars->unacked_list);
1295
1296out:
1297        spin_unlock_bh(&tp_vars->unacked_lock);
1298
1299        return true;
1300}
1301
1302/**
1303 * batadv_tp_ack_unordered() - update number received bytes in current stream
1304 *  without gaps
1305 * @tp_vars: the private data of the current TP meter session
1306 */
1307static void batadv_tp_ack_unordered(struct batadv_tp_vars *tp_vars)
1308{
1309        struct batadv_tp_unacked *un, *safe;
1310        u32 to_ack;
1311
1312        /* go through the unacked packet list and possibly ACK them as
1313         * well
1314         */
1315        spin_lock_bh(&tp_vars->unacked_lock);
1316        list_for_each_entry_safe(un, safe, &tp_vars->unacked_list, list) {
1317                /* the list is ordered, therefore it is possible to stop as soon
1318                 * there is a gap between the last acked seqno and the seqno of
1319                 * the packet under inspection
1320                 */
1321                if (batadv_seq_before(tp_vars->last_recv, un->seqno))
1322                        break;
1323
1324                to_ack = un->seqno + un->len - tp_vars->last_recv;
1325
1326                if (batadv_seq_before(tp_vars->last_recv, un->seqno + un->len))
1327                        tp_vars->last_recv += to_ack;
1328
1329                list_del(&un->list);
1330                kfree(un);
1331        }
1332        spin_unlock_bh(&tp_vars->unacked_lock);
1333}
1334
1335/**
1336 * batadv_tp_init_recv() - return matching or create new receiver tp_vars
1337 * @bat_priv: the bat priv with all the soft interface information
1338 * @icmp: received icmp tp msg
1339 *
1340 * Return: corresponding tp_vars or NULL on errors
1341 */
1342static struct batadv_tp_vars *
1343batadv_tp_init_recv(struct batadv_priv *bat_priv,
1344                    const struct batadv_icmp_tp_packet *icmp)
1345{
1346        struct batadv_tp_vars *tp_vars;
1347
1348        spin_lock_bh(&bat_priv->tp_list_lock);
1349        tp_vars = batadv_tp_list_find_session(bat_priv, icmp->orig,
1350                                              icmp->session);
1351        if (tp_vars)
1352                goto out_unlock;
1353
1354        if (!atomic_add_unless(&bat_priv->tp_num, 1, BATADV_TP_MAX_NUM)) {
1355                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1356                           "Meter: too many ongoing sessions, aborting (RECV)\n");
1357                goto out_unlock;
1358        }
1359
1360        tp_vars = kmalloc(sizeof(*tp_vars), GFP_ATOMIC);
1361        if (!tp_vars)
1362                goto out_unlock;
1363
1364        ether_addr_copy(tp_vars->other_end, icmp->orig);
1365        tp_vars->role = BATADV_TP_RECEIVER;
1366        memcpy(tp_vars->session, icmp->session, sizeof(tp_vars->session));
1367        tp_vars->last_recv = BATADV_TP_FIRST_SEQ;
1368        tp_vars->bat_priv = bat_priv;
1369        kref_init(&tp_vars->refcount);
1370
1371        spin_lock_init(&tp_vars->unacked_lock);
1372        INIT_LIST_HEAD(&tp_vars->unacked_list);
1373
1374        kref_get(&tp_vars->refcount);
1375        hlist_add_head_rcu(&tp_vars->list, &bat_priv->tp_list);
1376
1377        kref_get(&tp_vars->refcount);
1378        timer_setup(&tp_vars->timer, batadv_tp_receiver_shutdown, 0);
1379
1380        batadv_tp_reset_receiver_timer(tp_vars);
1381
1382out_unlock:
1383        spin_unlock_bh(&bat_priv->tp_list_lock);
1384
1385        return tp_vars;
1386}
1387
1388/**
1389 * batadv_tp_recv_msg() - process a single data message
1390 * @bat_priv: the bat priv with all the soft interface information
1391 * @skb: the buffer containing the received packet
1392 *
1393 * Process a received TP MSG packet
1394 */
1395static void batadv_tp_recv_msg(struct batadv_priv *bat_priv,
1396                               const struct sk_buff *skb)
1397{
1398        const struct batadv_icmp_tp_packet *icmp;
1399        struct batadv_tp_vars *tp_vars;
1400        size_t packet_size;
1401        u32 seqno;
1402
1403        icmp = (struct batadv_icmp_tp_packet *)skb->data;
1404
1405        seqno = ntohl(icmp->seqno);
1406        /* check if this is the first seqno. This means that if the
1407         * first packet is lost, the tp meter does not work anymore!
1408         */
1409        if (seqno == BATADV_TP_FIRST_SEQ) {
1410                tp_vars = batadv_tp_init_recv(bat_priv, icmp);
1411                if (!tp_vars) {
1412                        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1413                                   "Meter: seqno != BATADV_TP_FIRST_SEQ cannot initiate connection\n");
1414                        goto out;
1415                }
1416        } else {
1417                tp_vars = batadv_tp_list_find_session(bat_priv, icmp->orig,
1418                                                      icmp->session);
1419                if (!tp_vars) {
1420                        batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1421                                   "Unexpected packet from %pM!\n",
1422                                   icmp->orig);
1423                        goto out;
1424                }
1425        }
1426
1427        if (unlikely(tp_vars->role != BATADV_TP_RECEIVER)) {
1428                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1429                           "Meter: dropping packet: not expected (role=%u)\n",
1430                           tp_vars->role);
1431                goto out;
1432        }
1433
1434        tp_vars->last_recv_time = jiffies;
1435
1436        /* if the packet is a duplicate, it may be the case that an ACK has been
1437         * lost. Resend the ACK
1438         */
1439        if (batadv_seq_before(seqno, tp_vars->last_recv))
1440                goto send_ack;
1441
1442        /* if the packet is out of order enqueue it */
1443        if (ntohl(icmp->seqno) != tp_vars->last_recv) {
1444                /* exit immediately (and do not send any ACK) if the packet has
1445                 * not been enqueued correctly
1446                 */
1447                if (!batadv_tp_handle_out_of_order(tp_vars, skb))
1448                        goto out;
1449
1450                /* send a duplicate ACK */
1451                goto send_ack;
1452        }
1453
1454        /* if everything was fine count the ACKed bytes */
1455        packet_size = skb->len - sizeof(struct batadv_unicast_packet);
1456        tp_vars->last_recv += packet_size;
1457
1458        /* check if this ordered message filled a gap.... */
1459        batadv_tp_ack_unordered(tp_vars);
1460
1461send_ack:
1462        /* send the ACK. If the received packet was out of order, the ACK that
1463         * is going to be sent is a duplicate (the sender will count them and
1464         * possibly enter Fast Retransmit as soon as it has reached 3)
1465         */
1466        batadv_tp_send_ack(bat_priv, icmp->orig, tp_vars->last_recv,
1467                           icmp->timestamp, icmp->session, icmp->uid);
1468out:
1469        if (likely(tp_vars))
1470                batadv_tp_vars_put(tp_vars);
1471}
1472
1473/**
1474 * batadv_tp_meter_recv() - main TP Meter receiving function
1475 * @bat_priv: the bat priv with all the soft interface information
1476 * @skb: the buffer containing the received packet
1477 */
1478void batadv_tp_meter_recv(struct batadv_priv *bat_priv, struct sk_buff *skb)
1479{
1480        struct batadv_icmp_tp_packet *icmp;
1481
1482        icmp = (struct batadv_icmp_tp_packet *)skb->data;
1483
1484        switch (icmp->subtype) {
1485        case BATADV_TP_MSG:
1486                batadv_tp_recv_msg(bat_priv, skb);
1487                break;
1488        case BATADV_TP_ACK:
1489                batadv_tp_recv_ack(bat_priv, skb);
1490                break;
1491        default:
1492                batadv_dbg(BATADV_DBG_TP_METER, bat_priv,
1493                           "Received unknown TP Metric packet type %u\n",
1494                           icmp->subtype);
1495        }
1496        consume_skb(skb);
1497}
1498
1499/**
1500 * batadv_tp_meter_init() - initialize global tp_meter structures
1501 */
1502void __init batadv_tp_meter_init(void)
1503{
1504        get_random_bytes(batadv_tp_prerandom, sizeof(batadv_tp_prerandom));
1505}
1506