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(¤t->sighand->siglock, flags); 11368c2ecf20Sopenharmony_ci recalc_sigpending(); 11378c2ecf20Sopenharmony_ci spin_unlock_irqrestore(¤t->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