// SPDX-License-Identifier: GPL-2.0
/* Multipath TCP token management
 * Copyright (c) 2017 - 2019, Intel Corporation.
 *
 * Note: This code is based on mptcp_ctrl.c from multipath-tcp.org,
 *       authored by:
 *
 *       Sébastien Barré <sebastien.barre@uclouvain.be>
 *       Christoph Paasch <christoph.paasch@uclouvain.be>
 *       Jaakko Korkeaniemi <jaakko.korkeaniemi@aalto.fi>
 *       Gregory Detal <gregory.detal@uclouvain.be>
 *       Fabien Duchêne <fabien.duchene@uclouvain.be>
 *       Andreas Seelinger <Andreas.Seelinger@rwth-aachen.de>
 *       Lavkesh Lahngir <lavkesh51@gmail.com>
 *       Andreas Ripke <ripke@neclab.eu>
 *       Vlad Dogaru <vlad.dogaru@intel.com>
 *       Octavian Purdila <octavian.purdila@intel.com>
 *       John Ronan <jronan@tssg.org>
 *       Catalin Nicutar <catalin.nicutar@gmail.com>
 *       Brandon Heller <brandonh@stanford.edu>
 */

#define pr_fmt(fmt) "MPTCP: " fmt

#include <linux/kernel.h>
#include <linux/module.h>
#include <linux/memblock.h>
#include <linux/ip.h>
#include <linux/tcp.h>
#include <net/sock.h>
#include <net/inet_common.h>
#include <net/protocol.h>
#include <net/mptcp.h>
#include "protocol.h"

#define TOKEN_MAX_CHAIN_LEN     4

struct token_bucket {
        spinlock_t              lock;
        int                     chain_len;
        struct hlist_nulls_head req_chain;
        struct hlist_nulls_head msk_chain;
};

static struct token_bucket *token_hash __read_mostly;
static unsigned int token_mask __read_mostly;

static struct token_bucket *token_bucket(u32 token)
{
        return &token_hash[token & token_mask];
}

/* called with bucket lock held */
static struct mptcp_subflow_request_sock *
__token_lookup_req(struct token_bucket *t, u32 token)
{
        struct mptcp_subflow_request_sock *req;
        struct hlist_nulls_node *pos;

        hlist_nulls_for_each_entry_rcu(req, pos, &t->req_chain, token_node)
                if (req->token == token)
                        return req;
        return NULL;
}

/* called with bucket lock held */
static struct mptcp_sock *
__token_lookup_msk(struct token_bucket *t, u32 token)
{
        struct hlist_nulls_node *pos;
        struct sock *sk;

        sk_nulls_for_each_rcu(sk, pos, &t->msk_chain)
                if (mptcp_sk(sk)->token == token)
                        return mptcp_sk(sk);
        return NULL;
}

static bool __token_bucket_busy(struct token_bucket *t, u32 token)
{
        return !token || t->chain_len >= TOKEN_MAX_CHAIN_LEN ||
               __token_lookup_req(t, token) || __token_lookup_msk(t, token);
}

static void mptcp_crypto_key_gen_sha(u64 *key, u32 *token, u64 *idsn)
{
        /* we might consider a faster version that computes the key as a
         * hash of some information available in the MPTCP socket. Use
         * random data at the moment, as it's probably the safest option
         * in case multiple sockets are opened in different namespaces at
         * the same time.
         */
        get_random_bytes(key, sizeof(u64));
        mptcp_crypto_key_sha(*key, token, idsn);
}

/**
 * mptcp_token_new_request - create new key/idsn/token for subflow_request
 * @req: the request socket
 *
 * This function is called when a new mptcp connection is coming in.
 *
 * It creates a unique token to identify the new mptcp connection,
 * a secret local key and the initial data sequence number (idsn).
 *
 * Returns 0 on success.
 */
int mptcp_token_new_request(struct request_sock *req)
{
        struct mptcp_subflow_request_sock *subflow_req = mptcp_subflow_rsk(req);
        struct token_bucket *bucket;
        u32 token;

        mptcp_crypto_key_sha(subflow_req->local_key,
                             &subflow_req->token,
                             &subflow_req->idsn);
        pr_debug("req=%p local_key=%llu, token=%u, idsn=%llu\n",
                 req, subflow_req->local_key, subflow_req->token,
                 subflow_req->idsn);

        token = subflow_req->token;
        bucket = token_bucket(token);
        spin_lock_bh(&bucket->lock);
        if (__token_bucket_busy(bucket, token)) {
                spin_unlock_bh(&bucket->lock);
                return -EBUSY;
        }

        hlist_nulls_add_head_rcu(&subflow_req->token_node, &bucket->req_chain);
        bucket->chain_len++;
        spin_unlock_bh(&bucket->lock);
        return 0;
}

