// SPDX-License-Identifier: GPL-2.0-only
/*
 * Common NFS I/O  operations for the pnfs file based
 * layout drivers.
 *
 * Copyright (c) 2014, Primary Data, Inc. All rights reserved.
 *
 * Tom Haynes <loghyr@primarydata.com>
 */

#include <linux/nfs_fs.h>
#include <linux/nfs_page.h>
#include <linux/sunrpc/addr.h>
#include <linux/module.h>

#include "nfs4session.h"
#include "internal.h"
#include "pnfs.h"
#include "netns.h"
#include "nfs4trace.h"

#define NFSDBG_FACILITY         NFSDBG_PNFS

void pnfs_generic_rw_release(void *data)
{
        struct nfs_pgio_header *hdr = data;

        nfs_put_client(hdr->ds_clp);
        hdr->mds_ops->rpc_release(data);
}
EXPORT_SYMBOL_GPL(pnfs_generic_rw_release);

/* Fake up some data that will cause nfs_commit_release to retry the writes. */
void pnfs_generic_prepare_to_resend_writes(struct nfs_commit_data *data)
{
        struct nfs_writeverf *verf = data->res.verf;

        data->task.tk_status = 0;
        memset(&verf->verifier, 0, sizeof(verf->verifier));
        verf->committed = NFS_UNSTABLE;
}
EXPORT_SYMBOL_GPL(pnfs_generic_prepare_to_resend_writes);

void pnfs_generic_write_commit_done(struct rpc_task *task, void *data)
{
        struct nfs_commit_data *wdata = data;

        /* Note this may cause RPC to be resent */
        wdata->mds_ops->rpc_call_done(task, data);
}
EXPORT_SYMBOL_GPL(pnfs_generic_write_commit_done);

void pnfs_generic_commit_release(void *calldata)
{
        struct nfs_commit_data *data = calldata;

        data->completion_ops->completion(data);
        pnfs_put_lseg(data->lseg);
        nfs_put_client(data->ds_clp);
        nfs_commitdata_release(data);
}
EXPORT_SYMBOL_GPL(pnfs_generic_commit_release);

static struct pnfs_layout_segment *
pnfs_free_bucket_lseg(struct pnfs_commit_bucket *bucket)
{
        if (list_empty(&bucket->committing) && list_empty(&bucket->written)) {
                struct pnfs_layout_segment *freeme = bucket->lseg;
                bucket->lseg = NULL;
                return freeme;
        }
        return NULL;
}

/* The generic layer is about to remove the req from the commit list.
 * If this will make the bucket empty, it will need to put the lseg reference.
 * Note this must be called holding nfsi->commit_mutex
 */
void
pnfs_generic_clear_request_commit(struct nfs_page *req,
                                  struct nfs_commit_info *cinfo)
{
        struct pnfs_commit_bucket *bucket = NULL;

        if (!test_and_clear_bit(PG_COMMIT_TO_DS, &req->wb_flags))
                goto out;
        cinfo->ds->nwritten--;
        if (list_is_singular(&req->wb_list))
                bucket = list_first_entry(&req->wb_list,
                                          struct pnfs_commit_bucket, written);
out:
        nfs_request_remove_commit_list(req, cinfo);
        if (bucket)
                pnfs_put_lseg(pnfs_free_bucket_lseg(bucket));
}
EXPORT_SYMBOL_GPL(pnfs_generic_clear_request_commit);

struct pnfs_commit_array *
pnfs_alloc_commit_array(size_t n, gfp_t gfp_flags)
{
        struct pnfs_commit_array *p;
        struct pnfs_commit_bucket *b;

        p = kmalloc_flex(*p, buckets, n, gfp_flags);
        if (!p)
                return NULL;
        p->nbuckets = n;
        INIT_LIST_HEAD(&p->cinfo_list);
        INIT_LIST_HEAD(&p->lseg_list);
        p->lseg = NULL;
        for (b = &p->buckets[0]; n != 0; b++, n--) {
                INIT_LIST_HEAD(&b->written);
                INIT_LIST_HEAD(&b->committing);
                b->lseg = NULL;
                b->direct_verf.committed = NFS_INVALID_STABLE_HOW;
        }
        return p;
}
EXPORT_SYMBOL_GPL(pnfs_alloc_commit_array);

void
pnfs_free_commit_array(struct pnfs_commit_array *p)
{
        kfree_rcu(p, rcu);
}
EXPORT_SYMBOL_GPL(pnfs_free_commit_array);

static struct pnfs_commit_array *
pnfs_find_commit_array_by_lseg(struct pnfs_ds_commit_info *fl_cinfo,
                struct pnfs_layout_segment *lseg)
{
        struct pnfs_commit_array *array;

        list_for_each_entry_rcu(array, &fl_cinfo->commits, cinfo_list) {
                if (array->lseg == lseg)
                        return array;
        }
        return NULL;
}

struct pnfs_commit_array *
pnfs_add_commit_array(struct pnfs_ds_commit_info *fl_cinfo,
                struct pnfs_commit_array *new,
                struct pnfs_layout_segment *lseg)
{
        struct pnfs_commit_array *array;

        array = pnfs_find_commit_array_by_lseg(fl_cinfo, lseg);
        if (array)
                return array;
        new->lseg = lseg;
        refcount_set(&new->refcount, 1);
        list_add_rcu(&new->cinfo_list, &fl_cinfo->commits);
        list_add(&new->lseg_list, &lseg->pls_commits);
        return new;
}
EXPORT_SYMBOL_GPL(pnfs_add_commit_array);

