18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
28c2ecf20Sopenharmony_ci/*
38c2ecf20Sopenharmony_ci * linux/net/sunrpc/svc.c
48c2ecf20Sopenharmony_ci *
58c2ecf20Sopenharmony_ci * High-level RPC service routines
68c2ecf20Sopenharmony_ci *
78c2ecf20Sopenharmony_ci * Copyright (C) 1995, 1996 Olaf Kirch <okir@monad.swb.de>
88c2ecf20Sopenharmony_ci *
98c2ecf20Sopenharmony_ci * Multiple threads pools and NUMAisation
108c2ecf20Sopenharmony_ci * Copyright (c) 2006 Silicon Graphics, Inc.
118c2ecf20Sopenharmony_ci * by Greg Banks <gnb@melbourne.sgi.com>
128c2ecf20Sopenharmony_ci */
138c2ecf20Sopenharmony_ci
148c2ecf20Sopenharmony_ci#include <linux/linkage.h>
158c2ecf20Sopenharmony_ci#include <linux/sched/signal.h>
168c2ecf20Sopenharmony_ci#include <linux/errno.h>
178c2ecf20Sopenharmony_ci#include <linux/net.h>
188c2ecf20Sopenharmony_ci#include <linux/in.h>
198c2ecf20Sopenharmony_ci#include <linux/mm.h>
208c2ecf20Sopenharmony_ci#include <linux/interrupt.h>
218c2ecf20Sopenharmony_ci#include <linux/module.h>
228c2ecf20Sopenharmony_ci#include <linux/kthread.h>
238c2ecf20Sopenharmony_ci#include <linux/slab.h>
248c2ecf20Sopenharmony_ci
258c2ecf20Sopenharmony_ci#include <linux/sunrpc/types.h>
268c2ecf20Sopenharmony_ci#include <linux/sunrpc/xdr.h>
278c2ecf20Sopenharmony_ci#include <linux/sunrpc/stats.h>
288c2ecf20Sopenharmony_ci#include <linux/sunrpc/svcsock.h>
298c2ecf20Sopenharmony_ci#include <linux/sunrpc/clnt.h>
308c2ecf20Sopenharmony_ci#include <linux/sunrpc/bc_xprt.h>
318c2ecf20Sopenharmony_ci
328c2ecf20Sopenharmony_ci#include <trace/events/sunrpc.h>
338c2ecf20Sopenharmony_ci
348c2ecf20Sopenharmony_ci#define RPCDBG_FACILITY	RPCDBG_SVCDSP
358c2ecf20Sopenharmony_ci
368c2ecf20Sopenharmony_cistatic void svc_unregister(const struct svc_serv *serv, struct net *net);
378c2ecf20Sopenharmony_ci
388c2ecf20Sopenharmony_ci#define svc_serv_is_pooled(serv)    ((serv)->sv_ops->svo_function)
398c2ecf20Sopenharmony_ci
408c2ecf20Sopenharmony_ci#define SVC_POOL_DEFAULT	SVC_POOL_GLOBAL
418c2ecf20Sopenharmony_ci
428c2ecf20Sopenharmony_ci/*
438c2ecf20Sopenharmony_ci * Structure for mapping cpus to pools and vice versa.
448c2ecf20Sopenharmony_ci * Setup once during sunrpc initialisation.
458c2ecf20Sopenharmony_ci */
468c2ecf20Sopenharmony_cistruct svc_pool_map svc_pool_map = {
478c2ecf20Sopenharmony_ci	.mode = SVC_POOL_DEFAULT
488c2ecf20Sopenharmony_ci};
498c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_pool_map);
508c2ecf20Sopenharmony_ci
518c2ecf20Sopenharmony_cistatic DEFINE_MUTEX(svc_pool_map_mutex);/* protects svc_pool_map.count only */
528c2ecf20Sopenharmony_ci
538c2ecf20Sopenharmony_cistatic int
548c2ecf20Sopenharmony_ciparam_set_pool_mode(const char *val, const struct kernel_param *kp)
558c2ecf20Sopenharmony_ci{
568c2ecf20Sopenharmony_ci	int *ip = (int *)kp->arg;
578c2ecf20Sopenharmony_ci	struct svc_pool_map *m = &svc_pool_map;
588c2ecf20Sopenharmony_ci	int err;
598c2ecf20Sopenharmony_ci
608c2ecf20Sopenharmony_ci	mutex_lock(&svc_pool_map_mutex);
618c2ecf20Sopenharmony_ci
628c2ecf20Sopenharmony_ci	err = -EBUSY;
638c2ecf20Sopenharmony_ci	if (m->count)
648c2ecf20Sopenharmony_ci		goto out;
658c2ecf20Sopenharmony_ci
668c2ecf20Sopenharmony_ci	err = 0;
678c2ecf20Sopenharmony_ci	if (!strncmp(val, "auto", 4))
688c2ecf20Sopenharmony_ci		*ip = SVC_POOL_AUTO;
698c2ecf20Sopenharmony_ci	else if (!strncmp(val, "global", 6))
708c2ecf20Sopenharmony_ci		*ip = SVC_POOL_GLOBAL;
718c2ecf20Sopenharmony_ci	else if (!strncmp(val, "percpu", 6))
728c2ecf20Sopenharmony_ci		*ip = SVC_POOL_PERCPU;
738c2ecf20Sopenharmony_ci	else if (!strncmp(val, "pernode", 7))
748c2ecf20Sopenharmony_ci		*ip = SVC_POOL_PERNODE;
758c2ecf20Sopenharmony_ci	else
768c2ecf20Sopenharmony_ci		err = -EINVAL;
778c2ecf20Sopenharmony_ci
788c2ecf20Sopenharmony_ciout:
798c2ecf20Sopenharmony_ci	mutex_unlock(&svc_pool_map_mutex);
808c2ecf20Sopenharmony_ci	return err;
818c2ecf20Sopenharmony_ci}
828c2ecf20Sopenharmony_ci
838c2ecf20Sopenharmony_cistatic int
848c2ecf20Sopenharmony_ciparam_get_pool_mode(char *buf, const struct kernel_param *kp)
858c2ecf20Sopenharmony_ci{
868c2ecf20Sopenharmony_ci	int *ip = (int *)kp->arg;
878c2ecf20Sopenharmony_ci
888c2ecf20Sopenharmony_ci	switch (*ip)
898c2ecf20Sopenharmony_ci	{
908c2ecf20Sopenharmony_ci	case SVC_POOL_AUTO:
918c2ecf20Sopenharmony_ci		return strlcpy(buf, "auto\n", 20);
928c2ecf20Sopenharmony_ci	case SVC_POOL_GLOBAL:
938c2ecf20Sopenharmony_ci		return strlcpy(buf, "global\n", 20);
948c2ecf20Sopenharmony_ci	case SVC_POOL_PERCPU:
958c2ecf20Sopenharmony_ci		return strlcpy(buf, "percpu\n", 20);
968c2ecf20Sopenharmony_ci	case SVC_POOL_PERNODE:
978c2ecf20Sopenharmony_ci		return strlcpy(buf, "pernode\n", 20);
988c2ecf20Sopenharmony_ci	default:
998c2ecf20Sopenharmony_ci		return sprintf(buf, "%d\n", *ip);
1008c2ecf20Sopenharmony_ci	}
1018c2ecf20Sopenharmony_ci}
1028c2ecf20Sopenharmony_ci
1038c2ecf20Sopenharmony_cimodule_param_call(pool_mode, param_set_pool_mode, param_get_pool_mode,
1048c2ecf20Sopenharmony_ci		 &svc_pool_map.mode, 0644);
1058c2ecf20Sopenharmony_ci
1068c2ecf20Sopenharmony_ci/*
1078c2ecf20Sopenharmony_ci * Detect best pool mapping mode heuristically,
1088c2ecf20Sopenharmony_ci * according to the machine's topology.
1098c2ecf20Sopenharmony_ci */
1108c2ecf20Sopenharmony_cistatic int
1118c2ecf20Sopenharmony_cisvc_pool_map_choose_mode(void)
1128c2ecf20Sopenharmony_ci{
1138c2ecf20Sopenharmony_ci	unsigned int node;
1148c2ecf20Sopenharmony_ci
1158c2ecf20Sopenharmony_ci	if (nr_online_nodes > 1) {
1168c2ecf20Sopenharmony_ci		/*
1178c2ecf20Sopenharmony_ci		 * Actually have multiple NUMA nodes,
1188c2ecf20Sopenharmony_ci		 * so split pools on NUMA node boundaries
1198c2ecf20Sopenharmony_ci		 */
1208c2ecf20Sopenharmony_ci		return SVC_POOL_PERNODE;
1218c2ecf20Sopenharmony_ci	}
1228c2ecf20Sopenharmony_ci
1238c2ecf20Sopenharmony_ci	node = first_online_node;
1248c2ecf20Sopenharmony_ci	if (nr_cpus_node(node) > 2) {
1258c2ecf20Sopenharmony_ci		/*
1268c2ecf20Sopenharmony_ci		 * Non-trivial SMP, or CONFIG_NUMA on
1278c2ecf20Sopenharmony_ci		 * non-NUMA hardware, e.g. with a generic
1288c2ecf20Sopenharmony_ci		 * x86_64 kernel on Xeons.  In this case we
1298c2ecf20Sopenharmony_ci		 * want to divide the pools on cpu boundaries.
1308c2ecf20Sopenharmony_ci		 */
1318c2ecf20Sopenharmony_ci		return SVC_POOL_PERCPU;
1328c2ecf20Sopenharmony_ci	}
1338c2ecf20Sopenharmony_ci
1348c2ecf20Sopenharmony_ci	/* default: one global pool */
1358c2ecf20Sopenharmony_ci	return SVC_POOL_GLOBAL;
1368c2ecf20Sopenharmony_ci}
1378c2ecf20Sopenharmony_ci
1388c2ecf20Sopenharmony_ci/*
1398c2ecf20Sopenharmony_ci * Allocate the to_pool[] and pool_to[] arrays.
1408c2ecf20Sopenharmony_ci * Returns 0 on success or an errno.
1418c2ecf20Sopenharmony_ci */
1428c2ecf20Sopenharmony_cistatic int
1438c2ecf20Sopenharmony_cisvc_pool_map_alloc_arrays(struct svc_pool_map *m, unsigned int maxpools)
1448c2ecf20Sopenharmony_ci{
1458c2ecf20Sopenharmony_ci	m->to_pool = kcalloc(maxpools, sizeof(unsigned int), GFP_KERNEL);
1468c2ecf20Sopenharmony_ci	if (!m->to_pool)
1478c2ecf20Sopenharmony_ci		goto fail;
1488c2ecf20Sopenharmony_ci	m->pool_to = kcalloc(maxpools, sizeof(unsigned int), GFP_KERNEL);
1498c2ecf20Sopenharmony_ci	if (!m->pool_to)
1508c2ecf20Sopenharmony_ci		goto fail_free;
1518c2ecf20Sopenharmony_ci
1528c2ecf20Sopenharmony_ci	return 0;
1538c2ecf20Sopenharmony_ci
1548c2ecf20Sopenharmony_cifail_free:
1558c2ecf20Sopenharmony_ci	kfree(m->to_pool);
1568c2ecf20Sopenharmony_ci	m->to_pool = NULL;
1578c2ecf20Sopenharmony_cifail:
1588c2ecf20Sopenharmony_ci	return -ENOMEM;
1598c2ecf20Sopenharmony_ci}
1608c2ecf20Sopenharmony_ci
1618c2ecf20Sopenharmony_ci/*
1628c2ecf20Sopenharmony_ci * Initialise the pool map for SVC_POOL_PERCPU mode.
1638c2ecf20Sopenharmony_ci * Returns number of pools or <0 on error.
1648c2ecf20Sopenharmony_ci */
1658c2ecf20Sopenharmony_cistatic int
1668c2ecf20Sopenharmony_cisvc_pool_map_init_percpu(struct svc_pool_map *m)
1678c2ecf20Sopenharmony_ci{
1688c2ecf20Sopenharmony_ci	unsigned int maxpools = nr_cpu_ids;
1698c2ecf20Sopenharmony_ci	unsigned int pidx = 0;
1708c2ecf20Sopenharmony_ci	unsigned int cpu;
1718c2ecf20Sopenharmony_ci	int err;
1728c2ecf20Sopenharmony_ci
1738c2ecf20Sopenharmony_ci	err = svc_pool_map_alloc_arrays(m, maxpools);
1748c2ecf20Sopenharmony_ci	if (err)
1758c2ecf20Sopenharmony_ci		return err;
1768c2ecf20Sopenharmony_ci
1778c2ecf20Sopenharmony_ci	for_each_online_cpu(cpu) {
1788c2ecf20Sopenharmony_ci		BUG_ON(pidx >= maxpools);
1798c2ecf20Sopenharmony_ci		m->to_pool[cpu] = pidx;
1808c2ecf20Sopenharmony_ci		m->pool_to[pidx] = cpu;
1818c2ecf20Sopenharmony_ci		pidx++;
1828c2ecf20Sopenharmony_ci	}
1838c2ecf20Sopenharmony_ci	/* cpus brought online later all get mapped to pool0, sorry */
1848c2ecf20Sopenharmony_ci
1858c2ecf20Sopenharmony_ci	return pidx;
1868c2ecf20Sopenharmony_ci};
1878c2ecf20Sopenharmony_ci
1888c2ecf20Sopenharmony_ci
1898c2ecf20Sopenharmony_ci/*
1908c2ecf20Sopenharmony_ci * Initialise the pool map for SVC_POOL_PERNODE mode.
1918c2ecf20Sopenharmony_ci * Returns number of pools or <0 on error.
1928c2ecf20Sopenharmony_ci */
1938c2ecf20Sopenharmony_cistatic int
1948c2ecf20Sopenharmony_cisvc_pool_map_init_pernode(struct svc_pool_map *m)
1958c2ecf20Sopenharmony_ci{
1968c2ecf20Sopenharmony_ci	unsigned int maxpools = nr_node_ids;
1978c2ecf20Sopenharmony_ci	unsigned int pidx = 0;
1988c2ecf20Sopenharmony_ci	unsigned int node;
1998c2ecf20Sopenharmony_ci	int err;
2008c2ecf20Sopenharmony_ci
2018c2ecf20Sopenharmony_ci	err = svc_pool_map_alloc_arrays(m, maxpools);
2028c2ecf20Sopenharmony_ci	if (err)
2038c2ecf20Sopenharmony_ci		return err;
2048c2ecf20Sopenharmony_ci
2058c2ecf20Sopenharmony_ci	for_each_node_with_cpus(node) {
2068c2ecf20Sopenharmony_ci		/* some architectures (e.g. SN2) have cpuless nodes */
2078c2ecf20Sopenharmony_ci		BUG_ON(pidx > maxpools);
2088c2ecf20Sopenharmony_ci		m->to_pool[node] = pidx;
2098c2ecf20Sopenharmony_ci		m->pool_to[pidx] = node;
2108c2ecf20Sopenharmony_ci		pidx++;
2118c2ecf20Sopenharmony_ci	}
2128c2ecf20Sopenharmony_ci	/* nodes brought online later all get mapped to pool0, sorry */
2138c2ecf20Sopenharmony_ci
2148c2ecf20Sopenharmony_ci	return pidx;
2158c2ecf20Sopenharmony_ci}
2168c2ecf20Sopenharmony_ci
2178c2ecf20Sopenharmony_ci
2188c2ecf20Sopenharmony_ci/*
2198c2ecf20Sopenharmony_ci * Add a reference to the global map of cpus to pools (and
2208c2ecf20Sopenharmony_ci * vice versa).  Initialise the map if we're the first user.
2218c2ecf20Sopenharmony_ci * Returns the number of pools.
2228c2ecf20Sopenharmony_ci */
2238c2ecf20Sopenharmony_ciunsigned int
2248c2ecf20Sopenharmony_cisvc_pool_map_get(void)
2258c2ecf20Sopenharmony_ci{
2268c2ecf20Sopenharmony_ci	struct svc_pool_map *m = &svc_pool_map;
2278c2ecf20Sopenharmony_ci	int npools = -1;
2288c2ecf20Sopenharmony_ci
2298c2ecf20Sopenharmony_ci	mutex_lock(&svc_pool_map_mutex);
2308c2ecf20Sopenharmony_ci
2318c2ecf20Sopenharmony_ci	if (m->count++) {
2328c2ecf20Sopenharmony_ci		mutex_unlock(&svc_pool_map_mutex);
2338c2ecf20Sopenharmony_ci		return m->npools;
2348c2ecf20Sopenharmony_ci	}
2358c2ecf20Sopenharmony_ci
2368c2ecf20Sopenharmony_ci	if (m->mode == SVC_POOL_AUTO)
2378c2ecf20Sopenharmony_ci		m->mode = svc_pool_map_choose_mode();
2388c2ecf20Sopenharmony_ci
2398c2ecf20Sopenharmony_ci	switch (m->mode) {
2408c2ecf20Sopenharmony_ci	case SVC_POOL_PERCPU:
2418c2ecf20Sopenharmony_ci		npools = svc_pool_map_init_percpu(m);
2428c2ecf20Sopenharmony_ci		break;
2438c2ecf20Sopenharmony_ci	case SVC_POOL_PERNODE:
2448c2ecf20Sopenharmony_ci		npools = svc_pool_map_init_pernode(m);
2458c2ecf20Sopenharmony_ci		break;
2468c2ecf20Sopenharmony_ci	}
2478c2ecf20Sopenharmony_ci
2488c2ecf20Sopenharmony_ci	if (npools < 0) {
2498c2ecf20Sopenharmony_ci		/* default, or memory allocation failure */
2508c2ecf20Sopenharmony_ci		npools = 1;
2518c2ecf20Sopenharmony_ci		m->mode = SVC_POOL_GLOBAL;
2528c2ecf20Sopenharmony_ci	}
2538c2ecf20Sopenharmony_ci	m->npools = npools;
2548c2ecf20Sopenharmony_ci
2558c2ecf20Sopenharmony_ci	mutex_unlock(&svc_pool_map_mutex);
2568c2ecf20Sopenharmony_ci	return m->npools;
2578c2ecf20Sopenharmony_ci}
2588c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_pool_map_get);
2598c2ecf20Sopenharmony_ci
2608c2ecf20Sopenharmony_ci/*
2618c2ecf20Sopenharmony_ci * Drop a reference to the global map of cpus to pools.
2628c2ecf20Sopenharmony_ci * When the last reference is dropped, the map data is
2638c2ecf20Sopenharmony_ci * freed; this allows the sysadmin to change the pool
2648c2ecf20Sopenharmony_ci * mode using the pool_mode module option without
2658c2ecf20Sopenharmony_ci * rebooting or re-loading sunrpc.ko.
2668c2ecf20Sopenharmony_ci */
2678c2ecf20Sopenharmony_civoid
2688c2ecf20Sopenharmony_cisvc_pool_map_put(void)
2698c2ecf20Sopenharmony_ci{
2708c2ecf20Sopenharmony_ci	struct svc_pool_map *m = &svc_pool_map;
2718c2ecf20Sopenharmony_ci
2728c2ecf20Sopenharmony_ci	mutex_lock(&svc_pool_map_mutex);
2738c2ecf20Sopenharmony_ci
2748c2ecf20Sopenharmony_ci	if (!--m->count) {
2758c2ecf20Sopenharmony_ci		kfree(m->to_pool);
2768c2ecf20Sopenharmony_ci		m->to_pool = NULL;
2778c2ecf20Sopenharmony_ci		kfree(m->pool_to);
2788c2ecf20Sopenharmony_ci		m->pool_to = NULL;
2798c2ecf20Sopenharmony_ci		m->npools = 0;
2808c2ecf20Sopenharmony_ci	}
2818c2ecf20Sopenharmony_ci
2828c2ecf20Sopenharmony_ci	mutex_unlock(&svc_pool_map_mutex);
2838c2ecf20Sopenharmony_ci}
2848c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_pool_map_put);
2858c2ecf20Sopenharmony_ci
2868c2ecf20Sopenharmony_cistatic int svc_pool_map_get_node(unsigned int pidx)
2878c2ecf20Sopenharmony_ci{
2888c2ecf20Sopenharmony_ci	const struct svc_pool_map *m = &svc_pool_map;
2898c2ecf20Sopenharmony_ci
2908c2ecf20Sopenharmony_ci	if (m->count) {
2918c2ecf20Sopenharmony_ci		if (m->mode == SVC_POOL_PERCPU)
2928c2ecf20Sopenharmony_ci			return cpu_to_node(m->pool_to[pidx]);
2938c2ecf20Sopenharmony_ci		if (m->mode == SVC_POOL_PERNODE)
2948c2ecf20Sopenharmony_ci			return m->pool_to[pidx];
2958c2ecf20Sopenharmony_ci	}
2968c2ecf20Sopenharmony_ci	return NUMA_NO_NODE;
2978c2ecf20Sopenharmony_ci}
2988c2ecf20Sopenharmony_ci/*
2998c2ecf20Sopenharmony_ci * Set the given thread's cpus_allowed mask so that it
3008c2ecf20Sopenharmony_ci * will only run on cpus in the given pool.
3018c2ecf20Sopenharmony_ci */
3028c2ecf20Sopenharmony_cistatic inline void
3038c2ecf20Sopenharmony_cisvc_pool_map_set_cpumask(struct task_struct *task, unsigned int pidx)
3048c2ecf20Sopenharmony_ci{
3058c2ecf20Sopenharmony_ci	struct svc_pool_map *m = &svc_pool_map;
3068c2ecf20Sopenharmony_ci	unsigned int node = m->pool_to[pidx];
3078c2ecf20Sopenharmony_ci
3088c2ecf20Sopenharmony_ci	/*
3098c2ecf20Sopenharmony_ci	 * The caller checks for sv_nrpools > 1, which
3108c2ecf20Sopenharmony_ci	 * implies that we've been initialized.
3118c2ecf20Sopenharmony_ci	 */
3128c2ecf20Sopenharmony_ci	WARN_ON_ONCE(m->count == 0);
3138c2ecf20Sopenharmony_ci	if (m->count == 0)
3148c2ecf20Sopenharmony_ci		return;
3158c2ecf20Sopenharmony_ci
3168c2ecf20Sopenharmony_ci	switch (m->mode) {
3178c2ecf20Sopenharmony_ci	case SVC_POOL_PERCPU:
3188c2ecf20Sopenharmony_ci	{
3198c2ecf20Sopenharmony_ci		set_cpus_allowed_ptr(task, cpumask_of(node));
3208c2ecf20Sopenharmony_ci		break;
3218c2ecf20Sopenharmony_ci	}
3228c2ecf20Sopenharmony_ci	case SVC_POOL_PERNODE:
3238c2ecf20Sopenharmony_ci	{
3248c2ecf20Sopenharmony_ci		set_cpus_allowed_ptr(task, cpumask_of_node(node));
3258c2ecf20Sopenharmony_ci		break;
3268c2ecf20Sopenharmony_ci	}
3278c2ecf20Sopenharmony_ci	}
3288c2ecf20Sopenharmony_ci}
3298c2ecf20Sopenharmony_ci
3308c2ecf20Sopenharmony_ci/*
3318c2ecf20Sopenharmony_ci * Use the mapping mode to choose a pool for a given CPU.
3328c2ecf20Sopenharmony_ci * Used when enqueueing an incoming RPC.  Always returns
3338c2ecf20Sopenharmony_ci * a non-NULL pool pointer.
3348c2ecf20Sopenharmony_ci */
3358c2ecf20Sopenharmony_cistruct svc_pool *
3368c2ecf20Sopenharmony_cisvc_pool_for_cpu(struct svc_serv *serv, int cpu)
3378c2ecf20Sopenharmony_ci{
3388c2ecf20Sopenharmony_ci	struct svc_pool_map *m = &svc_pool_map;
3398c2ecf20Sopenharmony_ci	unsigned int pidx = 0;
3408c2ecf20Sopenharmony_ci
3418c2ecf20Sopenharmony_ci	/*
3428c2ecf20Sopenharmony_ci	 * An uninitialised map happens in a pure client when
3438c2ecf20Sopenharmony_ci	 * lockd is brought up, so silently treat it the
3448c2ecf20Sopenharmony_ci	 * same as SVC_POOL_GLOBAL.
3458c2ecf20Sopenharmony_ci	 */
3468c2ecf20Sopenharmony_ci	if (svc_serv_is_pooled(serv)) {
3478c2ecf20Sopenharmony_ci		switch (m->mode) {
3488c2ecf20Sopenharmony_ci		case SVC_POOL_PERCPU:
3498c2ecf20Sopenharmony_ci			pidx = m->to_pool[cpu];
3508c2ecf20Sopenharmony_ci			break;
3518c2ecf20Sopenharmony_ci		case SVC_POOL_PERNODE:
3528c2ecf20Sopenharmony_ci			pidx = m->to_pool[cpu_to_node(cpu)];
3538c2ecf20Sopenharmony_ci			break;
3548c2ecf20Sopenharmony_ci		}
3558c2ecf20Sopenharmony_ci	}
3568c2ecf20Sopenharmony_ci	return &serv->sv_pools[pidx % serv->sv_nrpools];
3578c2ecf20Sopenharmony_ci}
3588c2ecf20Sopenharmony_ci
3598c2ecf20Sopenharmony_ciint svc_rpcb_setup(struct svc_serv *serv, struct net *net)
3608c2ecf20Sopenharmony_ci{
3618c2ecf20Sopenharmony_ci	int err;
3628c2ecf20Sopenharmony_ci
3638c2ecf20Sopenharmony_ci	err = rpcb_create_local(net);
3648c2ecf20Sopenharmony_ci	if (err)
3658c2ecf20Sopenharmony_ci		return err;
3668c2ecf20Sopenharmony_ci
3678c2ecf20Sopenharmony_ci	/* Remove any stale portmap registrations */
3688c2ecf20Sopenharmony_ci	svc_unregister(serv, net);
3698c2ecf20Sopenharmony_ci	return 0;
3708c2ecf20Sopenharmony_ci}
3718c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_rpcb_setup);
3728c2ecf20Sopenharmony_ci
3738c2ecf20Sopenharmony_civoid svc_rpcb_cleanup(struct svc_serv *serv, struct net *net)
3748c2ecf20Sopenharmony_ci{
3758c2ecf20Sopenharmony_ci	svc_unregister(serv, net);
3768c2ecf20Sopenharmony_ci	rpcb_put_local(net);
3778c2ecf20Sopenharmony_ci}
3788c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_rpcb_cleanup);
3798c2ecf20Sopenharmony_ci
3808c2ecf20Sopenharmony_cistatic int svc_uses_rpcbind(struct svc_serv *serv)
3818c2ecf20Sopenharmony_ci{
3828c2ecf20Sopenharmony_ci	struct svc_program	*progp;
3838c2ecf20Sopenharmony_ci	unsigned int		i;
3848c2ecf20Sopenharmony_ci
3858c2ecf20Sopenharmony_ci	for (progp = serv->sv_program; progp; progp = progp->pg_next) {
3868c2ecf20Sopenharmony_ci		for (i = 0; i < progp->pg_nvers; i++) {
3878c2ecf20Sopenharmony_ci			if (progp->pg_vers[i] == NULL)
3888c2ecf20Sopenharmony_ci				continue;
3898c2ecf20Sopenharmony_ci			if (!progp->pg_vers[i]->vs_hidden)
3908c2ecf20Sopenharmony_ci				return 1;
3918c2ecf20Sopenharmony_ci		}
3928c2ecf20Sopenharmony_ci	}
3938c2ecf20Sopenharmony_ci
3948c2ecf20Sopenharmony_ci	return 0;
3958c2ecf20Sopenharmony_ci}
3968c2ecf20Sopenharmony_ci
3978c2ecf20Sopenharmony_ciint svc_bind(struct svc_serv *serv, struct net *net)
3988c2ecf20Sopenharmony_ci{
3998c2ecf20Sopenharmony_ci	if (!svc_uses_rpcbind(serv))
4008c2ecf20Sopenharmony_ci		return 0;
4018c2ecf20Sopenharmony_ci	return svc_rpcb_setup(serv, net);
4028c2ecf20Sopenharmony_ci}
4038c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_bind);
4048c2ecf20Sopenharmony_ci
4058c2ecf20Sopenharmony_ci#if defined(CONFIG_SUNRPC_BACKCHANNEL)
4068c2ecf20Sopenharmony_cistatic void
4078c2ecf20Sopenharmony_ci__svc_init_bc(struct svc_serv *serv)
4088c2ecf20Sopenharmony_ci{
4098c2ecf20Sopenharmony_ci	INIT_LIST_HEAD(&serv->sv_cb_list);
4108c2ecf20Sopenharmony_ci	spin_lock_init(&serv->sv_cb_lock);
4118c2ecf20Sopenharmony_ci	init_waitqueue_head(&serv->sv_cb_waitq);
4128c2ecf20Sopenharmony_ci}
4138c2ecf20Sopenharmony_ci#else
4148c2ecf20Sopenharmony_cistatic void
4158c2ecf20Sopenharmony_ci__svc_init_bc(struct svc_serv *serv)
4168c2ecf20Sopenharmony_ci{
4178c2ecf20Sopenharmony_ci}
4188c2ecf20Sopenharmony_ci#endif
4198c2ecf20Sopenharmony_ci
4208c2ecf20Sopenharmony_ci/*
4218c2ecf20Sopenharmony_ci * Create an RPC service
4228c2ecf20Sopenharmony_ci */
4238c2ecf20Sopenharmony_cistatic struct svc_serv *
4248c2ecf20Sopenharmony_ci__svc_create(struct svc_program *prog, unsigned int bufsize, int npools,
4258c2ecf20Sopenharmony_ci	     const struct svc_serv_ops *ops)
4268c2ecf20Sopenharmony_ci{
4278c2ecf20Sopenharmony_ci	struct svc_serv	*serv;
4288c2ecf20Sopenharmony_ci	unsigned int vers;
4298c2ecf20Sopenharmony_ci	unsigned int xdrsize;
4308c2ecf20Sopenharmony_ci	unsigned int i;
4318c2ecf20Sopenharmony_ci
4328c2ecf20Sopenharmony_ci	if (!(serv = kzalloc(sizeof(*serv), GFP_KERNEL)))
4338c2ecf20Sopenharmony_ci		return NULL;
4348c2ecf20Sopenharmony_ci	serv->sv_name      = prog->pg_name;
4358c2ecf20Sopenharmony_ci	serv->sv_program   = prog;
4368c2ecf20Sopenharmony_ci	serv->sv_nrthreads = 1;
4378c2ecf20Sopenharmony_ci	serv->sv_stats     = prog->pg_stats;
4388c2ecf20Sopenharmony_ci	if (bufsize > RPCSVC_MAXPAYLOAD)
4398c2ecf20Sopenharmony_ci		bufsize = RPCSVC_MAXPAYLOAD;
4408c2ecf20Sopenharmony_ci	serv->sv_max_payload = bufsize? bufsize : 4096;
4418c2ecf20Sopenharmony_ci	serv->sv_max_mesg  = roundup(serv->sv_max_payload + PAGE_SIZE, PAGE_SIZE);
4428c2ecf20Sopenharmony_ci	serv->sv_ops = ops;
4438c2ecf20Sopenharmony_ci	xdrsize = 0;
4448c2ecf20Sopenharmony_ci	while (prog) {
4458c2ecf20Sopenharmony_ci		prog->pg_lovers = prog->pg_nvers-1;
4468c2ecf20Sopenharmony_ci		for (vers=0; vers<prog->pg_nvers ; vers++)
4478c2ecf20Sopenharmony_ci			if (prog->pg_vers[vers]) {
4488c2ecf20Sopenharmony_ci				prog->pg_hivers = vers;
4498c2ecf20Sopenharmony_ci				if (prog->pg_lovers > vers)
4508c2ecf20Sopenharmony_ci					prog->pg_lovers = vers;
4518c2ecf20Sopenharmony_ci				if (prog->pg_vers[vers]->vs_xdrsize > xdrsize)
4528c2ecf20Sopenharmony_ci					xdrsize = prog->pg_vers[vers]->vs_xdrsize;
4538c2ecf20Sopenharmony_ci			}
4548c2ecf20Sopenharmony_ci		prog = prog->pg_next;
4558c2ecf20Sopenharmony_ci	}
4568c2ecf20Sopenharmony_ci	serv->sv_xdrsize   = xdrsize;
4578c2ecf20Sopenharmony_ci	INIT_LIST_HEAD(&serv->sv_tempsocks);
4588c2ecf20Sopenharmony_ci	INIT_LIST_HEAD(&serv->sv_permsocks);
4598c2ecf20Sopenharmony_ci	timer_setup(&serv->sv_temptimer, NULL, 0);
4608c2ecf20Sopenharmony_ci	spin_lock_init(&serv->sv_lock);
4618c2ecf20Sopenharmony_ci
4628c2ecf20Sopenharmony_ci	__svc_init_bc(serv);
4638c2ecf20Sopenharmony_ci
4648c2ecf20Sopenharmony_ci	serv->sv_nrpools = npools;
4658c2ecf20Sopenharmony_ci	serv->sv_pools =
4668c2ecf20Sopenharmony_ci		kcalloc(serv->sv_nrpools, sizeof(struct svc_pool),
4678c2ecf20Sopenharmony_ci			GFP_KERNEL);
4688c2ecf20Sopenharmony_ci	if (!serv->sv_pools) {
4698c2ecf20Sopenharmony_ci		kfree(serv);
4708c2ecf20Sopenharmony_ci		return NULL;
4718c2ecf20Sopenharmony_ci	}
4728c2ecf20Sopenharmony_ci
4738c2ecf20Sopenharmony_ci	for (i = 0; i < serv->sv_nrpools; i++) {
4748c2ecf20Sopenharmony_ci		struct svc_pool *pool = &serv->sv_pools[i];
4758c2ecf20Sopenharmony_ci
4768c2ecf20Sopenharmony_ci		dprintk("svc: initialising pool %u for %s\n",
4778c2ecf20Sopenharmony_ci				i, serv->sv_name);
4788c2ecf20Sopenharmony_ci
4798c2ecf20Sopenharmony_ci		pool->sp_id = i;
4808c2ecf20Sopenharmony_ci		INIT_LIST_HEAD(&pool->sp_sockets);
4818c2ecf20Sopenharmony_ci		INIT_LIST_HEAD(&pool->sp_all_threads);
4828c2ecf20Sopenharmony_ci		spin_lock_init(&pool->sp_lock);
4838c2ecf20Sopenharmony_ci	}
4848c2ecf20Sopenharmony_ci
4858c2ecf20Sopenharmony_ci	return serv;
4868c2ecf20Sopenharmony_ci}
4878c2ecf20Sopenharmony_ci
4888c2ecf20Sopenharmony_cistruct svc_serv *
4898c2ecf20Sopenharmony_cisvc_create(struct svc_program *prog, unsigned int bufsize,
4908c2ecf20Sopenharmony_ci	   const struct svc_serv_ops *ops)
4918c2ecf20Sopenharmony_ci{
4928c2ecf20Sopenharmony_ci	return __svc_create(prog, bufsize, /*npools*/1, ops);
4938c2ecf20Sopenharmony_ci}
4948c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_create);
4958c2ecf20Sopenharmony_ci
4968c2ecf20Sopenharmony_cistruct svc_serv *
4978c2ecf20Sopenharmony_cisvc_create_pooled(struct svc_program *prog, unsigned int bufsize,
4988c2ecf20Sopenharmony_ci		  const struct svc_serv_ops *ops)
4998c2ecf20Sopenharmony_ci{
5008c2ecf20Sopenharmony_ci	struct svc_serv *serv;
5018c2ecf20Sopenharmony_ci	unsigned int npools = svc_pool_map_get();
5028c2ecf20Sopenharmony_ci
5038c2ecf20Sopenharmony_ci	serv = __svc_create(prog, bufsize, npools, ops);
5048c2ecf20Sopenharmony_ci	if (!serv)
5058c2ecf20Sopenharmony_ci		goto out_err;
5068c2ecf20Sopenharmony_ci	return serv;
5078c2ecf20Sopenharmony_ciout_err:
5088c2ecf20Sopenharmony_ci	svc_pool_map_put();
5098c2ecf20Sopenharmony_ci	return NULL;
5108c2ecf20Sopenharmony_ci}
5118c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_create_pooled);
5128c2ecf20Sopenharmony_ci
5138c2ecf20Sopenharmony_civoid svc_shutdown_net(struct svc_serv *serv, struct net *net)
5148c2ecf20Sopenharmony_ci{
5158c2ecf20Sopenharmony_ci	svc_close_net(serv, net);
5168c2ecf20Sopenharmony_ci
5178c2ecf20Sopenharmony_ci	if (serv->sv_ops->svo_shutdown)
5188c2ecf20Sopenharmony_ci		serv->sv_ops->svo_shutdown(serv, net);
5198c2ecf20Sopenharmony_ci}
5208c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_shutdown_net);
5218c2ecf20Sopenharmony_ci
5228c2ecf20Sopenharmony_ci/*
5238c2ecf20Sopenharmony_ci * Destroy an RPC service. Should be called with appropriate locking to
5248c2ecf20Sopenharmony_ci * protect the sv_nrthreads, sv_permsocks and sv_tempsocks.
5258c2ecf20Sopenharmony_ci */
5268c2ecf20Sopenharmony_civoid
5278c2ecf20Sopenharmony_cisvc_destroy(struct svc_serv *serv)
5288c2ecf20Sopenharmony_ci{
5298c2ecf20Sopenharmony_ci	dprintk("svc: svc_destroy(%s, %d)\n",
5308c2ecf20Sopenharmony_ci				serv->sv_program->pg_name,
5318c2ecf20Sopenharmony_ci				serv->sv_nrthreads);
5328c2ecf20Sopenharmony_ci
5338c2ecf20Sopenharmony_ci	if (serv->sv_nrthreads) {
5348c2ecf20Sopenharmony_ci		if (--(serv->sv_nrthreads) != 0) {
5358c2ecf20Sopenharmony_ci			svc_sock_update_bufs(serv);
5368c2ecf20Sopenharmony_ci			return;
5378c2ecf20Sopenharmony_ci		}
5388c2ecf20Sopenharmony_ci	} else
5398c2ecf20Sopenharmony_ci		printk("svc_destroy: no threads for serv=%p!\n", serv);
5408c2ecf20Sopenharmony_ci
5418c2ecf20Sopenharmony_ci	del_timer_sync(&serv->sv_temptimer);
5428c2ecf20Sopenharmony_ci
5438c2ecf20Sopenharmony_ci	/*
5448c2ecf20Sopenharmony_ci	 * The last user is gone and thus all sockets have to be destroyed to
5458c2ecf20Sopenharmony_ci	 * the point. Check this.
5468c2ecf20Sopenharmony_ci	 */
5478c2ecf20Sopenharmony_ci	BUG_ON(!list_empty(&serv->sv_permsocks));
5488c2ecf20Sopenharmony_ci	BUG_ON(!list_empty(&serv->sv_tempsocks));
5498c2ecf20Sopenharmony_ci
5508c2ecf20Sopenharmony_ci	cache_clean_deferred(serv);
5518c2ecf20Sopenharmony_ci
5528c2ecf20Sopenharmony_ci	if (svc_serv_is_pooled(serv))
5538c2ecf20Sopenharmony_ci		svc_pool_map_put();
5548c2ecf20Sopenharmony_ci
5558c2ecf20Sopenharmony_ci	kfree(serv->sv_pools);
5568c2ecf20Sopenharmony_ci	kfree(serv);
5578c2ecf20Sopenharmony_ci}
5588c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_destroy);
5598c2ecf20Sopenharmony_ci
5608c2ecf20Sopenharmony_ci/*
5618c2ecf20Sopenharmony_ci * Allocate an RPC server's buffer space.
5628c2ecf20Sopenharmony_ci * We allocate pages and place them in rq_argpages.
5638c2ecf20Sopenharmony_ci */
5648c2ecf20Sopenharmony_cistatic int
5658c2ecf20Sopenharmony_cisvc_init_buffer(struct svc_rqst *rqstp, unsigned int size, int node)
5668c2ecf20Sopenharmony_ci{
5678c2ecf20Sopenharmony_ci	unsigned int pages, arghi;
5688c2ecf20Sopenharmony_ci
5698c2ecf20Sopenharmony_ci	/* bc_xprt uses fore channel allocated buffers */
5708c2ecf20Sopenharmony_ci	if (svc_is_backchannel(rqstp))
5718c2ecf20Sopenharmony_ci		return 1;
5728c2ecf20Sopenharmony_ci
5738c2ecf20Sopenharmony_ci	pages = size / PAGE_SIZE + 1; /* extra page as we hold both request and reply.
5748c2ecf20Sopenharmony_ci				       * We assume one is at most one page
5758c2ecf20Sopenharmony_ci				       */
5768c2ecf20Sopenharmony_ci	arghi = 0;
5778c2ecf20Sopenharmony_ci	WARN_ON_ONCE(pages > RPCSVC_MAXPAGES);
5788c2ecf20Sopenharmony_ci	if (pages > RPCSVC_MAXPAGES)
5798c2ecf20Sopenharmony_ci		pages = RPCSVC_MAXPAGES;
5808c2ecf20Sopenharmony_ci	while (pages) {
5818c2ecf20Sopenharmony_ci		struct page *p = alloc_pages_node(node, GFP_KERNEL, 0);
5828c2ecf20Sopenharmony_ci		if (!p)
5838c2ecf20Sopenharmony_ci			break;
5848c2ecf20Sopenharmony_ci		rqstp->rq_pages[arghi++] = p;
5858c2ecf20Sopenharmony_ci		pages--;
5868c2ecf20Sopenharmony_ci	}
5878c2ecf20Sopenharmony_ci	return pages == 0;
5888c2ecf20Sopenharmony_ci}
5898c2ecf20Sopenharmony_ci
5908c2ecf20Sopenharmony_ci/*
5918c2ecf20Sopenharmony_ci * Release an RPC server buffer
5928c2ecf20Sopenharmony_ci */
5938c2ecf20Sopenharmony_cistatic void
5948c2ecf20Sopenharmony_cisvc_release_buffer(struct svc_rqst *rqstp)
5958c2ecf20Sopenharmony_ci{
5968c2ecf20Sopenharmony_ci	unsigned int i;
5978c2ecf20Sopenharmony_ci
5988c2ecf20Sopenharmony_ci	for (i = 0; i < ARRAY_SIZE(rqstp->rq_pages); i++)
5998c2ecf20Sopenharmony_ci		if (rqstp->rq_pages[i])
6008c2ecf20Sopenharmony_ci			put_page(rqstp->rq_pages[i]);
6018c2ecf20Sopenharmony_ci}
6028c2ecf20Sopenharmony_ci
6038c2ecf20Sopenharmony_cistruct svc_rqst *
6048c2ecf20Sopenharmony_cisvc_rqst_alloc(struct svc_serv *serv, struct svc_pool *pool, int node)
6058c2ecf20Sopenharmony_ci{
6068c2ecf20Sopenharmony_ci	struct svc_rqst	*rqstp;
6078c2ecf20Sopenharmony_ci
6088c2ecf20Sopenharmony_ci	rqstp = kzalloc_node(sizeof(*rqstp), GFP_KERNEL, node);
6098c2ecf20Sopenharmony_ci	if (!rqstp)
6108c2ecf20Sopenharmony_ci		return rqstp;
6118c2ecf20Sopenharmony_ci
6128c2ecf20Sopenharmony_ci	__set_bit(RQ_BUSY, &rqstp->rq_flags);
6138c2ecf20Sopenharmony_ci	spin_lock_init(&rqstp->rq_lock);
6148c2ecf20Sopenharmony_ci	rqstp->rq_server = serv;
6158c2ecf20Sopenharmony_ci	rqstp->rq_pool = pool;
6168c2ecf20Sopenharmony_ci
6178c2ecf20Sopenharmony_ci	rqstp->rq_argp = kmalloc_node(serv->sv_xdrsize, GFP_KERNEL, node);
6188c2ecf20Sopenharmony_ci	if (!rqstp->rq_argp)
6198c2ecf20Sopenharmony_ci		goto out_enomem;
6208c2ecf20Sopenharmony_ci
6218c2ecf20Sopenharmony_ci	rqstp->rq_resp = kmalloc_node(serv->sv_xdrsize, GFP_KERNEL, node);
6228c2ecf20Sopenharmony_ci	if (!rqstp->rq_resp)
6238c2ecf20Sopenharmony_ci		goto out_enomem;
6248c2ecf20Sopenharmony_ci
6258c2ecf20Sopenharmony_ci	if (!svc_init_buffer(rqstp, serv->sv_max_mesg, node))
6268c2ecf20Sopenharmony_ci		goto out_enomem;
6278c2ecf20Sopenharmony_ci
6288c2ecf20Sopenharmony_ci	return rqstp;
6298c2ecf20Sopenharmony_ciout_enomem:
6308c2ecf20Sopenharmony_ci	svc_rqst_free(rqstp);
6318c2ecf20Sopenharmony_ci	return NULL;
6328c2ecf20Sopenharmony_ci}
6338c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_rqst_alloc);
6348c2ecf20Sopenharmony_ci
6358c2ecf20Sopenharmony_cistruct svc_rqst *
6368c2ecf20Sopenharmony_cisvc_prepare_thread(struct svc_serv *serv, struct svc_pool *pool, int node)
6378c2ecf20Sopenharmony_ci{
6388c2ecf20Sopenharmony_ci	struct svc_rqst	*rqstp;
6398c2ecf20Sopenharmony_ci
6408c2ecf20Sopenharmony_ci	rqstp = svc_rqst_alloc(serv, pool, node);
6418c2ecf20Sopenharmony_ci	if (!rqstp)
6428c2ecf20Sopenharmony_ci		return ERR_PTR(-ENOMEM);
6438c2ecf20Sopenharmony_ci
6448c2ecf20Sopenharmony_ci	serv->sv_nrthreads++;
6458c2ecf20Sopenharmony_ci	spin_lock_bh(&pool->sp_lock);
6468c2ecf20Sopenharmony_ci	pool->sp_nrthreads++;
6478c2ecf20Sopenharmony_ci	list_add_rcu(&rqstp->rq_all, &pool->sp_all_threads);
6488c2ecf20Sopenharmony_ci	spin_unlock_bh(&pool->sp_lock);
6498c2ecf20Sopenharmony_ci	return rqstp;
6508c2ecf20Sopenharmony_ci}
6518c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_prepare_thread);
6528c2ecf20Sopenharmony_ci
6538c2ecf20Sopenharmony_ci/*
6548c2ecf20Sopenharmony_ci * Choose a pool in which to create a new thread, for svc_set_num_threads
6558c2ecf20Sopenharmony_ci */
6568c2ecf20Sopenharmony_cistatic inline struct svc_pool *
6578c2ecf20Sopenharmony_cichoose_pool(struct svc_serv *serv, struct svc_pool *pool, unsigned int *state)
6588c2ecf20Sopenharmony_ci{
6598c2ecf20Sopenharmony_ci	if (pool != NULL)
6608c2ecf20Sopenharmony_ci		return pool;
6618c2ecf20Sopenharmony_ci
6628c2ecf20Sopenharmony_ci	return &serv->sv_pools[(*state)++ % serv->sv_nrpools];
6638c2ecf20Sopenharmony_ci}
6648c2ecf20Sopenharmony_ci
6658c2ecf20Sopenharmony_ci/*
6668c2ecf20Sopenharmony_ci * Choose a thread to kill, for svc_set_num_threads
6678c2ecf20Sopenharmony_ci */
6688c2ecf20Sopenharmony_cistatic inline struct task_struct *
6698c2ecf20Sopenharmony_cichoose_victim(struct svc_serv *serv, struct svc_pool *pool, unsigned int *state)
6708c2ecf20Sopenharmony_ci{
6718c2ecf20Sopenharmony_ci	unsigned int i;
6728c2ecf20Sopenharmony_ci	struct task_struct *task = NULL;
6738c2ecf20Sopenharmony_ci
6748c2ecf20Sopenharmony_ci	if (pool != NULL) {
6758c2ecf20Sopenharmony_ci		spin_lock_bh(&pool->sp_lock);
6768c2ecf20Sopenharmony_ci	} else {
6778c2ecf20Sopenharmony_ci		/* choose a pool in round-robin fashion */
6788c2ecf20Sopenharmony_ci		for (i = 0; i < serv->sv_nrpools; i++) {
6798c2ecf20Sopenharmony_ci			pool = &serv->sv_pools[--(*state) % serv->sv_nrpools];
6808c2ecf20Sopenharmony_ci			spin_lock_bh(&pool->sp_lock);
6818c2ecf20Sopenharmony_ci			if (!list_empty(&pool->sp_all_threads))
6828c2ecf20Sopenharmony_ci				goto found_pool;
6838c2ecf20Sopenharmony_ci			spin_unlock_bh(&pool->sp_lock);
6848c2ecf20Sopenharmony_ci		}
6858c2ecf20Sopenharmony_ci		return NULL;
6868c2ecf20Sopenharmony_ci	}
6878c2ecf20Sopenharmony_ci
6888c2ecf20Sopenharmony_cifound_pool:
6898c2ecf20Sopenharmony_ci	if (!list_empty(&pool->sp_all_threads)) {
6908c2ecf20Sopenharmony_ci		struct svc_rqst *rqstp;
6918c2ecf20Sopenharmony_ci
6928c2ecf20Sopenharmony_ci		/*
6938c2ecf20Sopenharmony_ci		 * Remove from the pool->sp_all_threads list
6948c2ecf20Sopenharmony_ci		 * so we don't try to kill it again.
6958c2ecf20Sopenharmony_ci		 */
6968c2ecf20Sopenharmony_ci		rqstp = list_entry(pool->sp_all_threads.next, struct svc_rqst, rq_all);
6978c2ecf20Sopenharmony_ci		set_bit(RQ_VICTIM, &rqstp->rq_flags);
6988c2ecf20Sopenharmony_ci		list_del_rcu(&rqstp->rq_all);
6998c2ecf20Sopenharmony_ci		task = rqstp->rq_task;
7008c2ecf20Sopenharmony_ci	}
7018c2ecf20Sopenharmony_ci	spin_unlock_bh(&pool->sp_lock);
7028c2ecf20Sopenharmony_ci
7038c2ecf20Sopenharmony_ci	return task;
7048c2ecf20Sopenharmony_ci}
7058c2ecf20Sopenharmony_ci
7068c2ecf20Sopenharmony_ci/* create new threads */
7078c2ecf20Sopenharmony_cistatic int
7088c2ecf20Sopenharmony_cisvc_start_kthreads(struct svc_serv *serv, struct svc_pool *pool, int nrservs)
7098c2ecf20Sopenharmony_ci{
7108c2ecf20Sopenharmony_ci	struct svc_rqst	*rqstp;
7118c2ecf20Sopenharmony_ci	struct task_struct *task;
7128c2ecf20Sopenharmony_ci	struct svc_pool *chosen_pool;
7138c2ecf20Sopenharmony_ci	unsigned int state = serv->sv_nrthreads-1;
7148c2ecf20Sopenharmony_ci	int node;
7158c2ecf20Sopenharmony_ci
7168c2ecf20Sopenharmony_ci	do {
7178c2ecf20Sopenharmony_ci		nrservs--;
7188c2ecf20Sopenharmony_ci		chosen_pool = choose_pool(serv, pool, &state);
7198c2ecf20Sopenharmony_ci
7208c2ecf20Sopenharmony_ci		node = svc_pool_map_get_node(chosen_pool->sp_id);
7218c2ecf20Sopenharmony_ci		rqstp = svc_prepare_thread(serv, chosen_pool, node);
7228c2ecf20Sopenharmony_ci		if (IS_ERR(rqstp))
7238c2ecf20Sopenharmony_ci			return PTR_ERR(rqstp);
7248c2ecf20Sopenharmony_ci
7258c2ecf20Sopenharmony_ci		__module_get(serv->sv_ops->svo_module);
7268c2ecf20Sopenharmony_ci		task = kthread_create_on_node(serv->sv_ops->svo_function, rqstp,
7278c2ecf20Sopenharmony_ci					      node, "%s", serv->sv_name);
7288c2ecf20Sopenharmony_ci		if (IS_ERR(task)) {
7298c2ecf20Sopenharmony_ci			module_put(serv->sv_ops->svo_module);
7308c2ecf20Sopenharmony_ci			svc_exit_thread(rqstp);
7318c2ecf20Sopenharmony_ci			return PTR_ERR(task);
7328c2ecf20Sopenharmony_ci		}
7338c2ecf20Sopenharmony_ci
7348c2ecf20Sopenharmony_ci		rqstp->rq_task = task;
7358c2ecf20Sopenharmony_ci		if (serv->sv_nrpools > 1)
7368c2ecf20Sopenharmony_ci			svc_pool_map_set_cpumask(task, chosen_pool->sp_id);
7378c2ecf20Sopenharmony_ci
7388c2ecf20Sopenharmony_ci		svc_sock_update_bufs(serv);
7398c2ecf20Sopenharmony_ci		wake_up_process(task);
7408c2ecf20Sopenharmony_ci	} while (nrservs > 0);
7418c2ecf20Sopenharmony_ci
7428c2ecf20Sopenharmony_ci	return 0;
7438c2ecf20Sopenharmony_ci}
7448c2ecf20Sopenharmony_ci
7458c2ecf20Sopenharmony_ci
7468c2ecf20Sopenharmony_ci/* destroy old threads */
7478c2ecf20Sopenharmony_cistatic int
7488c2ecf20Sopenharmony_cisvc_signal_kthreads(struct svc_serv *serv, struct svc_pool *pool, int nrservs)
7498c2ecf20Sopenharmony_ci{
7508c2ecf20Sopenharmony_ci	struct task_struct *task;
7518c2ecf20Sopenharmony_ci	unsigned int state = serv->sv_nrthreads-1;
7528c2ecf20Sopenharmony_ci
7538c2ecf20Sopenharmony_ci	/* destroy old threads */
7548c2ecf20Sopenharmony_ci	do {
7558c2ecf20Sopenharmony_ci		task = choose_victim(serv, pool, &state);
7568c2ecf20Sopenharmony_ci		if (task == NULL)
7578c2ecf20Sopenharmony_ci			break;
7588c2ecf20Sopenharmony_ci		send_sig(SIGINT, task, 1);
7598c2ecf20Sopenharmony_ci		nrservs++;
7608c2ecf20Sopenharmony_ci	} while (nrservs < 0);
7618c2ecf20Sopenharmony_ci
7628c2ecf20Sopenharmony_ci	return 0;
7638c2ecf20Sopenharmony_ci}
7648c2ecf20Sopenharmony_ci
7658c2ecf20Sopenharmony_ci/*
7668c2ecf20Sopenharmony_ci * Create or destroy enough new threads to make the number
7678c2ecf20Sopenharmony_ci * of threads the given number.  If `pool' is non-NULL, applies
7688c2ecf20Sopenharmony_ci * only to threads in that pool, otherwise round-robins between
7698c2ecf20Sopenharmony_ci * all pools.  Caller must ensure that mutual exclusion between this and
7708c2ecf20Sopenharmony_ci * server startup or shutdown.
7718c2ecf20Sopenharmony_ci *
7728c2ecf20Sopenharmony_ci * Destroying threads relies on the service threads filling in
7738c2ecf20Sopenharmony_ci * rqstp->rq_task, which only the nfs ones do.  Assumes the serv
7748c2ecf20Sopenharmony_ci * has been created using svc_create_pooled().
7758c2ecf20Sopenharmony_ci *
7768c2ecf20Sopenharmony_ci * Based on code that used to be in nfsd_svc() but tweaked
7778c2ecf20Sopenharmony_ci * to be pool-aware.
7788c2ecf20Sopenharmony_ci */
7798c2ecf20Sopenharmony_ciint
7808c2ecf20Sopenharmony_cisvc_set_num_threads(struct svc_serv *serv, struct svc_pool *pool, int nrservs)
7818c2ecf20Sopenharmony_ci{
7828c2ecf20Sopenharmony_ci	if (pool == NULL) {
7838c2ecf20Sopenharmony_ci		/* The -1 assumes caller has done a svc_get() */
7848c2ecf20Sopenharmony_ci		nrservs -= (serv->sv_nrthreads-1);
7858c2ecf20Sopenharmony_ci	} else {
7868c2ecf20Sopenharmony_ci		spin_lock_bh(&pool->sp_lock);
7878c2ecf20Sopenharmony_ci		nrservs -= pool->sp_nrthreads;
7888c2ecf20Sopenharmony_ci		spin_unlock_bh(&pool->sp_lock);
7898c2ecf20Sopenharmony_ci	}
7908c2ecf20Sopenharmony_ci
7918c2ecf20Sopenharmony_ci	if (nrservs > 0)
7928c2ecf20Sopenharmony_ci		return svc_start_kthreads(serv, pool, nrservs);
7938c2ecf20Sopenharmony_ci	if (nrservs < 0)
7948c2ecf20Sopenharmony_ci		return svc_signal_kthreads(serv, pool, nrservs);
7958c2ecf20Sopenharmony_ci	return 0;
7968c2ecf20Sopenharmony_ci}
7978c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_set_num_threads);
7988c2ecf20Sopenharmony_ci
7998c2ecf20Sopenharmony_ci/* destroy old threads */
8008c2ecf20Sopenharmony_cistatic int
8018c2ecf20Sopenharmony_cisvc_stop_kthreads(struct svc_serv *serv, struct svc_pool *pool, int nrservs)
8028c2ecf20Sopenharmony_ci{
8038c2ecf20Sopenharmony_ci	struct svc_rqst	*rqstp;
8048c2ecf20Sopenharmony_ci	struct task_struct *task;
8058c2ecf20Sopenharmony_ci	unsigned int state = serv->sv_nrthreads-1;
8068c2ecf20Sopenharmony_ci
8078c2ecf20Sopenharmony_ci	/* destroy old threads */
8088c2ecf20Sopenharmony_ci	do {
8098c2ecf20Sopenharmony_ci		task = choose_victim(serv, pool, &state);
8108c2ecf20Sopenharmony_ci		if (task == NULL)
8118c2ecf20Sopenharmony_ci			break;
8128c2ecf20Sopenharmony_ci		rqstp = kthread_data(task);
8138c2ecf20Sopenharmony_ci		/* Did we lose a race to svo_function threadfn? */
8148c2ecf20Sopenharmony_ci		if (kthread_stop(task) == -EINTR)
8158c2ecf20Sopenharmony_ci			svc_exit_thread(rqstp);
8168c2ecf20Sopenharmony_ci		nrservs++;
8178c2ecf20Sopenharmony_ci	} while (nrservs < 0);
8188c2ecf20Sopenharmony_ci	return 0;
8198c2ecf20Sopenharmony_ci}
8208c2ecf20Sopenharmony_ci
8218c2ecf20Sopenharmony_ciint
8228c2ecf20Sopenharmony_cisvc_set_num_threads_sync(struct svc_serv *serv, struct svc_pool *pool, int nrservs)
8238c2ecf20Sopenharmony_ci{
8248c2ecf20Sopenharmony_ci	if (pool == NULL) {
8258c2ecf20Sopenharmony_ci		/* The -1 assumes caller has done a svc_get() */
8268c2ecf20Sopenharmony_ci		nrservs -= (serv->sv_nrthreads-1);
8278c2ecf20Sopenharmony_ci	} else {
8288c2ecf20Sopenharmony_ci		spin_lock_bh(&pool->sp_lock);
8298c2ecf20Sopenharmony_ci		nrservs -= pool->sp_nrthreads;
8308c2ecf20Sopenharmony_ci		spin_unlock_bh(&pool->sp_lock);
8318c2ecf20Sopenharmony_ci	}
8328c2ecf20Sopenharmony_ci
8338c2ecf20Sopenharmony_ci	if (nrservs > 0)
8348c2ecf20Sopenharmony_ci		return svc_start_kthreads(serv, pool, nrservs);
8358c2ecf20Sopenharmony_ci	if (nrservs < 0)
8368c2ecf20Sopenharmony_ci		return svc_stop_kthreads(serv, pool, nrservs);
8378c2ecf20Sopenharmony_ci	return 0;
8388c2ecf20Sopenharmony_ci}
8398c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_set_num_threads_sync);
8408c2ecf20Sopenharmony_ci
8418c2ecf20Sopenharmony_ci/*
8428c2ecf20Sopenharmony_ci * Called from a server thread as it's exiting. Caller must hold the "service
8438c2ecf20Sopenharmony_ci * mutex" for the service.
8448c2ecf20Sopenharmony_ci */
8458c2ecf20Sopenharmony_civoid
8468c2ecf20Sopenharmony_cisvc_rqst_free(struct svc_rqst *rqstp)
8478c2ecf20Sopenharmony_ci{
8488c2ecf20Sopenharmony_ci	svc_release_buffer(rqstp);
8498c2ecf20Sopenharmony_ci	kfree(rqstp->rq_resp);
8508c2ecf20Sopenharmony_ci	kfree(rqstp->rq_argp);
8518c2ecf20Sopenharmony_ci	kfree(rqstp->rq_auth_data);
8528c2ecf20Sopenharmony_ci	kfree_rcu(rqstp, rq_rcu_head);
8538c2ecf20Sopenharmony_ci}
8548c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_rqst_free);
8558c2ecf20Sopenharmony_ci
8568c2ecf20Sopenharmony_civoid
8578c2ecf20Sopenharmony_cisvc_exit_thread(struct svc_rqst *rqstp)
8588c2ecf20Sopenharmony_ci{
8598c2ecf20Sopenharmony_ci	struct svc_serv	*serv = rqstp->rq_server;
8608c2ecf20Sopenharmony_ci	struct svc_pool	*pool = rqstp->rq_pool;
8618c2ecf20Sopenharmony_ci
8628c2ecf20Sopenharmony_ci	spin_lock_bh(&pool->sp_lock);
8638c2ecf20Sopenharmony_ci	pool->sp_nrthreads--;
8648c2ecf20Sopenharmony_ci	if (!test_and_set_bit(RQ_VICTIM, &rqstp->rq_flags))
8658c2ecf20Sopenharmony_ci		list_del_rcu(&rqstp->rq_all);
8668c2ecf20Sopenharmony_ci	spin_unlock_bh(&pool->sp_lock);
8678c2ecf20Sopenharmony_ci
8688c2ecf20Sopenharmony_ci	svc_rqst_free(rqstp);
8698c2ecf20Sopenharmony_ci
8708c2ecf20Sopenharmony_ci	/* Release the server */
8718c2ecf20Sopenharmony_ci	if (serv)
8728c2ecf20Sopenharmony_ci		svc_destroy(serv);
8738c2ecf20Sopenharmony_ci}
8748c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_exit_thread);
8758c2ecf20Sopenharmony_ci
8768c2ecf20Sopenharmony_ci/*
8778c2ecf20Sopenharmony_ci * Register an "inet" protocol family netid with the local
8788c2ecf20Sopenharmony_ci * rpcbind daemon via an rpcbind v4 SET request.
8798c2ecf20Sopenharmony_ci *
8808c2ecf20Sopenharmony_ci * No netconfig infrastructure is available in the kernel, so
8818c2ecf20Sopenharmony_ci * we map IP_ protocol numbers to netids by hand.
8828c2ecf20Sopenharmony_ci *
8838c2ecf20Sopenharmony_ci * Returns zero on success; a negative errno value is returned
8848c2ecf20Sopenharmony_ci * if any error occurs.
8858c2ecf20Sopenharmony_ci */
8868c2ecf20Sopenharmony_cistatic int __svc_rpcb_register4(struct net *net, const u32 program,
8878c2ecf20Sopenharmony_ci				const u32 version,
8888c2ecf20Sopenharmony_ci				const unsigned short protocol,
8898c2ecf20Sopenharmony_ci				const unsigned short port)
8908c2ecf20Sopenharmony_ci{
8918c2ecf20Sopenharmony_ci	const struct sockaddr_in sin = {
8928c2ecf20Sopenharmony_ci		.sin_family		= AF_INET,
8938c2ecf20Sopenharmony_ci		.sin_addr.s_addr	= htonl(INADDR_ANY),
8948c2ecf20Sopenharmony_ci		.sin_port		= htons(port),
8958c2ecf20Sopenharmony_ci	};
8968c2ecf20Sopenharmony_ci	const char *netid;
8978c2ecf20Sopenharmony_ci	int error;
8988c2ecf20Sopenharmony_ci
8998c2ecf20Sopenharmony_ci	switch (protocol) {
9008c2ecf20Sopenharmony_ci	case IPPROTO_UDP:
9018c2ecf20Sopenharmony_ci		netid = RPCBIND_NETID_UDP;
9028c2ecf20Sopenharmony_ci		break;
9038c2ecf20Sopenharmony_ci	case IPPROTO_TCP:
9048c2ecf20Sopenharmony_ci		netid = RPCBIND_NETID_TCP;
9058c2ecf20Sopenharmony_ci		break;
9068c2ecf20Sopenharmony_ci	default:
9078c2ecf20Sopenharmony_ci		return -ENOPROTOOPT;
9088c2ecf20Sopenharmony_ci	}
9098c2ecf20Sopenharmony_ci
9108c2ecf20Sopenharmony_ci	error = rpcb_v4_register(net, program, version,
9118c2ecf20Sopenharmony_ci					(const struct sockaddr *)&sin, netid);
9128c2ecf20Sopenharmony_ci
9138c2ecf20Sopenharmony_ci	/*
9148c2ecf20Sopenharmony_ci	 * User space didn't support rpcbind v4, so retry this
9158c2ecf20Sopenharmony_ci	 * registration request with the legacy rpcbind v2 protocol.
9168c2ecf20Sopenharmony_ci	 */
9178c2ecf20Sopenharmony_ci	if (error == -EPROTONOSUPPORT)
9188c2ecf20Sopenharmony_ci		error = rpcb_register(net, program, version, protocol, port);
9198c2ecf20Sopenharmony_ci
9208c2ecf20Sopenharmony_ci	return error;
9218c2ecf20Sopenharmony_ci}
9228c2ecf20Sopenharmony_ci
9238c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6)
9248c2ecf20Sopenharmony_ci/*
9258c2ecf20Sopenharmony_ci * Register an "inet6" protocol family netid with the local
9268c2ecf20Sopenharmony_ci * rpcbind daemon via an rpcbind v4 SET request.
9278c2ecf20Sopenharmony_ci *
9288c2ecf20Sopenharmony_ci * No netconfig infrastructure is available in the kernel, so
9298c2ecf20Sopenharmony_ci * we map IP_ protocol numbers to netids by hand.
9308c2ecf20Sopenharmony_ci *
9318c2ecf20Sopenharmony_ci * Returns zero on success; a negative errno value is returned
9328c2ecf20Sopenharmony_ci * if any error occurs.
9338c2ecf20Sopenharmony_ci */
9348c2ecf20Sopenharmony_cistatic int __svc_rpcb_register6(struct net *net, const u32 program,
9358c2ecf20Sopenharmony_ci				const u32 version,
9368c2ecf20Sopenharmony_ci				const unsigned short protocol,
9378c2ecf20Sopenharmony_ci				const unsigned short port)
9388c2ecf20Sopenharmony_ci{
9398c2ecf20Sopenharmony_ci	const struct sockaddr_in6 sin6 = {
9408c2ecf20Sopenharmony_ci		.sin6_family		= AF_INET6,
9418c2ecf20Sopenharmony_ci		.sin6_addr		= IN6ADDR_ANY_INIT,
9428c2ecf20Sopenharmony_ci		.sin6_port		= htons(port),
9438c2ecf20Sopenharmony_ci	};
9448c2ecf20Sopenharmony_ci	const char *netid;
9458c2ecf20Sopenharmony_ci	int error;
9468c2ecf20Sopenharmony_ci
9478c2ecf20Sopenharmony_ci	switch (protocol) {
9488c2ecf20Sopenharmony_ci	case IPPROTO_UDP:
9498c2ecf20Sopenharmony_ci		netid = RPCBIND_NETID_UDP6;
9508c2ecf20Sopenharmony_ci		break;
9518c2ecf20Sopenharmony_ci	case IPPROTO_TCP:
9528c2ecf20Sopenharmony_ci		netid = RPCBIND_NETID_TCP6;
9538c2ecf20Sopenharmony_ci		break;
9548c2ecf20Sopenharmony_ci	default:
9558c2ecf20Sopenharmony_ci		return -ENOPROTOOPT;
9568c2ecf20Sopenharmony_ci	}
9578c2ecf20Sopenharmony_ci
9588c2ecf20Sopenharmony_ci	error = rpcb_v4_register(net, program, version,
9598c2ecf20Sopenharmony_ci					(const struct sockaddr *)&sin6, netid);
9608c2ecf20Sopenharmony_ci
9618c2ecf20Sopenharmony_ci	/*
9628c2ecf20Sopenharmony_ci	 * User space didn't support rpcbind version 4, so we won't
9638c2ecf20Sopenharmony_ci	 * use a PF_INET6 listener.
9648c2ecf20Sopenharmony_ci	 */
9658c2ecf20Sopenharmony_ci	if (error == -EPROTONOSUPPORT)
9668c2ecf20Sopenharmony_ci		error = -EAFNOSUPPORT;
9678c2ecf20Sopenharmony_ci
9688c2ecf20Sopenharmony_ci	return error;
9698c2ecf20Sopenharmony_ci}
9708c2ecf20Sopenharmony_ci#endif	/* IS_ENABLED(CONFIG_IPV6) */
9718c2ecf20Sopenharmony_ci
9728c2ecf20Sopenharmony_ci/*
9738c2ecf20Sopenharmony_ci * Register a kernel RPC service via rpcbind version 4.
9748c2ecf20Sopenharmony_ci *
9758c2ecf20Sopenharmony_ci * Returns zero on success; a negative errno value is returned
9768c2ecf20Sopenharmony_ci * if any error occurs.
9778c2ecf20Sopenharmony_ci */
9788c2ecf20Sopenharmony_cistatic int __svc_register(struct net *net, const char *progname,
9798c2ecf20Sopenharmony_ci			  const u32 program, const u32 version,
9808c2ecf20Sopenharmony_ci			  const int family,
9818c2ecf20Sopenharmony_ci			  const unsigned short protocol,
9828c2ecf20Sopenharmony_ci			  const unsigned short port)
9838c2ecf20Sopenharmony_ci{
9848c2ecf20Sopenharmony_ci	int error = -EAFNOSUPPORT;
9858c2ecf20Sopenharmony_ci
9868c2ecf20Sopenharmony_ci	switch (family) {
9878c2ecf20Sopenharmony_ci	case PF_INET:
9888c2ecf20Sopenharmony_ci		error = __svc_rpcb_register4(net, program, version,
9898c2ecf20Sopenharmony_ci						protocol, port);
9908c2ecf20Sopenharmony_ci		break;
9918c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_IPV6)
9928c2ecf20Sopenharmony_ci	case PF_INET6:
9938c2ecf20Sopenharmony_ci		error = __svc_rpcb_register6(net, program, version,
9948c2ecf20Sopenharmony_ci						protocol, port);
9958c2ecf20Sopenharmony_ci#endif
9968c2ecf20Sopenharmony_ci	}
9978c2ecf20Sopenharmony_ci
9988c2ecf20Sopenharmony_ci	trace_svc_register(progname, version, family, protocol, port, error);
9998c2ecf20Sopenharmony_ci	return error;
10008c2ecf20Sopenharmony_ci}
10018c2ecf20Sopenharmony_ci
10028c2ecf20Sopenharmony_ciint svc_rpcbind_set_version(struct net *net,
10038c2ecf20Sopenharmony_ci			    const struct svc_program *progp,
10048c2ecf20Sopenharmony_ci			    u32 version, int family,
10058c2ecf20Sopenharmony_ci			    unsigned short proto,
10068c2ecf20Sopenharmony_ci			    unsigned short port)
10078c2ecf20Sopenharmony_ci{
10088c2ecf20Sopenharmony_ci	return __svc_register(net, progp->pg_name, progp->pg_prog,
10098c2ecf20Sopenharmony_ci				version, family, proto, port);
10108c2ecf20Sopenharmony_ci
10118c2ecf20Sopenharmony_ci}
10128c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_rpcbind_set_version);
10138c2ecf20Sopenharmony_ci
10148c2ecf20Sopenharmony_ciint svc_generic_rpcbind_set(struct net *net,
10158c2ecf20Sopenharmony_ci			    const struct svc_program *progp,
10168c2ecf20Sopenharmony_ci			    u32 version, int family,
10178c2ecf20Sopenharmony_ci			    unsigned short proto,
10188c2ecf20Sopenharmony_ci			    unsigned short port)
10198c2ecf20Sopenharmony_ci{
10208c2ecf20Sopenharmony_ci	const struct svc_version *vers = progp->pg_vers[version];
10218c2ecf20Sopenharmony_ci	int error;
10228c2ecf20Sopenharmony_ci
10238c2ecf20Sopenharmony_ci	if (vers == NULL)
10248c2ecf20Sopenharmony_ci		return 0;
10258c2ecf20Sopenharmony_ci
10268c2ecf20Sopenharmony_ci	if (vers->vs_hidden) {
10278c2ecf20Sopenharmony_ci		trace_svc_noregister(progp->pg_name, version, proto,
10288c2ecf20Sopenharmony_ci				     port, family, 0);
10298c2ecf20Sopenharmony_ci		return 0;
10308c2ecf20Sopenharmony_ci	}
10318c2ecf20Sopenharmony_ci
10328c2ecf20Sopenharmony_ci	/*
10338c2ecf20Sopenharmony_ci	 * Don't register a UDP port if we need congestion
10348c2ecf20Sopenharmony_ci	 * control.
10358c2ecf20Sopenharmony_ci	 */
10368c2ecf20Sopenharmony_ci	if (vers->vs_need_cong_ctrl && proto == IPPROTO_UDP)
10378c2ecf20Sopenharmony_ci		return 0;
10388c2ecf20Sopenharmony_ci
10398c2ecf20Sopenharmony_ci	error = svc_rpcbind_set_version(net, progp, version,
10408c2ecf20Sopenharmony_ci					family, proto, port);
10418c2ecf20Sopenharmony_ci
10428c2ecf20Sopenharmony_ci	return (vers->vs_rpcb_optnl) ? 0 : error;
10438c2ecf20Sopenharmony_ci}
10448c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_generic_rpcbind_set);
10458c2ecf20Sopenharmony_ci
10468c2ecf20Sopenharmony_ci/**
10478c2ecf20Sopenharmony_ci * svc_register - register an RPC service with the local portmapper
10488c2ecf20Sopenharmony_ci * @serv: svc_serv struct for the service to register
10498c2ecf20Sopenharmony_ci * @net: net namespace for the service to register
10508c2ecf20Sopenharmony_ci * @family: protocol family of service's listener socket
10518c2ecf20Sopenharmony_ci * @proto: transport protocol number to advertise
10528c2ecf20Sopenharmony_ci * @port: port to advertise
10538c2ecf20Sopenharmony_ci *
10548c2ecf20Sopenharmony_ci * Service is registered for any address in the passed-in protocol family
10558c2ecf20Sopenharmony_ci */
10568c2ecf20Sopenharmony_ciint svc_register(const struct svc_serv *serv, struct net *net,
10578c2ecf20Sopenharmony_ci		 const int family, const unsigned short proto,
10588c2ecf20Sopenharmony_ci		 const unsigned short port)
10598c2ecf20Sopenharmony_ci{
10608c2ecf20Sopenharmony_ci	struct svc_program	*progp;
10618c2ecf20Sopenharmony_ci	unsigned int		i;
10628c2ecf20Sopenharmony_ci	int			error = 0;
10638c2ecf20Sopenharmony_ci
10648c2ecf20Sopenharmony_ci	WARN_ON_ONCE(proto == 0 && port == 0);
10658c2ecf20Sopenharmony_ci	if (proto == 0 && port == 0)
10668c2ecf20Sopenharmony_ci		return -EINVAL;
10678c2ecf20Sopenharmony_ci
10688c2ecf20Sopenharmony_ci	for (progp = serv->sv_program; progp; progp = progp->pg_next) {
10698c2ecf20Sopenharmony_ci		for (i = 0; i < progp->pg_nvers; i++) {
10708c2ecf20Sopenharmony_ci
10718c2ecf20Sopenharmony_ci			error = progp->pg_rpcbind_set(net, progp, i,
10728c2ecf20Sopenharmony_ci					family, proto, port);
10738c2ecf20Sopenharmony_ci			if (error < 0) {
10748c2ecf20Sopenharmony_ci				printk(KERN_WARNING "svc: failed to register "
10758c2ecf20Sopenharmony_ci					"%sv%u RPC service (errno %d).\n",
10768c2ecf20Sopenharmony_ci					progp->pg_name, i, -error);
10778c2ecf20Sopenharmony_ci				break;
10788c2ecf20Sopenharmony_ci			}
10798c2ecf20Sopenharmony_ci		}
10808c2ecf20Sopenharmony_ci	}
10818c2ecf20Sopenharmony_ci
10828c2ecf20Sopenharmony_ci	return error;
10838c2ecf20Sopenharmony_ci}
10848c2ecf20Sopenharmony_ci
10858c2ecf20Sopenharmony_ci/*
10868c2ecf20Sopenharmony_ci * If user space is running rpcbind, it should take the v4 UNSET
10878c2ecf20Sopenharmony_ci * and clear everything for this [program, version].  If user space
10888c2ecf20Sopenharmony_ci * is running portmap, it will reject the v4 UNSET, but won't have
10898c2ecf20Sopenharmony_ci * any "inet6" entries anyway.  So a PMAP_UNSET should be sufficient
10908c2ecf20Sopenharmony_ci * in this case to clear all existing entries for [program, version].
10918c2ecf20Sopenharmony_ci */
10928c2ecf20Sopenharmony_cistatic void __svc_unregister(struct net *net, const u32 program, const u32 version,
10938c2ecf20Sopenharmony_ci			     const char *progname)
10948c2ecf20Sopenharmony_ci{
10958c2ecf20Sopenharmony_ci	int error;
10968c2ecf20Sopenharmony_ci
10978c2ecf20Sopenharmony_ci	error = rpcb_v4_register(net, program, version, NULL, "");
10988c2ecf20Sopenharmony_ci
10998c2ecf20Sopenharmony_ci	/*
11008c2ecf20Sopenharmony_ci	 * User space didn't support rpcbind v4, so retry this
11018c2ecf20Sopenharmony_ci	 * request with the legacy rpcbind v2 protocol.
11028c2ecf20Sopenharmony_ci	 */
11038c2ecf20Sopenharmony_ci	if (error == -EPROTONOSUPPORT)
11048c2ecf20Sopenharmony_ci		error = rpcb_register(net, program, version, 0, 0);
11058c2ecf20Sopenharmony_ci
11068c2ecf20Sopenharmony_ci	trace_svc_unregister(progname, version, error);
11078c2ecf20Sopenharmony_ci}
11088c2ecf20Sopenharmony_ci
11098c2ecf20Sopenharmony_ci/*
11108c2ecf20Sopenharmony_ci * All netids, bind addresses and ports registered for [program, version]
11118c2ecf20Sopenharmony_ci * are removed from the local rpcbind database (if the service is not
11128c2ecf20Sopenharmony_ci * hidden) to make way for a new instance of the service.
11138c2ecf20Sopenharmony_ci *
11148c2ecf20Sopenharmony_ci * The result of unregistration is reported via dprintk for those who want
11158c2ecf20Sopenharmony_ci * verification of the result, but is otherwise not important.
11168c2ecf20Sopenharmony_ci */
11178c2ecf20Sopenharmony_cistatic void svc_unregister(const struct svc_serv *serv, struct net *net)
11188c2ecf20Sopenharmony_ci{
11198c2ecf20Sopenharmony_ci	struct svc_program *progp;
11208c2ecf20Sopenharmony_ci	unsigned long flags;
11218c2ecf20Sopenharmony_ci	unsigned int i;
11228c2ecf20Sopenharmony_ci
11238c2ecf20Sopenharmony_ci	clear_thread_flag(TIF_SIGPENDING);
11248c2ecf20Sopenharmony_ci
11258c2ecf20Sopenharmony_ci	for (progp = serv->sv_program; progp; progp = progp->pg_next) {
11268c2ecf20Sopenharmony_ci		for (i = 0; i < progp->pg_nvers; i++) {
11278c2ecf20Sopenharmony_ci			if (progp->pg_vers[i] == NULL)
11288c2ecf20Sopenharmony_ci				continue;
11298c2ecf20Sopenharmony_ci			if (progp->pg_vers[i]->vs_hidden)
11308c2ecf20Sopenharmony_ci				continue;
11318c2ecf20Sopenharmony_ci			__svc_unregister(net, progp->pg_prog, i, progp->pg_name);
11328c2ecf20Sopenharmony_ci		}
11338c2ecf20Sopenharmony_ci	}
11348c2ecf20Sopenharmony_ci
11358c2ecf20Sopenharmony_ci	spin_lock_irqsave(&current->sighand->siglock, flags);
11368c2ecf20Sopenharmony_ci	recalc_sigpending();
11378c2ecf20Sopenharmony_ci	spin_unlock_irqrestore(&current->sighand->siglock, flags);
11388c2ecf20Sopenharmony_ci}
11398c2ecf20Sopenharmony_ci
11408c2ecf20Sopenharmony_ci/*
11418c2ecf20Sopenharmony_ci * dprintk the given error with the address of the client that caused it.
11428c2ecf20Sopenharmony_ci */
11438c2ecf20Sopenharmony_ci#if IS_ENABLED(CONFIG_SUNRPC_DEBUG)
11448c2ecf20Sopenharmony_cistatic __printf(2, 3)
11458c2ecf20Sopenharmony_civoid svc_printk(struct svc_rqst *rqstp, const char *fmt, ...)
11468c2ecf20Sopenharmony_ci{
11478c2ecf20Sopenharmony_ci	struct va_format vaf;
11488c2ecf20Sopenharmony_ci	va_list args;
11498c2ecf20Sopenharmony_ci	char 	buf[RPC_MAX_ADDRBUFLEN];
11508c2ecf20Sopenharmony_ci
11518c2ecf20Sopenharmony_ci	va_start(args, fmt);
11528c2ecf20Sopenharmony_ci
11538c2ecf20Sopenharmony_ci	vaf.fmt = fmt;
11548c2ecf20Sopenharmony_ci	vaf.va = &args;
11558c2ecf20Sopenharmony_ci
11568c2ecf20Sopenharmony_ci	dprintk("svc: %s: %pV", svc_print_addr(rqstp, buf, sizeof(buf)), &vaf);
11578c2ecf20Sopenharmony_ci
11588c2ecf20Sopenharmony_ci	va_end(args);
11598c2ecf20Sopenharmony_ci}
11608c2ecf20Sopenharmony_ci#else
11618c2ecf20Sopenharmony_cistatic __printf(2,3) void svc_printk(struct svc_rqst *rqstp, const char *fmt, ...) {}
11628c2ecf20Sopenharmony_ci#endif
11638c2ecf20Sopenharmony_ci
11648c2ecf20Sopenharmony_ci__be32
11658c2ecf20Sopenharmony_cisvc_return_autherr(struct svc_rqst *rqstp, __be32 auth_err)
11668c2ecf20Sopenharmony_ci{
11678c2ecf20Sopenharmony_ci	set_bit(RQ_AUTHERR, &rqstp->rq_flags);
11688c2ecf20Sopenharmony_ci	return auth_err;
11698c2ecf20Sopenharmony_ci}
11708c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_return_autherr);
11718c2ecf20Sopenharmony_ci
11728c2ecf20Sopenharmony_cistatic __be32
11738c2ecf20Sopenharmony_cisvc_get_autherr(struct svc_rqst *rqstp, __be32 *statp)
11748c2ecf20Sopenharmony_ci{
11758c2ecf20Sopenharmony_ci	if (test_and_clear_bit(RQ_AUTHERR, &rqstp->rq_flags))
11768c2ecf20Sopenharmony_ci		return *statp;
11778c2ecf20Sopenharmony_ci	return rpc_auth_ok;
11788c2ecf20Sopenharmony_ci}
11798c2ecf20Sopenharmony_ci
11808c2ecf20Sopenharmony_cistatic int
11818c2ecf20Sopenharmony_cisvc_generic_dispatch(struct svc_rqst *rqstp, __be32 *statp)
11828c2ecf20Sopenharmony_ci{
11838c2ecf20Sopenharmony_ci	struct kvec *argv = &rqstp->rq_arg.head[0];
11848c2ecf20Sopenharmony_ci	struct kvec *resv = &rqstp->rq_res.head[0];
11858c2ecf20Sopenharmony_ci	const struct svc_procedure *procp = rqstp->rq_procinfo;
11868c2ecf20Sopenharmony_ci
11878c2ecf20Sopenharmony_ci	/*
11888c2ecf20Sopenharmony_ci	 * Decode arguments
11898c2ecf20Sopenharmony_ci	 * XXX: why do we ignore the return value?
11908c2ecf20Sopenharmony_ci	 */
11918c2ecf20Sopenharmony_ci	if (procp->pc_decode &&
11928c2ecf20Sopenharmony_ci	    !procp->pc_decode(rqstp, argv->iov_base)) {
11938c2ecf20Sopenharmony_ci		*statp = rpc_garbage_args;
11948c2ecf20Sopenharmony_ci		return 1;
11958c2ecf20Sopenharmony_ci	}
11968c2ecf20Sopenharmony_ci
11978c2ecf20Sopenharmony_ci	*statp = procp->pc_func(rqstp);
11988c2ecf20Sopenharmony_ci
11998c2ecf20Sopenharmony_ci	if (*statp == rpc_drop_reply ||
12008c2ecf20Sopenharmony_ci	    test_bit(RQ_DROPME, &rqstp->rq_flags))
12018c2ecf20Sopenharmony_ci		return 0;
12028c2ecf20Sopenharmony_ci
12038c2ecf20Sopenharmony_ci	if (test_bit(RQ_AUTHERR, &rqstp->rq_flags))
12048c2ecf20Sopenharmony_ci		return 1;
12058c2ecf20Sopenharmony_ci
12068c2ecf20Sopenharmony_ci	if (*statp != rpc_success)
12078c2ecf20Sopenharmony_ci		return 1;
12088c2ecf20Sopenharmony_ci
12098c2ecf20Sopenharmony_ci	/* Encode reply */
12108c2ecf20Sopenharmony_ci	if (procp->pc_encode &&
12118c2ecf20Sopenharmony_ci	    !procp->pc_encode(rqstp, resv->iov_base + resv->iov_len)) {
12128c2ecf20Sopenharmony_ci		dprintk("svc: failed to encode reply\n");
12138c2ecf20Sopenharmony_ci		/* serv->sv_stats->rpcsystemerr++; */
12148c2ecf20Sopenharmony_ci		*statp = rpc_system_err;
12158c2ecf20Sopenharmony_ci	}
12168c2ecf20Sopenharmony_ci	return 1;
12178c2ecf20Sopenharmony_ci}
12188c2ecf20Sopenharmony_ci
12198c2ecf20Sopenharmony_ci__be32
12208c2ecf20Sopenharmony_cisvc_generic_init_request(struct svc_rqst *rqstp,
12218c2ecf20Sopenharmony_ci		const struct svc_program *progp,
12228c2ecf20Sopenharmony_ci		struct svc_process_info *ret)
12238c2ecf20Sopenharmony_ci{
12248c2ecf20Sopenharmony_ci	const struct svc_version *versp = NULL;	/* compiler food */
12258c2ecf20Sopenharmony_ci	const struct svc_procedure *procp = NULL;
12268c2ecf20Sopenharmony_ci
12278c2ecf20Sopenharmony_ci	if (rqstp->rq_vers >= progp->pg_nvers )
12288c2ecf20Sopenharmony_ci		goto err_bad_vers;
12298c2ecf20Sopenharmony_ci	versp = progp->pg_vers[rqstp->rq_vers];
12308c2ecf20Sopenharmony_ci	if (!versp)
12318c2ecf20Sopenharmony_ci		goto err_bad_vers;
12328c2ecf20Sopenharmony_ci
12338c2ecf20Sopenharmony_ci	/*
12348c2ecf20Sopenharmony_ci	 * Some protocol versions (namely NFSv4) require some form of
12358c2ecf20Sopenharmony_ci	 * congestion control.  (See RFC 7530 section 3.1 paragraph 2)
12368c2ecf20Sopenharmony_ci	 * In other words, UDP is not allowed. We mark those when setting
12378c2ecf20Sopenharmony_ci	 * up the svc_xprt, and verify that here.
12388c2ecf20Sopenharmony_ci	 *
12398c2ecf20Sopenharmony_ci	 * The spec is not very clear about what error should be returned
12408c2ecf20Sopenharmony_ci	 * when someone tries to access a server that is listening on UDP
12418c2ecf20Sopenharmony_ci	 * for lower versions. RPC_PROG_MISMATCH seems to be the closest
12428c2ecf20Sopenharmony_ci	 * fit.
12438c2ecf20Sopenharmony_ci	 */
12448c2ecf20Sopenharmony_ci	if (versp->vs_need_cong_ctrl && rqstp->rq_xprt &&
12458c2ecf20Sopenharmony_ci	    !test_bit(XPT_CONG_CTRL, &rqstp->rq_xprt->xpt_flags))
12468c2ecf20Sopenharmony_ci		goto err_bad_vers;
12478c2ecf20Sopenharmony_ci
12488c2ecf20Sopenharmony_ci	if (rqstp->rq_proc >= versp->vs_nproc)
12498c2ecf20Sopenharmony_ci		goto err_bad_proc;
12508c2ecf20Sopenharmony_ci	rqstp->rq_procinfo = procp = &versp->vs_proc[rqstp->rq_proc];
12518c2ecf20Sopenharmony_ci	if (!procp)
12528c2ecf20Sopenharmony_ci		goto err_bad_proc;
12538c2ecf20Sopenharmony_ci
12548c2ecf20Sopenharmony_ci	/* Initialize storage for argp and resp */
12558c2ecf20Sopenharmony_ci	memset(rqstp->rq_argp, 0, procp->pc_argsize);
12568c2ecf20Sopenharmony_ci	memset(rqstp->rq_resp, 0, procp->pc_ressize);
12578c2ecf20Sopenharmony_ci
12588c2ecf20Sopenharmony_ci	/* Bump per-procedure stats counter */
12598c2ecf20Sopenharmony_ci	versp->vs_count[rqstp->rq_proc]++;
12608c2ecf20Sopenharmony_ci
12618c2ecf20Sopenharmony_ci	ret->dispatch = versp->vs_dispatch;
12628c2ecf20Sopenharmony_ci	return rpc_success;
12638c2ecf20Sopenharmony_cierr_bad_vers:
12648c2ecf20Sopenharmony_ci	ret->mismatch.lovers = progp->pg_lovers;
12658c2ecf20Sopenharmony_ci	ret->mismatch.hivers = progp->pg_hivers;
12668c2ecf20Sopenharmony_ci	return rpc_prog_mismatch;
12678c2ecf20Sopenharmony_cierr_bad_proc:
12688c2ecf20Sopenharmony_ci	return rpc_proc_unavail;
12698c2ecf20Sopenharmony_ci}
12708c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_generic_init_request);
12718c2ecf20Sopenharmony_ci
12728c2ecf20Sopenharmony_ci/*
12738c2ecf20Sopenharmony_ci * Common routine for processing the RPC request.
12748c2ecf20Sopenharmony_ci */
12758c2ecf20Sopenharmony_cistatic int
12768c2ecf20Sopenharmony_cisvc_process_common(struct svc_rqst *rqstp, struct kvec *argv, struct kvec *resv)
12778c2ecf20Sopenharmony_ci{
12788c2ecf20Sopenharmony_ci	struct svc_program	*progp;
12798c2ecf20Sopenharmony_ci	const struct svc_procedure *procp = NULL;
12808c2ecf20Sopenharmony_ci	struct svc_serv		*serv = rqstp->rq_server;
12818c2ecf20Sopenharmony_ci	struct svc_process_info process;
12828c2ecf20Sopenharmony_ci	__be32			*statp;
12838c2ecf20Sopenharmony_ci	u32			prog, vers;
12848c2ecf20Sopenharmony_ci	__be32			auth_stat, rpc_stat;
12858c2ecf20Sopenharmony_ci	int			auth_res;
12868c2ecf20Sopenharmony_ci	__be32			*reply_statp;
12878c2ecf20Sopenharmony_ci
12888c2ecf20Sopenharmony_ci	rpc_stat = rpc_success;
12898c2ecf20Sopenharmony_ci
12908c2ecf20Sopenharmony_ci	if (argv->iov_len < 6*4)
12918c2ecf20Sopenharmony_ci		goto err_short_len;
12928c2ecf20Sopenharmony_ci
12938c2ecf20Sopenharmony_ci	/* Will be turned off by GSS integrity and privacy services */
12948c2ecf20Sopenharmony_ci	set_bit(RQ_SPLICE_OK, &rqstp->rq_flags);
12958c2ecf20Sopenharmony_ci	/* Will be turned off only when NFSv4 Sessions are used */
12968c2ecf20Sopenharmony_ci	set_bit(RQ_USEDEFERRAL, &rqstp->rq_flags);
12978c2ecf20Sopenharmony_ci	clear_bit(RQ_DROPME, &rqstp->rq_flags);
12988c2ecf20Sopenharmony_ci
12998c2ecf20Sopenharmony_ci	svc_putu32(resv, rqstp->rq_xid);
13008c2ecf20Sopenharmony_ci
13018c2ecf20Sopenharmony_ci	vers = svc_getnl(argv);
13028c2ecf20Sopenharmony_ci
13038c2ecf20Sopenharmony_ci	/* First words of reply: */
13048c2ecf20Sopenharmony_ci	svc_putnl(resv, 1);		/* REPLY */
13058c2ecf20Sopenharmony_ci
13068c2ecf20Sopenharmony_ci	if (vers != 2)		/* RPC version number */
13078c2ecf20Sopenharmony_ci		goto err_bad_rpc;
13088c2ecf20Sopenharmony_ci
13098c2ecf20Sopenharmony_ci	/* Save position in case we later decide to reject: */
13108c2ecf20Sopenharmony_ci	reply_statp = resv->iov_base + resv->iov_len;
13118c2ecf20Sopenharmony_ci
13128c2ecf20Sopenharmony_ci	svc_putnl(resv, 0);		/* ACCEPT */
13138c2ecf20Sopenharmony_ci
13148c2ecf20Sopenharmony_ci	rqstp->rq_prog = prog = svc_getnl(argv);	/* program number */
13158c2ecf20Sopenharmony_ci	rqstp->rq_vers = svc_getnl(argv);	/* version number */
13168c2ecf20Sopenharmony_ci	rqstp->rq_proc = svc_getnl(argv);	/* procedure number */
13178c2ecf20Sopenharmony_ci
13188c2ecf20Sopenharmony_ci	for (progp = serv->sv_program; progp; progp = progp->pg_next)
13198c2ecf20Sopenharmony_ci		if (prog == progp->pg_prog)
13208c2ecf20Sopenharmony_ci			break;
13218c2ecf20Sopenharmony_ci
13228c2ecf20Sopenharmony_ci	/*
13238c2ecf20Sopenharmony_ci	 * Decode auth data, and add verifier to reply buffer.
13248c2ecf20Sopenharmony_ci	 * We do this before anything else in order to get a decent
13258c2ecf20Sopenharmony_ci	 * auth verifier.
13268c2ecf20Sopenharmony_ci	 */
13278c2ecf20Sopenharmony_ci	auth_res = svc_authenticate(rqstp, &auth_stat);
13288c2ecf20Sopenharmony_ci	/* Also give the program a chance to reject this call: */
13298c2ecf20Sopenharmony_ci	if (auth_res == SVC_OK && progp) {
13308c2ecf20Sopenharmony_ci		auth_stat = rpc_autherr_badcred;
13318c2ecf20Sopenharmony_ci		auth_res = progp->pg_authenticate(rqstp);
13328c2ecf20Sopenharmony_ci	}
13338c2ecf20Sopenharmony_ci	if (auth_res != SVC_OK)
13348c2ecf20Sopenharmony_ci		trace_svc_authenticate(rqstp, auth_res, auth_stat);
13358c2ecf20Sopenharmony_ci	switch (auth_res) {
13368c2ecf20Sopenharmony_ci	case SVC_OK:
13378c2ecf20Sopenharmony_ci		break;
13388c2ecf20Sopenharmony_ci	case SVC_GARBAGE:
13398c2ecf20Sopenharmony_ci		goto err_garbage;
13408c2ecf20Sopenharmony_ci	case SVC_SYSERR:
13418c2ecf20Sopenharmony_ci		rpc_stat = rpc_system_err;
13428c2ecf20Sopenharmony_ci		goto err_bad;
13438c2ecf20Sopenharmony_ci	case SVC_DENIED:
13448c2ecf20Sopenharmony_ci		goto err_bad_auth;
13458c2ecf20Sopenharmony_ci	case SVC_CLOSE:
13468c2ecf20Sopenharmony_ci		goto close;
13478c2ecf20Sopenharmony_ci	case SVC_DROP:
13488c2ecf20Sopenharmony_ci		goto dropit;
13498c2ecf20Sopenharmony_ci	case SVC_COMPLETE:
13508c2ecf20Sopenharmony_ci		goto sendit;
13518c2ecf20Sopenharmony_ci	}
13528c2ecf20Sopenharmony_ci
13538c2ecf20Sopenharmony_ci	if (progp == NULL)
13548c2ecf20Sopenharmony_ci		goto err_bad_prog;
13558c2ecf20Sopenharmony_ci
13568c2ecf20Sopenharmony_ci	rpc_stat = progp->pg_init_request(rqstp, progp, &process);
13578c2ecf20Sopenharmony_ci	switch (rpc_stat) {
13588c2ecf20Sopenharmony_ci	case rpc_success:
13598c2ecf20Sopenharmony_ci		break;
13608c2ecf20Sopenharmony_ci	case rpc_prog_unavail:
13618c2ecf20Sopenharmony_ci		goto err_bad_prog;
13628c2ecf20Sopenharmony_ci	case rpc_prog_mismatch:
13638c2ecf20Sopenharmony_ci		goto err_bad_vers;
13648c2ecf20Sopenharmony_ci	case rpc_proc_unavail:
13658c2ecf20Sopenharmony_ci		goto err_bad_proc;
13668c2ecf20Sopenharmony_ci	}
13678c2ecf20Sopenharmony_ci
13688c2ecf20Sopenharmony_ci	procp = rqstp->rq_procinfo;
13698c2ecf20Sopenharmony_ci	/* Should this check go into the dispatcher? */
13708c2ecf20Sopenharmony_ci	if (!procp || !procp->pc_func)
13718c2ecf20Sopenharmony_ci		goto err_bad_proc;
13728c2ecf20Sopenharmony_ci
13738c2ecf20Sopenharmony_ci	/* Syntactic check complete */
13748c2ecf20Sopenharmony_ci	serv->sv_stats->rpccnt++;
13758c2ecf20Sopenharmony_ci	trace_svc_process(rqstp, progp->pg_name);
13768c2ecf20Sopenharmony_ci
13778c2ecf20Sopenharmony_ci	/* Build the reply header. */
13788c2ecf20Sopenharmony_ci	statp = resv->iov_base +resv->iov_len;
13798c2ecf20Sopenharmony_ci	svc_putnl(resv, RPC_SUCCESS);
13808c2ecf20Sopenharmony_ci
13818c2ecf20Sopenharmony_ci	/* un-reserve some of the out-queue now that we have a
13828c2ecf20Sopenharmony_ci	 * better idea of reply size
13838c2ecf20Sopenharmony_ci	 */
13848c2ecf20Sopenharmony_ci	if (procp->pc_xdrressize)
13858c2ecf20Sopenharmony_ci		svc_reserve_auth(rqstp, procp->pc_xdrressize<<2);
13868c2ecf20Sopenharmony_ci
13878c2ecf20Sopenharmony_ci	/* Call the function that processes the request. */
13888c2ecf20Sopenharmony_ci	if (!process.dispatch) {
13898c2ecf20Sopenharmony_ci		if (!svc_generic_dispatch(rqstp, statp))
13908c2ecf20Sopenharmony_ci			goto release_dropit;
13918c2ecf20Sopenharmony_ci		if (*statp == rpc_garbage_args)
13928c2ecf20Sopenharmony_ci			goto err_garbage;
13938c2ecf20Sopenharmony_ci		auth_stat = svc_get_autherr(rqstp, statp);
13948c2ecf20Sopenharmony_ci		if (auth_stat != rpc_auth_ok)
13958c2ecf20Sopenharmony_ci			goto err_release_bad_auth;
13968c2ecf20Sopenharmony_ci	} else {
13978c2ecf20Sopenharmony_ci		dprintk("svc: calling dispatcher\n");
13988c2ecf20Sopenharmony_ci		if (!process.dispatch(rqstp, statp))
13998c2ecf20Sopenharmony_ci			goto release_dropit; /* Release reply info */
14008c2ecf20Sopenharmony_ci	}
14018c2ecf20Sopenharmony_ci
14028c2ecf20Sopenharmony_ci	/* Check RPC status result */
14038c2ecf20Sopenharmony_ci	if (*statp != rpc_success)
14048c2ecf20Sopenharmony_ci		resv->iov_len = ((void*)statp)  - resv->iov_base + 4;
14058c2ecf20Sopenharmony_ci
14068c2ecf20Sopenharmony_ci	/* Release reply info */
14078c2ecf20Sopenharmony_ci	if (procp->pc_release)
14088c2ecf20Sopenharmony_ci		procp->pc_release(rqstp);
14098c2ecf20Sopenharmony_ci
14108c2ecf20Sopenharmony_ci	if (procp->pc_encode == NULL)
14118c2ecf20Sopenharmony_ci		goto dropit;
14128c2ecf20Sopenharmony_ci
14138c2ecf20Sopenharmony_ci sendit:
14148c2ecf20Sopenharmony_ci	if (svc_authorise(rqstp))
14158c2ecf20Sopenharmony_ci		goto close_xprt;
14168c2ecf20Sopenharmony_ci	return 1;		/* Caller can now send it */
14178c2ecf20Sopenharmony_ci
14188c2ecf20Sopenharmony_cirelease_dropit:
14198c2ecf20Sopenharmony_ci	if (procp->pc_release)
14208c2ecf20Sopenharmony_ci		procp->pc_release(rqstp);
14218c2ecf20Sopenharmony_ci dropit:
14228c2ecf20Sopenharmony_ci	svc_authorise(rqstp);	/* doesn't hurt to call this twice */
14238c2ecf20Sopenharmony_ci	dprintk("svc: svc_process dropit\n");
14248c2ecf20Sopenharmony_ci	return 0;
14258c2ecf20Sopenharmony_ci
14268c2ecf20Sopenharmony_ci close:
14278c2ecf20Sopenharmony_ci	svc_authorise(rqstp);
14288c2ecf20Sopenharmony_ciclose_xprt:
14298c2ecf20Sopenharmony_ci	if (rqstp->rq_xprt && test_bit(XPT_TEMP, &rqstp->rq_xprt->xpt_flags))
14308c2ecf20Sopenharmony_ci		svc_close_xprt(rqstp->rq_xprt);
14318c2ecf20Sopenharmony_ci	dprintk("svc: svc_process close\n");
14328c2ecf20Sopenharmony_ci	return 0;
14338c2ecf20Sopenharmony_ci
14348c2ecf20Sopenharmony_cierr_short_len:
14358c2ecf20Sopenharmony_ci	svc_printk(rqstp, "short len %zd, dropping request\n",
14368c2ecf20Sopenharmony_ci			argv->iov_len);
14378c2ecf20Sopenharmony_ci	goto close_xprt;
14388c2ecf20Sopenharmony_ci
14398c2ecf20Sopenharmony_cierr_bad_rpc:
14408c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadfmt++;
14418c2ecf20Sopenharmony_ci	svc_putnl(resv, 1);	/* REJECT */
14428c2ecf20Sopenharmony_ci	svc_putnl(resv, 0);	/* RPC_MISMATCH */
14438c2ecf20Sopenharmony_ci	svc_putnl(resv, 2);	/* Only RPCv2 supported */
14448c2ecf20Sopenharmony_ci	svc_putnl(resv, 2);
14458c2ecf20Sopenharmony_ci	goto sendit;
14468c2ecf20Sopenharmony_ci
14478c2ecf20Sopenharmony_cierr_release_bad_auth:
14488c2ecf20Sopenharmony_ci	if (procp->pc_release)
14498c2ecf20Sopenharmony_ci		procp->pc_release(rqstp);
14508c2ecf20Sopenharmony_cierr_bad_auth:
14518c2ecf20Sopenharmony_ci	dprintk("svc: authentication failed (%d)\n", ntohl(auth_stat));
14528c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadauth++;
14538c2ecf20Sopenharmony_ci	/* Restore write pointer to location of accept status: */
14548c2ecf20Sopenharmony_ci	xdr_ressize_check(rqstp, reply_statp);
14558c2ecf20Sopenharmony_ci	svc_putnl(resv, 1);	/* REJECT */
14568c2ecf20Sopenharmony_ci	svc_putnl(resv, 1);	/* AUTH_ERROR */
14578c2ecf20Sopenharmony_ci	svc_putnl(resv, ntohl(auth_stat));	/* status */
14588c2ecf20Sopenharmony_ci	goto sendit;
14598c2ecf20Sopenharmony_ci
14608c2ecf20Sopenharmony_cierr_bad_prog:
14618c2ecf20Sopenharmony_ci	dprintk("svc: unknown program %d\n", prog);
14628c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadfmt++;
14638c2ecf20Sopenharmony_ci	svc_putnl(resv, RPC_PROG_UNAVAIL);
14648c2ecf20Sopenharmony_ci	goto sendit;
14658c2ecf20Sopenharmony_ci
14668c2ecf20Sopenharmony_cierr_bad_vers:
14678c2ecf20Sopenharmony_ci	svc_printk(rqstp, "unknown version (%d for prog %d, %s)\n",
14688c2ecf20Sopenharmony_ci		       rqstp->rq_vers, rqstp->rq_prog, progp->pg_name);
14698c2ecf20Sopenharmony_ci
14708c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadfmt++;
14718c2ecf20Sopenharmony_ci	svc_putnl(resv, RPC_PROG_MISMATCH);
14728c2ecf20Sopenharmony_ci	svc_putnl(resv, process.mismatch.lovers);
14738c2ecf20Sopenharmony_ci	svc_putnl(resv, process.mismatch.hivers);
14748c2ecf20Sopenharmony_ci	goto sendit;
14758c2ecf20Sopenharmony_ci
14768c2ecf20Sopenharmony_cierr_bad_proc:
14778c2ecf20Sopenharmony_ci	svc_printk(rqstp, "unknown procedure (%d)\n", rqstp->rq_proc);
14788c2ecf20Sopenharmony_ci
14798c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadfmt++;
14808c2ecf20Sopenharmony_ci	svc_putnl(resv, RPC_PROC_UNAVAIL);
14818c2ecf20Sopenharmony_ci	goto sendit;
14828c2ecf20Sopenharmony_ci
14838c2ecf20Sopenharmony_cierr_garbage:
14848c2ecf20Sopenharmony_ci	svc_printk(rqstp, "failed to decode args\n");
14858c2ecf20Sopenharmony_ci
14868c2ecf20Sopenharmony_ci	rpc_stat = rpc_garbage_args;
14878c2ecf20Sopenharmony_cierr_bad:
14888c2ecf20Sopenharmony_ci	serv->sv_stats->rpcbadfmt++;
14898c2ecf20Sopenharmony_ci	svc_putnl(resv, ntohl(rpc_stat));
14908c2ecf20Sopenharmony_ci	goto sendit;
14918c2ecf20Sopenharmony_ci}
14928c2ecf20Sopenharmony_ci
14938c2ecf20Sopenharmony_ci/*
14948c2ecf20Sopenharmony_ci * Process the RPC request.
14958c2ecf20Sopenharmony_ci */
14968c2ecf20Sopenharmony_ciint
14978c2ecf20Sopenharmony_cisvc_process(struct svc_rqst *rqstp)
14988c2ecf20Sopenharmony_ci{
14998c2ecf20Sopenharmony_ci	struct kvec		*argv = &rqstp->rq_arg.head[0];
15008c2ecf20Sopenharmony_ci	struct kvec		*resv = &rqstp->rq_res.head[0];
15018c2ecf20Sopenharmony_ci	struct svc_serv		*serv = rqstp->rq_server;
15028c2ecf20Sopenharmony_ci	u32			dir;
15038c2ecf20Sopenharmony_ci
15048c2ecf20Sopenharmony_ci	/*
15058c2ecf20Sopenharmony_ci	 * Setup response xdr_buf.
15068c2ecf20Sopenharmony_ci	 * Initially it has just one page
15078c2ecf20Sopenharmony_ci	 */
15088c2ecf20Sopenharmony_ci	rqstp->rq_next_page = &rqstp->rq_respages[1];
15098c2ecf20Sopenharmony_ci	resv->iov_base = page_address(rqstp->rq_respages[0]);
15108c2ecf20Sopenharmony_ci	resv->iov_len = 0;
15118c2ecf20Sopenharmony_ci	rqstp->rq_res.pages = rqstp->rq_respages + 1;
15128c2ecf20Sopenharmony_ci	rqstp->rq_res.len = 0;
15138c2ecf20Sopenharmony_ci	rqstp->rq_res.page_base = 0;
15148c2ecf20Sopenharmony_ci	rqstp->rq_res.page_len = 0;
15158c2ecf20Sopenharmony_ci	rqstp->rq_res.buflen = PAGE_SIZE;
15168c2ecf20Sopenharmony_ci	rqstp->rq_res.tail[0].iov_base = NULL;
15178c2ecf20Sopenharmony_ci	rqstp->rq_res.tail[0].iov_len = 0;
15188c2ecf20Sopenharmony_ci
15198c2ecf20Sopenharmony_ci	dir  = svc_getnl(argv);
15208c2ecf20Sopenharmony_ci	if (dir != 0) {
15218c2ecf20Sopenharmony_ci		/* direction != CALL */
15228c2ecf20Sopenharmony_ci		svc_printk(rqstp, "bad direction %d, dropping request\n", dir);
15238c2ecf20Sopenharmony_ci		serv->sv_stats->rpcbadfmt++;
15248c2ecf20Sopenharmony_ci		goto out_drop;
15258c2ecf20Sopenharmony_ci	}
15268c2ecf20Sopenharmony_ci
15278c2ecf20Sopenharmony_ci	/* Returns 1 for send, 0 for drop */
15288c2ecf20Sopenharmony_ci	if (likely(svc_process_common(rqstp, argv, resv)))
15298c2ecf20Sopenharmony_ci		return svc_send(rqstp);
15308c2ecf20Sopenharmony_ci
15318c2ecf20Sopenharmony_ciout_drop:
15328c2ecf20Sopenharmony_ci	svc_drop(rqstp);
15338c2ecf20Sopenharmony_ci	return 0;
15348c2ecf20Sopenharmony_ci}
15358c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_process);
15368c2ecf20Sopenharmony_ci
15378c2ecf20Sopenharmony_ci#if defined(CONFIG_SUNRPC_BACKCHANNEL)
15388c2ecf20Sopenharmony_ci/*
15398c2ecf20Sopenharmony_ci * Process a backchannel RPC request that arrived over an existing
15408c2ecf20Sopenharmony_ci * outbound connection
15418c2ecf20Sopenharmony_ci */
15428c2ecf20Sopenharmony_ciint
15438c2ecf20Sopenharmony_cibc_svc_process(struct svc_serv *serv, struct rpc_rqst *req,
15448c2ecf20Sopenharmony_ci	       struct svc_rqst *rqstp)
15458c2ecf20Sopenharmony_ci{
15468c2ecf20Sopenharmony_ci	struct kvec	*argv = &rqstp->rq_arg.head[0];
15478c2ecf20Sopenharmony_ci	struct kvec	*resv = &rqstp->rq_res.head[0];
15488c2ecf20Sopenharmony_ci	struct rpc_task *task;
15498c2ecf20Sopenharmony_ci	int proc_error;
15508c2ecf20Sopenharmony_ci	int error;
15518c2ecf20Sopenharmony_ci
15528c2ecf20Sopenharmony_ci	dprintk("svc: %s(%p)\n", __func__, req);
15538c2ecf20Sopenharmony_ci
15548c2ecf20Sopenharmony_ci	/* Build the svc_rqst used by the common processing routine */
15558c2ecf20Sopenharmony_ci	rqstp->rq_xid = req->rq_xid;
15568c2ecf20Sopenharmony_ci	rqstp->rq_prot = req->rq_xprt->prot;
15578c2ecf20Sopenharmony_ci	rqstp->rq_server = serv;
15588c2ecf20Sopenharmony_ci	rqstp->rq_bc_net = req->rq_xprt->xprt_net;
15598c2ecf20Sopenharmony_ci
15608c2ecf20Sopenharmony_ci	rqstp->rq_addrlen = sizeof(req->rq_xprt->addr);
15618c2ecf20Sopenharmony_ci	memcpy(&rqstp->rq_addr, &req->rq_xprt->addr, rqstp->rq_addrlen);
15628c2ecf20Sopenharmony_ci	memcpy(&rqstp->rq_arg, &req->rq_rcv_buf, sizeof(rqstp->rq_arg));
15638c2ecf20Sopenharmony_ci	memcpy(&rqstp->rq_res, &req->rq_snd_buf, sizeof(rqstp->rq_res));
15648c2ecf20Sopenharmony_ci
15658c2ecf20Sopenharmony_ci	/* Adjust the argument buffer length */
15668c2ecf20Sopenharmony_ci	rqstp->rq_arg.len = req->rq_private_buf.len;
15678c2ecf20Sopenharmony_ci	if (rqstp->rq_arg.len <= rqstp->rq_arg.head[0].iov_len) {
15688c2ecf20Sopenharmony_ci		rqstp->rq_arg.head[0].iov_len = rqstp->rq_arg.len;
15698c2ecf20Sopenharmony_ci		rqstp->rq_arg.page_len = 0;
15708c2ecf20Sopenharmony_ci	} else if (rqstp->rq_arg.len <= rqstp->rq_arg.head[0].iov_len +
15718c2ecf20Sopenharmony_ci			rqstp->rq_arg.page_len)
15728c2ecf20Sopenharmony_ci		rqstp->rq_arg.page_len = rqstp->rq_arg.len -
15738c2ecf20Sopenharmony_ci			rqstp->rq_arg.head[0].iov_len;
15748c2ecf20Sopenharmony_ci	else
15758c2ecf20Sopenharmony_ci		rqstp->rq_arg.len = rqstp->rq_arg.head[0].iov_len +
15768c2ecf20Sopenharmony_ci			rqstp->rq_arg.page_len;
15778c2ecf20Sopenharmony_ci
15788c2ecf20Sopenharmony_ci	/* reset result send buffer "put" position */
15798c2ecf20Sopenharmony_ci	resv->iov_len = 0;
15808c2ecf20Sopenharmony_ci
15818c2ecf20Sopenharmony_ci	/*
15828c2ecf20Sopenharmony_ci	 * Skip the next two words because they've already been
15838c2ecf20Sopenharmony_ci	 * processed in the transport
15848c2ecf20Sopenharmony_ci	 */
15858c2ecf20Sopenharmony_ci	svc_getu32(argv);	/* XID */
15868c2ecf20Sopenharmony_ci	svc_getnl(argv);	/* CALLDIR */
15878c2ecf20Sopenharmony_ci
15888c2ecf20Sopenharmony_ci	/* Parse and execute the bc call */
15898c2ecf20Sopenharmony_ci	proc_error = svc_process_common(rqstp, argv, resv);
15908c2ecf20Sopenharmony_ci
15918c2ecf20Sopenharmony_ci	atomic_dec(&req->rq_xprt->bc_slot_count);
15928c2ecf20Sopenharmony_ci	if (!proc_error) {
15938c2ecf20Sopenharmony_ci		/* Processing error: drop the request */
15948c2ecf20Sopenharmony_ci		xprt_free_bc_request(req);
15958c2ecf20Sopenharmony_ci		error = -EINVAL;
15968c2ecf20Sopenharmony_ci		goto out;
15978c2ecf20Sopenharmony_ci	}
15988c2ecf20Sopenharmony_ci	/* Finally, send the reply synchronously */
15998c2ecf20Sopenharmony_ci	memcpy(&req->rq_snd_buf, &rqstp->rq_res, sizeof(req->rq_snd_buf));
16008c2ecf20Sopenharmony_ci	task = rpc_run_bc_task(req);
16018c2ecf20Sopenharmony_ci	if (IS_ERR(task)) {
16028c2ecf20Sopenharmony_ci		error = PTR_ERR(task);
16038c2ecf20Sopenharmony_ci		goto out;
16048c2ecf20Sopenharmony_ci	}
16058c2ecf20Sopenharmony_ci
16068c2ecf20Sopenharmony_ci	WARN_ON_ONCE(atomic_read(&task->tk_count) != 1);
16078c2ecf20Sopenharmony_ci	error = task->tk_status;
16088c2ecf20Sopenharmony_ci	rpc_put_task(task);
16098c2ecf20Sopenharmony_ci
16108c2ecf20Sopenharmony_ciout:
16118c2ecf20Sopenharmony_ci	dprintk("svc: %s(), error=%d\n", __func__, error);
16128c2ecf20Sopenharmony_ci	return error;
16138c2ecf20Sopenharmony_ci}
16148c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(bc_svc_process);
16158c2ecf20Sopenharmony_ci#endif /* CONFIG_SUNRPC_BACKCHANNEL */
16168c2ecf20Sopenharmony_ci
16178c2ecf20Sopenharmony_ci/*
16188c2ecf20Sopenharmony_ci * Return (transport-specific) limit on the rpc payload.
16198c2ecf20Sopenharmony_ci */
16208c2ecf20Sopenharmony_ciu32 svc_max_payload(const struct svc_rqst *rqstp)
16218c2ecf20Sopenharmony_ci{
16228c2ecf20Sopenharmony_ci	u32 max = rqstp->rq_xprt->xpt_class->xcl_max_payload;
16238c2ecf20Sopenharmony_ci
16248c2ecf20Sopenharmony_ci	if (rqstp->rq_server->sv_max_payload < max)
16258c2ecf20Sopenharmony_ci		max = rqstp->rq_server->sv_max_payload;
16268c2ecf20Sopenharmony_ci	return max;
16278c2ecf20Sopenharmony_ci}
16288c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_max_payload);
16298c2ecf20Sopenharmony_ci
16308c2ecf20Sopenharmony_ci/**
16318c2ecf20Sopenharmony_ci * svc_encode_read_payload - mark a range of bytes as a READ payload
16328c2ecf20Sopenharmony_ci * @rqstp: svc_rqst to operate on
16338c2ecf20Sopenharmony_ci * @offset: payload's byte offset in rqstp->rq_res
16348c2ecf20Sopenharmony_ci * @length: size of payload, in bytes
16358c2ecf20Sopenharmony_ci *
16368c2ecf20Sopenharmony_ci * Returns zero on success, or a negative errno if a permanent
16378c2ecf20Sopenharmony_ci * error occurred.
16388c2ecf20Sopenharmony_ci */
16398c2ecf20Sopenharmony_ciint svc_encode_read_payload(struct svc_rqst *rqstp, unsigned int offset,
16408c2ecf20Sopenharmony_ci			    unsigned int length)
16418c2ecf20Sopenharmony_ci{
16428c2ecf20Sopenharmony_ci	return rqstp->rq_xprt->xpt_ops->xpo_read_payload(rqstp, offset, length);
16438c2ecf20Sopenharmony_ci}
16448c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_encode_read_payload);
16458c2ecf20Sopenharmony_ci
16468c2ecf20Sopenharmony_ci/**
16478c2ecf20Sopenharmony_ci * svc_fill_write_vector - Construct data argument for VFS write call
16488c2ecf20Sopenharmony_ci * @rqstp: svc_rqst to operate on
16498c2ecf20Sopenharmony_ci * @pages: list of pages containing data payload
16508c2ecf20Sopenharmony_ci * @first: buffer containing first section of write payload
16518c2ecf20Sopenharmony_ci * @total: total number of bytes of write payload
16528c2ecf20Sopenharmony_ci *
16538c2ecf20Sopenharmony_ci * Fills in rqstp::rq_vec, and returns the number of elements.
16548c2ecf20Sopenharmony_ci */
16558c2ecf20Sopenharmony_ciunsigned int svc_fill_write_vector(struct svc_rqst *rqstp, struct page **pages,
16568c2ecf20Sopenharmony_ci				   struct kvec *first, size_t total)
16578c2ecf20Sopenharmony_ci{
16588c2ecf20Sopenharmony_ci	struct kvec *vec = rqstp->rq_vec;
16598c2ecf20Sopenharmony_ci	unsigned int i;
16608c2ecf20Sopenharmony_ci
16618c2ecf20Sopenharmony_ci	/* Some types of transport can present the write payload
16628c2ecf20Sopenharmony_ci	 * entirely in rq_arg.pages. In this case, @first is empty.
16638c2ecf20Sopenharmony_ci	 */
16648c2ecf20Sopenharmony_ci	i = 0;
16658c2ecf20Sopenharmony_ci	if (first->iov_len) {
16668c2ecf20Sopenharmony_ci		vec[i].iov_base = first->iov_base;
16678c2ecf20Sopenharmony_ci		vec[i].iov_len = min_t(size_t, total, first->iov_len);
16688c2ecf20Sopenharmony_ci		total -= vec[i].iov_len;
16698c2ecf20Sopenharmony_ci		++i;
16708c2ecf20Sopenharmony_ci	}
16718c2ecf20Sopenharmony_ci
16728c2ecf20Sopenharmony_ci	while (total) {
16738c2ecf20Sopenharmony_ci		vec[i].iov_base = page_address(*pages);
16748c2ecf20Sopenharmony_ci		vec[i].iov_len = min_t(size_t, total, PAGE_SIZE);
16758c2ecf20Sopenharmony_ci		total -= vec[i].iov_len;
16768c2ecf20Sopenharmony_ci		++i;
16778c2ecf20Sopenharmony_ci		++pages;
16788c2ecf20Sopenharmony_ci	}
16798c2ecf20Sopenharmony_ci
16808c2ecf20Sopenharmony_ci	WARN_ON_ONCE(i > ARRAY_SIZE(rqstp->rq_vec));
16818c2ecf20Sopenharmony_ci	return i;
16828c2ecf20Sopenharmony_ci}
16838c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_fill_write_vector);
16848c2ecf20Sopenharmony_ci
16858c2ecf20Sopenharmony_ci/**
16868c2ecf20Sopenharmony_ci * svc_fill_symlink_pathname - Construct pathname argument for VFS symlink call
16878c2ecf20Sopenharmony_ci * @rqstp: svc_rqst to operate on
16888c2ecf20Sopenharmony_ci * @first: buffer containing first section of pathname
16898c2ecf20Sopenharmony_ci * @p: buffer containing remaining section of pathname
16908c2ecf20Sopenharmony_ci * @total: total length of the pathname argument
16918c2ecf20Sopenharmony_ci *
16928c2ecf20Sopenharmony_ci * The VFS symlink API demands a NUL-terminated pathname in mapped memory.
16938c2ecf20Sopenharmony_ci * Returns pointer to a NUL-terminated string, or an ERR_PTR. Caller must free
16948c2ecf20Sopenharmony_ci * the returned string.
16958c2ecf20Sopenharmony_ci */
16968c2ecf20Sopenharmony_cichar *svc_fill_symlink_pathname(struct svc_rqst *rqstp, struct kvec *first,
16978c2ecf20Sopenharmony_ci				void *p, size_t total)
16988c2ecf20Sopenharmony_ci{
16998c2ecf20Sopenharmony_ci	size_t len, remaining;
17008c2ecf20Sopenharmony_ci	char *result, *dst;
17018c2ecf20Sopenharmony_ci
17028c2ecf20Sopenharmony_ci	result = kmalloc(total + 1, GFP_KERNEL);
17038c2ecf20Sopenharmony_ci	if (!result)
17048c2ecf20Sopenharmony_ci		return ERR_PTR(-ESERVERFAULT);
17058c2ecf20Sopenharmony_ci
17068c2ecf20Sopenharmony_ci	dst = result;
17078c2ecf20Sopenharmony_ci	remaining = total;
17088c2ecf20Sopenharmony_ci
17098c2ecf20Sopenharmony_ci	len = min_t(size_t, total, first->iov_len);
17108c2ecf20Sopenharmony_ci	if (len) {
17118c2ecf20Sopenharmony_ci		memcpy(dst, first->iov_base, len);
17128c2ecf20Sopenharmony_ci		dst += len;
17138c2ecf20Sopenharmony_ci		remaining -= len;
17148c2ecf20Sopenharmony_ci	}
17158c2ecf20Sopenharmony_ci
17168c2ecf20Sopenharmony_ci	if (remaining) {
17178c2ecf20Sopenharmony_ci		len = min_t(size_t, remaining, PAGE_SIZE);
17188c2ecf20Sopenharmony_ci		memcpy(dst, p, len);
17198c2ecf20Sopenharmony_ci		dst += len;
17208c2ecf20Sopenharmony_ci	}
17218c2ecf20Sopenharmony_ci
17228c2ecf20Sopenharmony_ci	*dst = '\0';
17238c2ecf20Sopenharmony_ci
17248c2ecf20Sopenharmony_ci	/* Sanity check: Linux doesn't allow the pathname argument to
17258c2ecf20Sopenharmony_ci	 * contain a NUL byte.
17268c2ecf20Sopenharmony_ci	 */
17278c2ecf20Sopenharmony_ci	if (strlen(result) != total) {
17288c2ecf20Sopenharmony_ci		kfree(result);
17298c2ecf20Sopenharmony_ci		return ERR_PTR(-EINVAL);
17308c2ecf20Sopenharmony_ci	}
17318c2ecf20Sopenharmony_ci	return result;
17328c2ecf20Sopenharmony_ci}
17338c2ecf20Sopenharmony_ciEXPORT_SYMBOL_GPL(svc_fill_symlink_pathname);
1734