/**
 * mptcp_token_new_connect - create new key/idsn/token for subflow
 * @sk: the socket that will initiate a connection
 *
 * This function is called when a new outgoing mptcp connection is
 * initiated.
 *
 * It creates a unique token to identify the new mptcp connection,
 * a secret local key and the initial data sequence number (idsn).
 *
 * On success, the mptcp connection can be found again using
 * the computed token at a later time, this is needed to process
 * join requests.
 *
 * returns 0 on success.
 */
int mptcp_token_new_connect(struct sock *sk)
{
        struct mptcp_subflow_context *subflow = mptcp_subflow_ctx(sk);
        struct mptcp_sock *msk = mptcp_sk(subflow->conn);
        int retries = MPTCP_TOKEN_MAX_RETRIES;
        struct token_bucket *bucket;

again:
        mptcp_crypto_key_gen_sha(&subflow->local_key, &subflow->token,
                                 &subflow->idsn);

        bucket = token_bucket(subflow->token);
        spin_lock_bh(&bucket->lock);
        if (__token_bucket_busy(bucket, subflow->token)) {
                spin_unlock_bh(&bucket->lock);
                if (!--retries)
                        return -EBUSY;
                goto again;
        }

        pr_debug("ssk=%p, local_key=%llu, token=%u, idsn=%llu\n",
                 sk, subflow->local_key, subflow->token, subflow->idsn);

        WRITE_ONCE(msk->token, subflow->token);
        __sk_nulls_add_node_rcu((struct sock *)msk, &bucket->msk_chain);
        bucket->chain_len++;
        spin_unlock_bh(&bucket->lock);
        return 0;
}

/**
 * mptcp_token_accept - replace a req sk with full sock in token hash
 * @req: the request socket to be removed
 * @msk: the just cloned socket linked to the new connection
 *
 * Called when a SYN packet creates a new logical connection, i.e.
 * is not a join request.
 */
void mptcp_token_accept(struct mptcp_subflow_request_sock *req,
                        struct mptcp_sock *msk)
{
        struct mptcp_subflow_request_sock *pos;
        struct token_bucket *bucket;

        bucket = token_bucket(req->token);
        spin_lock_bh(&bucket->lock);

        /* pedantic lookup check for the moved token */
        pos = __token_lookup_req(bucket, req->token);
        if (!WARN_ON_ONCE(pos != req))
                hlist_nulls_del_init_rcu(&req->token_node);
        __sk_nulls_add_node_rcu((struct sock *)msk, &bucket->msk_chain);
        spin_unlock_bh(&bucket->lock);
}

bool mptcp_token_exists(u32 token)
{
        struct hlist_nulls_node *pos;
        struct token_bucket *bucket;
        struct mptcp_sock *msk;
        struct sock *sk;

        rcu_read_lock();
        bucket = token_bucket(token);

again:
        sk_nulls_for_each_rcu(sk, pos, &bucket->msk_chain) {
                msk = mptcp_sk(sk);
                if (READ_ONCE(msk->token) == token)
                        goto found;
        }
        if (get_nulls_value(pos) != (token & token_mask))
                goto again;

        rcu_read_unlock();
        return false;
found:
        rcu_read_unlock();
        return true;
}

/**
 * mptcp_token_get_sock - retrieve mptcp connection sock using its token
 * @token: token of the mptcp connection to retrieve
 *
 * This function returns the mptcp connection structure with the given token.
 * A reference count on the mptcp socket returned is taken.
 *
 * returns NULL if no connection with the given token value exists.
 */
struct mptcp_sock *mptcp_token_get_sock(u32 token)
{
        struct hlist_nulls_node *pos;
        struct token_bucket *bucket;
        struct mptcp_sock *msk;
        struct sock *sk;

        rcu_read_lock();
        bucket = token_bucket(token);

again:
        sk_nulls_for_each_rcu(sk, pos, &bucket->msk_chain) {
                msk = mptcp_sk(sk);
                if (READ_ONCE(msk->token) != token)
                        continue;
                if (!refcount_inc_not_zero(&sk->sk_refcnt))
                        goto not_found;
                if (READ_ONCE(msk->token) != token) {
                        sock_put(sk);
                        goto again;
                }
                goto found;
        }
        if (get_nulls_value(pos) != (token & token_mask))
                goto again;

not_found:
        msk = NULL;

found:
        rcu_read_unlock();
        return msk;
}
EXPORT_SYMBOL_GPL(mptcp_token_get_sock);