static struct pnfs_commit_array *
pnfs_lookup_commit_array(struct pnfs_ds_commit_info *fl_cinfo,
                struct pnfs_layout_segment *lseg)
{
        struct pnfs_commit_array *array;

        rcu_read_lock();
        array = pnfs_find_commit_array_by_lseg(fl_cinfo, lseg);
        if (!array) {
                rcu_read_unlock();
                fl_cinfo->ops->setup_ds_info(fl_cinfo, lseg);
                rcu_read_lock();
                array = pnfs_find_commit_array_by_lseg(fl_cinfo, lseg);
        }
        rcu_read_unlock();
        return array;
}

static void
pnfs_release_commit_array_locked(struct pnfs_commit_array *array)
{
        list_del_rcu(&array->cinfo_list);
        list_del(&array->lseg_list);
        pnfs_free_commit_array(array);
}

static void
pnfs_put_commit_array_locked(struct pnfs_commit_array *array)
{
        if (refcount_dec_and_test(&array->refcount))
                pnfs_release_commit_array_locked(array);
}

static void
pnfs_put_commit_array(struct pnfs_commit_array *array, struct inode *inode)
{
        if (refcount_dec_and_lock(&array->refcount, &inode->i_lock)) {
                pnfs_release_commit_array_locked(array);
                spin_unlock(&inode->i_lock);
        }
}

static struct pnfs_commit_array *
pnfs_get_commit_array(struct pnfs_commit_array *array)
{
        if (refcount_inc_not_zero(&array->refcount))
                return array;
        return NULL;
}

static void
pnfs_remove_and_free_commit_array(struct pnfs_commit_array *array)
{
        array->lseg = NULL;
        list_del_init(&array->lseg_list);
        pnfs_put_commit_array_locked(array);
}

void
pnfs_generic_ds_cinfo_release_lseg(struct pnfs_ds_commit_info *fl_cinfo,
                struct pnfs_layout_segment *lseg)
{
        struct pnfs_commit_array *array, *tmp;

        list_for_each_entry_safe(array, tmp, &lseg->pls_commits, lseg_list)
                pnfs_remove_and_free_commit_array(array);
}
EXPORT_SYMBOL_GPL(pnfs_generic_ds_cinfo_release_lseg);

void
pnfs_generic_ds_cinfo_destroy(struct pnfs_ds_commit_info *fl_cinfo)
{
        struct pnfs_commit_array *array, *tmp;

        list_for_each_entry_safe(array, tmp, &fl_cinfo->commits, cinfo_list)
                pnfs_remove_and_free_commit_array(array);
}
EXPORT_SYMBOL_GPL(pnfs_generic_ds_cinfo_destroy);

/*
 * Locks the nfs_page requests for commit and moves them to
 * @bucket->committing.
 */
static int
pnfs_bucket_scan_ds_commit_list(struct pnfs_commit_bucket *bucket,
                                struct nfs_commit_info *cinfo,
                                int max)
{
        struct list_head *src = &bucket->written;
        struct list_head *dst = &bucket->committing;
        int ret;

        lockdep_assert_held(&NFS_I(cinfo->inode)->commit_mutex);
        ret = nfs_scan_commit_list(src, dst, cinfo, max);
        if (ret) {
                cinfo->ds->nwritten -= ret;
                cinfo->ds->ncommitting += ret;
        }
        return ret;
}

static int pnfs_bucket_scan_array(struct nfs_commit_info *cinfo,
                                  struct pnfs_commit_bucket *buckets,
                                  unsigned int nbuckets,
                                  int max)
{
        unsigned int i;
        int rv = 0, cnt;

        for (i = 0; i < nbuckets && max != 0; i++) {
                cnt = pnfs_bucket_scan_ds_commit_list(&buckets[i], cinfo, max);
                rv += cnt;
                max -= cnt;
        }
        return rv;
}

/* Move reqs from written to committing lists, returning count
 * of number moved.
 */
int pnfs_generic_scan_commit_lists(struct nfs_commit_info *cinfo, int max)
{
        struct pnfs_ds_commit_info *fl_cinfo = cinfo->ds;
        struct pnfs_commit_array *array;
        int rv = 0, cnt;

        rcu_read_lock();
        list_for_each_entry_rcu(array, &fl_cinfo->commits, cinfo_list) {
                if (!array->lseg || !pnfs_get_commit_array(array))
                        continue;
                rcu_read_unlock();
                cnt = pnfs_bucket_scan_array(cinfo, array->buckets,
                                array->nbuckets, max);
                rcu_read_lock();
                pnfs_put_commit_array(array, cinfo->inode);
                rv += cnt;
                max -= cnt;
                if (!max)
                        break;
        }
        rcu_read_unlock();
        return rv;
}
EXPORT_SYMBOL_GPL(pnfs_generic_scan_commit_lists);

static unsigned int
pnfs_bucket_recover_commit_reqs(struct list_head *dst,
                                struct pnfs_commit_bucket *buckets,
                                unsigned int nbuckets,
                                struct nfs_commit_info *cinfo)
{
        struct pnfs_commit_bucket *b;
        struct pnfs_layout_segment *freeme;
        unsigned int nwritten, ret = 0;
        unsigned int i;

restart:
        for (i = 0, b = buckets; i < nbuckets; i++, b++) {
                nwritten = nfs_scan_commit_list(&b->written, dst, cinfo, 0);
                if (!nwritten)
                        continue;
                ret += nwritten;
                freeme = pnfs_free_bucket_lseg(b);
                if (freeme) {
                        pnfs_put_lseg(freeme);
                        goto restart;
                }
        }
        return ret;
}

/* Pull everything off the committing lists and dump into @dst.  */
void pnfs_generic_recover_commit_reqs(struct list_head *dst,
                                      struct nfs_commit_info *cinfo)
{
        struct pnfs_ds_commit_info *fl_cinfo = cinfo->ds;
        struct pnfs_commit_array *array;
        unsigned int nwritten;

        lockdep_assert_held(&NFS_I(cinfo->inode)->commit_mutex);
        rcu_read_lock();
        list_for_each_entry_rcu(array, &fl_cinfo->commits, cinfo_list) {
                if (!array->lseg || !pnfs_get_commit_array(array))
                        continue;
                rcu_read_unlock();
                nwritten = pnfs_bucket_recover_commit_reqs(dst,
                                                           array->buckets,
                                                           array->nbuckets,
                                                           cinfo);
                rcu_read_lock();
                pnfs_put_commit_array(array, cinfo->inode);
                fl_cinfo->nwritten -= nwritten;
        }
        rcu_read_unlock();
}
EXPORT_SYMBOL_GPL(pnfs_generic_recover_commit_reqs);

static struct pnfs_layout_segment *
pnfs_bucket_get_committing(struct list_head *head,
                           struct pnfs_commit_bucket *bucket,
                           struct nfs_commit_info *cinfo)
{
        struct pnfs_layout_segment *lseg;
        struct list_head *pos;

        list_for_each(pos, &bucket->committing)
                cinfo->ds->ncommitting--;
        list_splice_init(&bucket->committing, head);
        lseg = pnfs_free_bucket_lseg(bucket);
        if (!lseg)
                lseg = pnfs_get_lseg(bucket->lseg);
        return lseg;
}

static struct nfs_commit_data *
pnfs_bucket_fetch_commitdata(struct pnfs_commit_bucket *bucket,
                             struct nfs_commit_info *cinfo)
{
        struct nfs_commit_data *data = nfs_commitdata_alloc();

        if (!data)
                return NULL;
        data->lseg = pnfs_bucket_get_committing(&data->pages, bucket, cinfo);
        return data;
}

static void pnfs_generic_retry_commit(struct pnfs_commit_bucket *buckets,
                                      unsigned int nbuckets,
                                      struct nfs_commit_info *cinfo,
                                      unsigned int idx)
{
        struct pnfs_commit_bucket *bucket;
        struct pnfs_layout_segment *freeme;
        LIST_HEAD(pages);

        for (bucket = buckets; idx < nbuckets; bucket++, idx++) {
                if (list_empty(&bucket->committing))
                        continue;
                mutex_lock(&NFS_I(cinfo->inode)->commit_mutex);
                freeme = pnfs_bucket_get_committing(&pages, bucket, cinfo);
                mutex_unlock(&NFS_I(cinfo->inode)->commit_mutex);
                nfs_retry_commit(&pages, freeme, cinfo, idx);
                pnfs_put_lseg(freeme);
        }
}

static unsigned int
pnfs_bucket_alloc_ds_commits(struct list_head *list,
                             struct pnfs_commit_bucket *buckets,
                             unsigned int nbuckets,
                             struct nfs_commit_info *cinfo)
{
        struct pnfs_commit_bucket *bucket;
        struct nfs_commit_data *data;
        unsigned int i;
        unsigned int nreq = 0;

        for (i = 0, bucket = buckets; i < nbuckets; i++, bucket++) {
                if (list_empty(&bucket->committing))
                        continue;
                mutex_lock(&NFS_I(cinfo->inode)->commit_mutex);
                if (!list_empty(&bucket->committing)) {
                        data = pnfs_bucket_fetch_commitdata(bucket, cinfo);
                        if (!data)
                                goto out_error;
                        data->ds_commit_index = i;
                        list_add_tail(&data->list, list);
                        nreq++;
                }
                mutex_unlock(&NFS_I(cinfo->inode)->commit_mutex);
        }
        return nreq;
out_error:
        mutex_unlock(&NFS_I(cinfo->inode)->commit_mutex);
        /* Clean up on error */
        pnfs_generic_retry_commit(buckets, nbuckets, cinfo, i);
        return nreq;
}

static unsigned int
pnfs_alloc_ds_commits_list(struct list_head *list,
                           struct pnfs_ds_commit_info *fl_cinfo,
                           struct nfs_commit_info *cinfo)
{
        struct pnfs_commit_array *array;
        unsigned int ret = 0;

        rcu_read_lock();
        list_for_each_entry_rcu(array, &fl_cinfo->commits, cinfo_list) {
                if (!array->lseg || !pnfs_get_commit_array(array))
                        continue;
                rcu_read_unlock();
                ret += pnfs_bucket_alloc_ds_commits(list, array->buckets,
                                array->nbuckets, cinfo);
                rcu_read_lock();
                pnfs_put_commit_array(array, cinfo->inode);
        }
        rcu_read_unlock();
        return ret;
}