/**
 * mptcp_token_iter_next - iterate over the token container from given pos
 * @net: namespace to be iterated
 * @s_slot: start slot number
 * @s_num: start number inside the given lock
 *
 * This function returns the first mptcp connection structure found inside the
 * token container starting from the specified position, or NULL.
 *
 * On successful iteration, the iterator is move to the next position and the
 * the acquires a reference to the returned socket.
 */
struct mptcp_sock *mptcp_token_iter_next(const struct net *net, long *s_slot,
                                         long *s_num)
{
        struct mptcp_sock *ret = NULL;
        struct hlist_nulls_node *pos;
        int slot, num = 0;

        for (slot = *s_slot; slot <= token_mask; *s_num = 0, slot++) {
                struct token_bucket *bucket = &token_hash[slot];
                struct sock *sk;

                num = 0;

                if (hlist_nulls_empty(&bucket->msk_chain))
                        continue;

                rcu_read_lock();
                sk_nulls_for_each_rcu(sk, pos, &bucket->msk_chain) {
                        ++num;
                        if (!net_eq(sock_net(sk), net))
                                continue;

                        if (num <= *s_num)
                                continue;

                        if (!refcount_inc_not_zero(&sk->sk_refcnt))
                                continue;

                        if (!net_eq(sock_net(sk), net)) {
                                sock_put(sk);
                                continue;
                        }

                        ret = mptcp_sk(sk);
                        rcu_read_unlock();
                        goto out;
                }
                rcu_read_unlock();
        }

out:
        *s_slot = slot;
        *s_num = num;
        return ret;
}
EXPORT_SYMBOL_GPL(mptcp_token_iter_next);

/**
 * mptcp_token_destroy_request - remove mptcp connection/token
 * @req: mptcp request socket dropping the token
 *
 * Remove the token associated to @req.
 */
void mptcp_token_destroy_request(struct request_sock *req)
{
        struct mptcp_subflow_request_sock *subflow_req = mptcp_subflow_rsk(req);
        struct mptcp_subflow_request_sock *pos;
        struct token_bucket *bucket;

        if (hlist_nulls_unhashed(&subflow_req->token_node))
                return;

        bucket = token_bucket(subflow_req->token);
        spin_lock_bh(&bucket->lock);
        pos = __token_lookup_req(bucket, subflow_req->token);
        if (!WARN_ON_ONCE(pos != subflow_req)) {
                hlist_nulls_del_init_rcu(&pos->token_node);
                bucket->chain_len--;
        }
        spin_unlock_bh(&bucket->lock);
}

/**
 * mptcp_token_destroy - remove mptcp connection/token
 * @msk: mptcp connection dropping the token
 *
 * Remove the token associated to @msk
 */
void mptcp_token_destroy(struct mptcp_sock *msk)
{
        struct token_bucket *bucket;
        struct mptcp_sock *pos;

        if (sk_unhashed((struct sock *)msk))
                return;

        bucket = token_bucket(msk->token);
        spin_lock_bh(&bucket->lock);
        pos = __token_lookup_msk(bucket, msk->token);
        if (!WARN_ON_ONCE(pos != msk)) {
                __sk_nulls_del_node_init_rcu((struct sock *)pos);
                bucket->chain_len--;
        }
        spin_unlock_bh(&bucket->lock);
}

void __init mptcp_token_init(void)
{
        int i;

        token_hash = alloc_large_system_hash("MPTCP token",
                                             sizeof(struct token_bucket),
                                             0,
                                             20,/* one slot per 1MB of memory */
                                             HASH_ZERO,
                                             NULL,
                                             &token_mask,
                                             0,
                                             64 * 1024);
        for (i = 0; i < token_mask + 1; ++i) {
                INIT_HLIST_NULLS_HEAD(&token_hash[i].req_chain, i);
                INIT_HLIST_NULLS_HEAD(&token_hash[i].msk_chain, i);
                spin_lock_init(&token_hash[i].lock);
        }
}

#if IS_MODULE(CONFIG_MPTCP_KUNIT_TEST)
EXPORT_SYMBOL_GPL(mptcp_token_new_request);
EXPORT_SYMBOL_GPL(mptcp_token_new_connect);
EXPORT_SYMBOL_GPL(mptcp_token_accept);
EXPORT_SYMBOL_GPL(mptcp_token_destroy_request);
EXPORT_SYMBOL_GPL(mptcp_token_destroy);
#endif