/* This follows nfs_commit_list pretty closely */
int
pnfs_generic_commit_pagelist(struct inode *inode, struct list_head *mds_pages,
                             int how, struct nfs_commit_info *cinfo,
                             int (*initiate_commit)(struct nfs_commit_data *data,
                                                    int how))
{
        struct pnfs_ds_commit_info *fl_cinfo = cinfo->ds;
        struct nfs_commit_data *data, *tmp;
        LIST_HEAD(list);
        unsigned int nreq = 0;

        if (!list_empty(mds_pages)) {
                data = nfs_commitdata_alloc();
                if (!data) {
                        nfs_retry_commit(mds_pages, NULL, cinfo, -1);
                        return -ENOMEM;
                }
                data->ds_commit_index = -1;
                list_splice_init(mds_pages, &data->pages);
                list_add_tail(&data->list, &list);
                nreq++;
        }

        nreq += pnfs_alloc_ds_commits_list(&list, fl_cinfo, cinfo);
        if (nreq == 0)
                goto out;

        list_for_each_entry_safe(data, tmp, &list, list) {
                list_del(&data->list);
                if (data->ds_commit_index < 0) {
                        nfs_init_commit(data, NULL, NULL, cinfo);
                        nfs_initiate_commit(NFS_CLIENT(inode), data,
                                            NFS_PROTO(data->inode),
                                            data->mds_ops, how,
                                            RPC_TASK_CRED_NOREF, NULL);
                } else {
                        nfs_init_commit(data, NULL, data->lseg, cinfo);
                        initiate_commit(data, how);
                }
        }
out:
        return PNFS_ATTEMPTED;
}
EXPORT_SYMBOL_GPL(pnfs_generic_commit_pagelist);

/*
 * Data server cache
 *
 * Data servers can be mapped to different device ids, but should
 * never be shared between net namespaces.
 *
 * nfs4_pnfs_ds reference counting:
 *   - set to 1 on allocation
 *   - incremented when a device id maps a data server already in the cache.
 *   - decremented when deviceid is removed from the cache.
 */

/* Debug routines */
static void
print_ds(struct nfs4_pnfs_ds *ds)
{
        if (ds == NULL) {
                printk(KERN_WARNING "%s NULL device\n", __func__);
                return;
        }
        printk(KERN_WARNING "        ds %s\n"
                "        ref count %d\n"
                "        client %p\n"
                "        cl_exchange_flags %x\n",
                ds->ds_remotestr,
                refcount_read(&ds->ds_count), ds->ds_clp,
                ds->ds_clp ? ds->ds_clp->cl_exchange_flags : 0);
}

static bool
same_sockaddr(struct sockaddr *addr1, struct sockaddr *addr2)
{
        struct sockaddr_in *a, *b;
        struct sockaddr_in6 *a6, *b6;

        if (addr1->sa_family != addr2->sa_family)
                return false;

        switch (addr1->sa_family) {
        case AF_INET:
                a = (struct sockaddr_in *)addr1;
                b = (struct sockaddr_in *)addr2;

                if (a->sin_addr.s_addr == b->sin_addr.s_addr &&
                    a->sin_port == b->sin_port)
                        return true;
                break;

        case AF_INET6:
                a6 = (struct sockaddr_in6 *)addr1;
                b6 = (struct sockaddr_in6 *)addr2;

                /* LINKLOCAL addresses must have matching scope_id */
                if (ipv6_addr_src_scope(&a6->sin6_addr) ==
                    IPV6_ADDR_SCOPE_LINKLOCAL &&
                    a6->sin6_scope_id != b6->sin6_scope_id)
                        return false;

                if (ipv6_addr_equal(&a6->sin6_addr, &b6->sin6_addr) &&
                    a6->sin6_port == b6->sin6_port)
                        return true;
                break;

        default:
                dprintk("%s: unhandled address family: %u\n",
                        __func__, addr1->sa_family);
                return false;
        }

        return false;
}

/*
 * Checks if 'dsaddrs1' contains a subset of 'dsaddrs2'. If it does,
 * declare a match.
 */
static bool
_same_data_server_addrs_locked(const struct list_head *dsaddrs1,
                               const struct list_head *dsaddrs2)
{
        struct nfs4_pnfs_ds_addr *da1, *da2;
        struct sockaddr *sa1, *sa2;
        bool match = false;

        list_for_each_entry(da1, dsaddrs1, da_node) {
                sa1 = (struct sockaddr *)&da1->da_addr;
                match = false;
                list_for_each_entry(da2, dsaddrs2, da_node) {
                        sa2 = (struct sockaddr *)&da2->da_addr;
                        match = same_sockaddr(sa1, sa2);
                        if (match)
                                break;
                }
                if (!match)
                        break;
        }
        return match;
}

/*
 * Lookup DS by addresses.  nfs4_ds_cache_lock is held
 */
static struct nfs4_pnfs_ds *
_data_server_lookup_locked(const struct nfs_net *nn, const struct list_head *dsaddrs)
{
        struct nfs4_pnfs_ds *ds;

        list_for_each_entry(ds, &nn->nfs4_data_server_cache, ds_node)
                if (_same_data_server_addrs_locked(&ds->ds_addrs, dsaddrs))
                        return ds;
        return NULL;
}

static struct nfs4_pnfs_ds_addr *nfs4_pnfs_ds_addr_alloc(gfp_t gfp_flags)
{
        struct nfs4_pnfs_ds_addr *da = kzalloc_obj(*da, gfp_flags);
        if (da)
                INIT_LIST_HEAD(&da->da_node);
        return da;
}

static void nfs4_pnfs_ds_addr_free(struct nfs4_pnfs_ds_addr *da)
{
        kfree(da->da_remotestr);
        kfree(da->da_netid);
        kfree(da);
}

static void destroy_ds(struct nfs4_pnfs_ds *ds)
{
        struct nfs4_pnfs_ds_addr *da;

        dprintk("--> %s\n", __func__);
        ifdebug(FACILITY)
                print_ds(ds);

        nfs_put_client(ds->ds_clp);

        while (!list_empty(&ds->ds_addrs)) {
                da = list_first_entry(&ds->ds_addrs,
                                      struct nfs4_pnfs_ds_addr,
                                      da_node);
                list_del_init(&da->da_node);
                nfs4_pnfs_ds_addr_free(da);
        }

        kfree(ds->ds_remotestr);
        kfree(ds);
}

void nfs4_pnfs_ds_put(struct nfs4_pnfs_ds *ds)
{
        struct nfs_net *nn = net_generic(ds->ds_net, nfs_net_id);

        if (refcount_dec_and_lock(&ds->ds_count, &nn->nfs4_data_server_lock)) {
                list_del_init(&ds->ds_node);
                spin_unlock(&nn->nfs4_data_server_lock);
                destroy_ds(ds);
        }
}
EXPORT_SYMBOL_GPL(nfs4_pnfs_ds_put);

/*
 * Create a string with a human readable address and port to avoid
 * complicated setup around many dprinks.
 */
static char *
nfs4_pnfs_remotestr(struct list_head *dsaddrs, gfp_t gfp_flags)
{
        struct nfs4_pnfs_ds_addr *da;
        char *remotestr;
        size_t len;
        char *p;

        len = 3;        /* '{', '}' and eol */
        list_for_each_entry(da, dsaddrs, da_node) {
                len += strlen(da->da_remotestr) + 1;    /* string plus comma */
        }

        remotestr = kzalloc(len, gfp_flags);
        if (!remotestr)
                return NULL;

        p = remotestr;
        *(p++) = '{';
        len--;
        list_for_each_entry(da, dsaddrs, da_node) {
                size_t ll = strlen(da->da_remotestr);

                if (ll > len)
                        goto out_err;

                memcpy(p, da->da_remotestr, ll);
                p += ll;
                len -= ll;

                if (len < 1)
                        goto out_err;
                (*p++) = ',';
                len--;
        }
        if (len < 2)
                goto out_err;
        *(p++) = '}';
        *p = '\0';
        return remotestr;
out_err:
        kfree(remotestr);
        return NULL;
}

/*
 * Given a list of multipath struct nfs4_pnfs_ds_addr, add it to ds cache if
 * uncached and return cached struct nfs4_pnfs_ds.
 */
struct nfs4_pnfs_ds *
nfs4_pnfs_ds_add(const struct net *net, struct list_head *dsaddrs, gfp_t gfp_flags)
{
        struct nfs_net *nn = net_generic(net, nfs_net_id);
        struct nfs4_pnfs_ds *tmp_ds, *ds = NULL;
        char *remotestr;

        if (list_empty(dsaddrs)) {
                dprintk("%s: no addresses defined\n", __func__);
                goto out;
        }

        ds = kzalloc_obj(*ds, gfp_flags);
        if (!ds)
                goto out;

        /* this is only used for debugging, so it's ok if its NULL */
        remotestr = nfs4_pnfs_remotestr(dsaddrs, gfp_flags);

        spin_lock(&nn->nfs4_data_server_lock);
        tmp_ds = _data_server_lookup_locked(nn, dsaddrs);
        if (tmp_ds == NULL) {
                INIT_LIST_HEAD(&ds->ds_addrs);
                list_splice_init(dsaddrs, &ds->ds_addrs);
                ds->ds_remotestr = remotestr;
                refcount_set(&ds->ds_count, 1);
                INIT_LIST_HEAD(&ds->ds_node);
                ds->ds_net = net;
                ds->ds_clp = NULL;
                list_add(&ds->ds_node, &nn->nfs4_data_server_cache);
                dprintk("%s add new data server %s\n", __func__,
                        ds->ds_remotestr);
        } else {
                kfree(remotestr);
                kfree(ds);
                refcount_inc(&tmp_ds->ds_count);
                dprintk("%s data server %s found, inc'ed ds_count to %d\n",
                        __func__, tmp_ds->ds_remotestr,
                        refcount_read(&tmp_ds->ds_count));
                ds = tmp_ds;
        }
        spin_unlock(&nn->nfs4_data_server_lock);
out:
        return ds;
}
EXPORT_SYMBOL_GPL(nfs4_pnfs_ds_add);

static int nfs4_wait_ds_connect(struct nfs4_pnfs_ds *ds)
{
        might_sleep();
        return wait_on_bit(&ds->ds_state, NFS4DS_CONNECTING, TASK_KILLABLE);
}

static void nfs4_clear_ds_conn_bit(struct nfs4_pnfs_ds *ds)
{
        smp_mb__before_atomic();
        clear_and_wake_up_bit(NFS4DS_CONNECTING, &ds->ds_state);
}

static struct nfs_client *(*get_v3_ds_connect)(
                        struct nfs_server *mds_srv,
                        const struct sockaddr_storage *ds_addr,
                        int ds_addrlen,
                        int ds_proto,
                        unsigned int ds_timeo,
                        unsigned int ds_retrans);

static bool load_v3_ds_connect(void)
{
        if (!get_v3_ds_connect) {
                get_v3_ds_connect = symbol_request(nfs3_set_ds_client);
                WARN_ON_ONCE(!get_v3_ds_connect);
        }

        return(get_v3_ds_connect != NULL);
}

void nfs4_pnfs_v3_ds_connect_unload(void)
{
        if (get_v3_ds_connect) {
                symbol_put(nfs3_set_ds_client);
                get_v3_ds_connect = NULL;
        }
}

static int _nfs4_pnfs_v3_ds_connect(struct nfs_server *mds_srv,
                                 struct nfs4_pnfs_ds *ds,
                                 unsigned int timeo,
                                 unsigned int retrans)
{
        struct nfs_client *clp = ERR_PTR(-EIO);
        struct nfs_client *mds_clp = mds_srv->nfs_client;
        enum xprtsec_policies xprtsec_policy = mds_clp->cl_xprtsec.policy;
        struct nfs4_pnfs_ds_addr *da;
        unsigned long connect_timeout = timeo * (retrans + 1) * HZ / 10;
        int ds_proto;
        int status = 0;

        dprintk("--> %s DS %s\n", __func__, ds->ds_remotestr);

        if (!load_v3_ds_connect())
                return -EPROTONOSUPPORT;

        list_for_each_entry(da, &ds->ds_addrs, da_node) {
                dprintk("%s: DS %s: trying address %s\n",
                        __func__, ds->ds_remotestr, da->da_remotestr);

                if (!IS_ERR(clp)) {
                        struct xprt_create xprt_args = {
                                .ident = da->da_transport,
                                .net = clp->cl_net,
                                .dstaddr = (struct sockaddr *)&da->da_addr,
                                .addrlen = da->da_addrlen,
                                .servername = clp->cl_hostname,
                                .connect_timeout = connect_timeout,
                                .reconnect_timeout = connect_timeout,
                                .xprtsec = clp->cl_xprtsec,
                        };

                        if (xprt_args.ident == XPRT_TRANSPORT_TCP &&
                            clp->cl_proto == XPRT_TRANSPORT_TCP_TLS)
                                xprt_args.ident = XPRT_TRANSPORT_TCP_TLS;

                        if (xprt_args.ident != clp->cl_proto)
                                continue;
                        if (xprt_args.dstaddr->sa_family !=
                            clp->cl_addr.ss_family)
                                continue;
                        /* Add this address as an alias */
                        rpc_clnt_add_xprt(clp->cl_rpcclient, &xprt_args,
                                          rpc_clnt_test_and_add_xprt, NULL);
                        continue;
                }

                ds_proto = da->da_transport;
                if (ds_proto == XPRT_TRANSPORT_TCP &&
                    xprtsec_policy != RPC_XPRTSEC_NONE)
                        ds_proto = XPRT_TRANSPORT_TCP_TLS;

                clp = get_v3_ds_connect(mds_srv, &da->da_addr, da->da_addrlen,
                                        ds_proto, timeo, retrans);
                if (IS_ERR(clp))
                        continue;
                clp->cl_rpcclient->cl_softerr = 0;
                clp->cl_rpcclient->cl_softrtry = 0;
        }

        if (IS_ERR(clp)) {
                status = PTR_ERR(clp);
                goto out;
        }

        smp_wmb();
        WRITE_ONCE(ds->ds_clp, clp);
        dprintk("%s [new] addr: %s\n", __func__, ds->ds_remotestr);
out:
        return status;
}

static int _nfs4_pnfs_v4_ds_connect(struct nfs_server *mds_srv,
                                 struct nfs4_pnfs_ds *ds,
                                 unsigned int timeo,
                                 unsigned int retrans,
                                 u32 minor_version)
{
        struct nfs_client *clp = ERR_PTR(-EIO);
        struct nfs_client *mds_clp = mds_srv->nfs_client;
        enum xprtsec_policies xprtsec_policy = mds_clp->cl_xprtsec.policy;
        struct nfs4_pnfs_ds_addr *da;
        int ds_proto;
        int status = 0;

        dprintk("--> %s DS %s\n", __func__, ds->ds_remotestr);

        list_for_each_entry(da, &ds->ds_addrs, da_node) {
                char servername[48];

                dprintk("%s: DS %s: trying address %s\n",
                        __func__, ds->ds_remotestr, da->da_remotestr);

                if (!IS_ERR(clp) && clp->cl_mvops->session_trunk) {
                        struct xprt_create xprt_args = {
                                .ident = da->da_transport,
                                .net = clp->cl_net,
                                .dstaddr = (struct sockaddr *)&da->da_addr,
                                .addrlen = da->da_addrlen,
                                .servername = clp->cl_hostname,
                                .xprtsec = clp->cl_xprtsec,
                        };
                        struct nfs4_add_xprt_data xprtdata = {
                                .clp = clp,
                        };
                        struct rpc_add_xprt_test rpcdata = {
                                .add_xprt_test = clp->cl_mvops->session_trunk,
                                .data = &xprtdata,
                        };

                        if (xprt_args.ident == XPRT_TRANSPORT_TCP &&
                            clp->cl_proto == XPRT_TRANSPORT_TCP_TLS) {
                                struct sockaddr *addr =
                                        (struct sockaddr *)&da->da_addr;
                                struct sockaddr_in *sin =
                                        (struct sockaddr_in *)&da->da_addr;
                                struct sockaddr_in6 *sin6 =
                                        (struct sockaddr_in6 *)&da->da_addr;

                                /* for NFS with TLS we need to supply a correct
                                 * servername of the trunked transport, not the
                                 * servername of the main transport stored in
                                 * clp->cl_hostname. And set the protocol to
                                 * indicate to use TLS
                                 */
                                servername[0] = '\0';
                                switch(addr->sa_family) {
                                case AF_INET:
                                        snprintf(servername, sizeof(servername),
                                                "%pI4", &sin->sin_addr.s_addr);
                                        break;
                                case AF_INET6:
                                        snprintf(servername, sizeof(servername),
                                                "%pI6", &sin6->sin6_addr);
                                        break;
                                default:
                                        /* do not consider this address */
                                        continue;
                                }
                                xprt_args.ident = XPRT_TRANSPORT_TCP_TLS;
                                xprt_args.servername = servername;
                        }
                        if (xprt_args.ident != clp->cl_proto)
                                continue;
                        if (xprt_args.dstaddr->sa_family !=
                            clp->cl_addr.ss_family)
                                continue;

                        /**
                        * Test this address for session trunking and
                        * add as an alias
                        */
                        xprtdata.cred = nfs4_get_clid_cred(clp);
                        rpc_clnt_add_xprt(clp->cl_rpcclient, &xprt_args,
                                          rpc_clnt_setup_test_and_add_xprt,
                                          &rpcdata);
                        if (xprtdata.cred)
                                put_cred(xprtdata.cred);
                } else {
                        ds_proto = da->da_transport;
                        if (ds_proto == XPRT_TRANSPORT_TCP &&
                            xprtsec_policy != RPC_XPRTSEC_NONE)
                                ds_proto = XPRT_TRANSPORT_TCP_TLS;

                        clp = nfs4_set_ds_client(mds_srv, &da->da_addr,
                                                 da->da_addrlen, ds_proto,
                                                 timeo, retrans, minor_version);
                        if (IS_ERR(clp))
                                continue;

                        status = nfs4_init_ds_session(clp,
                                        mds_srv->nfs_client->cl_lease_time);
                        if (status) {
                                nfs_put_client(clp);
                                clp = ERR_PTR(-EIO);
                                continue;
                        }
                }
        }

        if (IS_ERR(clp)) {
                status = PTR_ERR(clp);
                goto out;
        }

        smp_wmb();
        WRITE_ONCE(ds->ds_clp, clp);
        dprintk("%s [new] addr: %s\n", __func__, ds->ds_remotestr);
out:
        return status;
}

/*
 * Create an rpc connection to the nfs4_pnfs_ds data server.
 * Currently only supports IPv4 and IPv6 addresses.
 * If connection fails, make devid unavailable and return a -errno.
 */
int nfs4_pnfs_ds_connect(struct nfs_server *mds_srv, struct nfs4_pnfs_ds *ds,
                          struct nfs4_deviceid_node *devid, unsigned int timeo,
                          unsigned int retrans, u32 version, u32 minor_version)
{
        int err;

        do {
                err = nfs4_wait_ds_connect(ds);
                if (err || ds->ds_clp)
                        goto out;
                if (nfs4_test_deviceid_unavailable(devid)) {
                        err = -ENODEV;
                        goto out;
                }
        } while (test_and_set_bit(NFS4DS_CONNECTING, &ds->ds_state) != 0);

        if (ds->ds_clp)
                goto connect_done;

        switch (version) {
        case 3:
                err = _nfs4_pnfs_v3_ds_connect(mds_srv, ds, timeo, retrans);
                break;
        case 4:
                err = _nfs4_pnfs_v4_ds_connect(mds_srv, ds, timeo, retrans,
                                               minor_version);
                break;
        default:
                dprintk("%s: unsupported DS version %d\n", __func__, version);
                err = -EPROTONOSUPPORT;
        }

connect_done:
        nfs4_clear_ds_conn_bit(ds);
out:
        /*
         * At this point the ds->ds_clp should be ready, but it might have
         * hit an error.
         */
        if (!err) {
                if (!ds->ds_clp || !nfs_client_init_is_complete(ds->ds_clp)) {
                        WARN_ON_ONCE(ds->ds_clp ||
                                !nfs4_test_deviceid_unavailable(devid));
                        err = -EINVAL;
                } else
                        err = nfs_client_init_status(ds->ds_clp);
        }

        trace_pnfs_ds_connect(ds->ds_remotestr, err);
        return err;
}
EXPORT_SYMBOL_GPL(nfs4_pnfs_ds_connect);

/*
 * Currently only supports ipv4, ipv6 and one multi-path address.
 */
struct nfs4_pnfs_ds_addr *
nfs4_decode_mp_ds_addr(struct net *net, struct xdr_stream *xdr, gfp_t gfp_flags)
{
        struct nfs4_pnfs_ds_addr *da = NULL;
        char *buf, *portstr;
        __be16 port;
        ssize_t nlen, rlen;
        int tmp[2];
        char *netid;
        size_t len;
        char *startsep = "";
        char *endsep = "";


        /* r_netid */
        nlen = xdr_stream_decode_string_dup(xdr, &netid, XDR_MAX_NETOBJ,
                                            gfp_flags);
        if (unlikely(nlen < 0))
                goto out_err;

        /* r_addr: ip/ip6addr with port in dec octets - see RFC 5665 */
        /* port is ".ABC.DEF", 8 chars max */
        rlen = xdr_stream_decode_string_dup(xdr, &buf, INET6_ADDRSTRLEN +
                                            IPV6_SCOPE_ID_LEN + 8, gfp_flags);
        if (unlikely(rlen < 0))
                goto out_free_netid;

        /* replace port '.' with '-' */
        portstr = strrchr(buf, '.');
        if (!portstr) {
                dprintk("%s: Failed finding expected dot in port\n",
                        __func__);
                goto out_free_buf;
        }
        *portstr = '-';

        /* find '.' between address and port */
        portstr = strrchr(buf, '.');
        if (!portstr) {
                dprintk("%s: Failed finding expected dot between address and "
                        "port\n", __func__);
                goto out_free_buf;
        }
        *portstr = '\0';

        da = nfs4_pnfs_ds_addr_alloc(gfp_flags);
        if (unlikely(!da))
                goto out_free_buf;

        if (!rpc_pton(net, buf, portstr-buf, (struct sockaddr *)&da->da_addr,
                      sizeof(da->da_addr))) {
                dprintk("%s: error parsing address %s\n", __func__, buf);
                goto out_free_da;
        }

        portstr++;
        sscanf(portstr, "%d-%d", &tmp[0], &tmp[1]);
        port = htons((tmp[0] << 8) | (tmp[1]));

        switch (da->da_addr.ss_family) {
        case AF_INET:
                ((struct sockaddr_in *)&da->da_addr)->sin_port = port;
                da->da_addrlen = sizeof(struct sockaddr_in);
                break;

        case AF_INET6:
                ((struct sockaddr_in6 *)&da->da_addr)->sin6_port = port;
                da->da_addrlen = sizeof(struct sockaddr_in6);
                startsep = "[";
                endsep = "]";
                break;

        default:
                dprintk("%s: unsupported address family: %u\n",
                        __func__, da->da_addr.ss_family);
                goto out_free_da;
        }

        da->da_transport = xprt_find_transport_ident(netid);
        if (da->da_transport < 0) {
                dprintk("%s: ERROR: unknown r_netid \"%s\"\n",
                        __func__, netid);
                goto out_free_da;
        }

        da->da_netid = netid;

        /* save human readable address */
        len = strlen(startsep) + strlen(buf) + strlen(endsep) + 7;
        da->da_remotestr = kzalloc(len, gfp_flags);

        /* NULL is ok, only used for dprintk */
        if (da->da_remotestr)
                snprintf(da->da_remotestr, len, "%s%s%s:%u", startsep,
                         buf, endsep, ntohs(port));

        dprintk("%s: Parsed DS addr %s\n", __func__, da->da_remotestr);
        kfree(buf);
        return da;

out_free_da:
        kfree(da);
out_free_buf:
        dprintk("%s: Error parsing DS addr: %s\n", __func__, buf);
        kfree(buf);
out_free_netid:
        kfree(netid);
out_err:
        return NULL;
}
EXPORT_SYMBOL_GPL(nfs4_decode_mp_ds_addr);

void
pnfs_layout_mark_request_commit(struct nfs_page *req,
                                struct pnfs_layout_segment *lseg,
                                struct nfs_commit_info *cinfo,
                                u32 ds_commit_idx)
{
        struct list_head *list;
        struct pnfs_commit_array *array;
        struct pnfs_commit_bucket *bucket;

        mutex_lock(&NFS_I(cinfo->inode)->commit_mutex);
        array = pnfs_lookup_commit_array(cinfo->ds, lseg);
        if (!array || !pnfs_is_valid_lseg(lseg))
                goto out_resched;
        bucket = &array->buckets[ds_commit_idx];
        list = &bucket->written;
        /* Non-empty buckets hold a reference on the lseg.  That ref
         * is normally transferred to the COMMIT call and released
         * there.  It could also be released if the last req is pulled
         * off due to a rewrite, in which case it will be done in
         * pnfs_common_clear_request_commit
         */
        if (!bucket->lseg)
                bucket->lseg = pnfs_get_lseg(lseg);
        set_bit(PG_COMMIT_TO_DS, &req->wb_flags);
        cinfo->ds->nwritten++;

        nfs_request_add_commit_list_locked(req, list, cinfo);
        mutex_unlock(&NFS_I(cinfo->inode)->commit_mutex);
        nfs_folio_mark_unstable(nfs_page_to_folio(req), cinfo);
        return;
out_resched:
        mutex_unlock(&NFS_I(cinfo->inode)->commit_mutex);
        cinfo->completion_ops->resched_write(cinfo, req);
}
EXPORT_SYMBOL_GPL(pnfs_layout_mark_request_commit);

int
pnfs_nfs_generic_sync(struct inode *inode, bool datasync)
{
        int ret;

        if (!pnfs_layoutcommit_outstanding(inode))
                return 0;
        ret = nfs_commit_inode(inode, FLUSH_SYNC);
        if (ret < 0)
                return ret;
        if (datasync)
                return 0;
        return pnfs_layoutcommit_inode(inode, true);
}
EXPORT_SYMBOL_GPL(pnfs_nfs_generic_sync);