blob: e82f066d63ac1d5f0f423e6b9d3f95a90b391fca [file] [log] [blame]
Steffen Klassert16295be2010-01-06 19:47:10 +11001/*
2 * padata.c - generic interface to process data streams in parallel
3 *
Steffen Klassert107f8bd2012-03-28 08:42:34 +02004 * See Documentation/padata.txt for an api documentation.
5 *
Steffen Klassert16295be2010-01-06 19:47:10 +11006 * Copyright (C) 2008, 2009 secunet Security Networks AG
7 * Copyright (C) 2008, 2009 Steffen Klassert <steffen.klassert@secunet.com>
8 *
9 * This program is free software; you can redistribute it and/or modify it
10 * under the terms and conditions of the GNU General Public License,
11 * version 2, as published by the Free Software Foundation.
12 *
13 * This program is distributed in the hope it will be useful, but WITHOUT
14 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
15 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
16 * more details.
17 *
18 * You should have received a copy of the GNU General Public License along with
19 * this program; if not, write to the Free Software Foundation, Inc.,
20 * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
21 */
22
Paul Gortmaker9984de12011-05-23 14:51:41 -040023#include <linux/export.h>
Steffen Klassert16295be2010-01-06 19:47:10 +110024#include <linux/cpumask.h>
25#include <linux/err.h>
26#include <linux/cpu.h>
27#include <linux/padata.h>
28#include <linux/mutex.h>
29#include <linux/sched.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090030#include <linux/slab.h>
Dan Kruchinin5e017dc2010-07-14 14:33:08 +040031#include <linux/sysfs.h>
Steffen Klassert16295be2010-01-06 19:47:10 +110032#include <linux/rcupdate.h>
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +020033#include <linux/module.h>
Steffen Klassert16295be2010-01-06 19:47:10 +110034
Steffen Klassert97e3d942010-04-29 14:37:32 +020035#define MAX_OBJ_NUM 1000
Steffen Klassert16295be2010-01-06 19:47:10 +110036
Herbert Xu928cf3d2019-11-19 13:17:31 +080037static void padata_free_pd(struct parallel_data *pd);
38
Steffen Klassert16295be2010-01-06 19:47:10 +110039static int padata_index_to_cpu(struct parallel_data *pd, int cpu_index)
40{
41 int cpu, target_cpu;
42
Dan Kruchinine15bacb2010-07-14 14:31:57 +040043 target_cpu = cpumask_first(pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110044 for (cpu = 0; cpu < cpu_index; cpu++)
Dan Kruchinine15bacb2010-07-14 14:31:57 +040045 target_cpu = cpumask_next(target_cpu, pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110046
47 return target_cpu;
48}
49
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +010050static int padata_cpu_hash(struct parallel_data *pd)
Steffen Klassert16295be2010-01-06 19:47:10 +110051{
Mathias Krause0b6b0982013-10-25 12:14:15 +020052 unsigned int seq_nr;
Steffen Klassert16295be2010-01-06 19:47:10 +110053 int cpu_index;
Steffen Klassert16295be2010-01-06 19:47:10 +110054
55 /*
56 * Hash the sequence numbers to the cpus by taking
57 * seq_nr mod. number of cpus in use.
58 */
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +010059
Mathias Krause0b6b0982013-10-25 12:14:15 +020060 seq_nr = atomic_inc_return(&pd->seq_nr);
61 cpu_index = seq_nr % cpumask_weight(pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110062
63 return padata_index_to_cpu(pd, cpu_index);
64}
65
Dan Kruchinine15bacb2010-07-14 14:31:57 +040066static void padata_parallel_worker(struct work_struct *parallel_work)
Steffen Klassert16295be2010-01-06 19:47:10 +110067{
Dan Kruchinine15bacb2010-07-14 14:31:57 +040068 struct padata_parallel_queue *pqueue;
Steffen Klassert16295be2010-01-06 19:47:10 +110069 LIST_HEAD(local_list);
70
71 local_bh_disable();
Dan Kruchinine15bacb2010-07-14 14:31:57 +040072 pqueue = container_of(parallel_work,
73 struct padata_parallel_queue, work);
Steffen Klassert16295be2010-01-06 19:47:10 +110074
Dan Kruchinine15bacb2010-07-14 14:31:57 +040075 spin_lock(&pqueue->parallel.lock);
76 list_replace_init(&pqueue->parallel.list, &local_list);
77 spin_unlock(&pqueue->parallel.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +110078
79 while (!list_empty(&local_list)) {
80 struct padata_priv *padata;
81
82 padata = list_entry(local_list.next,
83 struct padata_priv, list);
84
85 list_del_init(&padata->list);
86
87 padata->parallel(padata);
88 }
89
90 local_bh_enable();
91}
92
Steffen Klassert0198ffd2010-05-19 13:44:27 +100093/**
Steffen Klassert16295be2010-01-06 19:47:10 +110094 * padata_do_parallel - padata parallelization function
95 *
96 * @pinst: padata instance
97 * @padata: object to be parallelized
98 * @cb_cpu: cpu the serialization callback function will run on,
Dan Kruchinine15bacb2010-07-14 14:31:57 +040099 * must be in the serial cpumask of padata(i.e. cpumask.cbcpu).
Steffen Klassert16295be2010-01-06 19:47:10 +1100100 *
101 * The parallelization callback function will run with BHs off.
102 * Note: Every object which is parallelized by padata_do_parallel
103 * must be seen by padata_do_serial.
104 */
105int padata_do_parallel(struct padata_instance *pinst,
106 struct padata_priv *padata, int cb_cpu)
107{
108 int target_cpu, err;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400109 struct padata_parallel_queue *queue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100110 struct parallel_data *pd;
111
112 rcu_read_lock_bh();
113
Mathias Krausec0e656b2013-11-28 19:20:05 +0100114 pd = rcu_dereference_bh(pinst->pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100115
Steffen Klassert83f619f2010-07-07 15:32:02 +0200116 err = -EINVAL;
Steffen Klassert74247132010-07-20 08:51:25 +0200117 if (!(pinst->flags & PADATA_INIT) || pinst->flags & PADATA_INVALID)
Steffen Klassert16295be2010-01-06 19:47:10 +1100118 goto out;
119
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400120 if (!cpumask_test_cpu(cb_cpu, pd->cpumask.cbcpu))
Steffen Klassert16295be2010-01-06 19:47:10 +1100121 goto out;
122
123 err = -EBUSY;
124 if ((pinst->flags & PADATA_RESET))
125 goto out;
126
127 if (atomic_read(&pd->refcnt) >= MAX_OBJ_NUM)
128 goto out;
129
Steffen Klassert83f619f2010-07-07 15:32:02 +0200130 err = 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100131 atomic_inc(&pd->refcnt);
132 padata->pd = pd;
133 padata->cb_cpu = cb_cpu;
134
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +0100135 target_cpu = padata_cpu_hash(pd);
Mathias Krause6953f88c2017-09-08 20:57:11 +0200136 padata->cpu = target_cpu;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400137 queue = per_cpu_ptr(pd->pqueue, target_cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100138
139 spin_lock(&queue->parallel.lock);
140 list_add_tail(&padata->list, &queue->parallel.list);
141 spin_unlock(&queue->parallel.lock);
142
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400143 queue_work_on(target_cpu, pinst->wq, &queue->work);
Steffen Klassert16295be2010-01-06 19:47:10 +1100144
145out:
146 rcu_read_unlock_bh();
147
148 return err;
149}
150EXPORT_SYMBOL(padata_do_parallel);
151
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000152/*
153 * padata_get_next - Get the next object that needs serialization.
154 *
155 * Return values are:
156 *
157 * A pointer to the control struct of the next object that needs
158 * serialization, if present in one of the percpu reorder queues.
159 *
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000160 * -EINPROGRESS, if the next object that needs serialization will
161 * be parallel processed by another cpu and is not yet present in
162 * the cpu's reorder queue.
163 *
164 * -ENODATA, if this cpu has to do the parallel processing for
165 * the next object.
166 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100167static struct padata_priv *padata_get_next(struct parallel_data *pd)
168{
Shan Weif0fcf202012-12-06 17:16:23 +0800169 struct padata_parallel_queue *next_queue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100170 struct padata_priv *padata;
171 struct padata_list *reorder;
Herbert Xuf5015132020-05-21 16:48:45 -0400172 int cpu = pd->cpu;
Steffen Klassert16295be2010-01-06 19:47:10 +1100173
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400174 next_queue = per_cpu_ptr(pd->pqueue, cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100175 reorder = &next_queue->reorder;
176
Jason A. Donenfeldeb8c62a2017-03-23 12:24:43 +0100177 spin_lock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100178 if (!list_empty(&reorder->list)) {
179 padata = list_entry(reorder->list.next,
180 struct padata_priv, list);
181
Steffen Klassert16295be2010-01-06 19:47:10 +1100182 list_del_init(&padata->list);
183 atomic_dec(&pd->reorder_objects);
Steffen Klassert16295be2010-01-06 19:47:10 +1100184
Herbert Xuf5015132020-05-21 16:48:45 -0400185 pd->cpu = cpumask_next_wrap(cpu, pd->cpumask.pcpu, -1,
186 false);
Steffen Klassert16295be2010-01-06 19:47:10 +1100187
Jason A. Donenfeldeb8c62a2017-03-23 12:24:43 +0100188 spin_unlock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100189 goto out;
190 }
Jason A. Donenfeldeb8c62a2017-03-23 12:24:43 +0100191 spin_unlock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100192
Shan Weif0fcf202012-12-06 17:16:23 +0800193 if (__this_cpu_read(pd->pqueue->cpu_index) == next_queue->cpu_index) {
Steffen Klassert16295be2010-01-06 19:47:10 +1100194 padata = ERR_PTR(-ENODATA);
195 goto out;
196 }
197
198 padata = ERR_PTR(-EINPROGRESS);
199out:
200 return padata;
201}
202
203static void padata_reorder(struct parallel_data *pd)
204{
Steffen Klassert30478172012-03-09 07:20:12 +0100205 int cb_cpu;
Steffen Klassert16295be2010-01-06 19:47:10 +1100206 struct padata_priv *padata;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400207 struct padata_serial_queue *squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100208 struct padata_instance *pinst = pd->pinst;
Herbert Xuf5015132020-05-21 16:48:45 -0400209 struct padata_parallel_queue *next_queue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100210
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000211 /*
212 * We need to ensure that only one cpu can work on dequeueing of
213 * the reorder queue the time. Calculating in which percpu reorder
214 * queue the next object will arrive takes some time. A spinlock
215 * would be highly contended. Also it is not clear in which order
216 * the objects arrive to the reorder queues. So a cpu could wait to
217 * get the lock just to notice that there is nothing to do at the
218 * moment. Therefore we use a trylock and let the holder of the lock
219 * care for all the objects enqueued during the holdtime of the lock.
220 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100221 if (!spin_trylock_bh(&pd->lock))
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000222 return;
Steffen Klassert16295be2010-01-06 19:47:10 +1100223
224 while (1) {
225 padata = padata_get_next(pd);
226
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000227 /*
Jason A. Donenfeld71746092017-04-12 10:40:19 +0200228 * If the next object that needs serialization is parallel
229 * processed by another cpu and is still on it's way to the
230 * cpu's reorder queue, nothing to do for now.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000231 */
Jason A. Donenfeld71746092017-04-12 10:40:19 +0200232 if (PTR_ERR(padata) == -EINPROGRESS)
Steffen Klassert16295be2010-01-06 19:47:10 +1100233 break;
234
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000235 /*
236 * This cpu has to do the parallel processing of the next
237 * object. It's waiting in the cpu's parallelization queue,
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300238 * so exit immediately.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000239 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100240 if (PTR_ERR(padata) == -ENODATA) {
241 spin_unlock_bh(&pd->lock);
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000242 return;
Steffen Klassert16295be2010-01-06 19:47:10 +1100243 }
244
Steffen Klassert30478172012-03-09 07:20:12 +0100245 cb_cpu = padata->cb_cpu;
246 squeue = per_cpu_ptr(pd->squeue, cb_cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100247
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400248 spin_lock(&squeue->serial.lock);
249 list_add_tail(&padata->list, &squeue->serial.list);
250 spin_unlock(&squeue->serial.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100251
Steffen Klassert30478172012-03-09 07:20:12 +0100252 queue_work_on(cb_cpu, pinst->wq, &squeue->work);
Steffen Klassert16295be2010-01-06 19:47:10 +1100253 }
254
255 spin_unlock_bh(&pd->lock);
256
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000257 /*
258 * The next object that needs serialization might have arrived to
Herbert Xuf5015132020-05-21 16:48:45 -0400259 * the reorder queues in the meantime.
Daniel Jordan4b414f52019-07-16 12:32:53 -0400260 *
Herbert Xuf5015132020-05-21 16:48:45 -0400261 * Ensure reorder queue is read after pd->lock is dropped so we see
262 * new objects from another task in padata_do_serial. Pairs with
Daniel Jordan4b414f52019-07-16 12:32:53 -0400263 * smp_mb__after_atomic in padata_do_serial.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000264 */
Daniel Jordan4b414f52019-07-16 12:32:53 -0400265 smp_mb();
Steffen Klassert16295be2010-01-06 19:47:10 +1100266
Herbert Xuf5015132020-05-21 16:48:45 -0400267 next_queue = per_cpu_ptr(pd->pqueue, pd->cpu);
268 if (!list_empty(&next_queue->reorder.list))
269 queue_work(pinst->wq, &pd->reorder_work);
Steffen Klassert16295be2010-01-06 19:47:10 +1100270}
271
Mathias Krause08257da2017-09-08 20:57:10 +0200272static void invoke_padata_reorder(struct work_struct *work)
273{
Mathias Krause08257da2017-09-08 20:57:10 +0200274 struct parallel_data *pd;
275
276 local_bh_disable();
Herbert Xuf5015132020-05-21 16:48:45 -0400277 pd = container_of(work, struct parallel_data, reorder_work);
Mathias Krause08257da2017-09-08 20:57:10 +0200278 padata_reorder(pd);
279 local_bh_enable();
280}
281
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400282static void padata_serial_worker(struct work_struct *serial_work)
Steffen Klassert16295be2010-01-06 19:47:10 +1100283{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400284 struct padata_serial_queue *squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100285 struct parallel_data *pd;
286 LIST_HEAD(local_list);
Herbert Xu928cf3d2019-11-19 13:17:31 +0800287 int cnt;
Steffen Klassert16295be2010-01-06 19:47:10 +1100288
289 local_bh_disable();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400290 squeue = container_of(serial_work, struct padata_serial_queue, work);
291 pd = squeue->pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100292
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400293 spin_lock(&squeue->serial.lock);
294 list_replace_init(&squeue->serial.list, &local_list);
295 spin_unlock(&squeue->serial.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100296
Herbert Xu928cf3d2019-11-19 13:17:31 +0800297 cnt = 0;
298
Steffen Klassert16295be2010-01-06 19:47:10 +1100299 while (!list_empty(&local_list)) {
300 struct padata_priv *padata;
301
302 padata = list_entry(local_list.next,
303 struct padata_priv, list);
304
305 list_del_init(&padata->list);
306
307 padata->serial(padata);
Herbert Xu928cf3d2019-11-19 13:17:31 +0800308 cnt++;
Steffen Klassert16295be2010-01-06 19:47:10 +1100309 }
310 local_bh_enable();
Herbert Xu928cf3d2019-11-19 13:17:31 +0800311
312 if (atomic_sub_and_test(cnt, &pd->refcnt))
313 padata_free_pd(pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100314}
315
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000316/**
Steffen Klassert16295be2010-01-06 19:47:10 +1100317 * padata_do_serial - padata serialization function
318 *
319 * @padata: object to be serialized.
320 *
321 * padata_do_serial must be called for every parallelized object.
322 * The serialization callback function will run with BHs off.
323 */
324void padata_do_serial(struct padata_priv *padata)
325{
Daniel Jordanbae3b502020-05-21 16:48:47 -0400326 struct parallel_data *pd = padata->pd;
327 struct padata_parallel_queue *pqueue = per_cpu_ptr(pd->pqueue,
328 padata->cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100329
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400330 spin_lock(&pqueue->reorder.lock);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400331 list_add_tail(&padata->list, &pqueue->reorder.list);
Herbert Xuf5015132020-05-21 16:48:45 -0400332 atomic_inc(&pd->reorder_objects);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400333 spin_unlock(&pqueue->reorder.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100334
Daniel Jordan4b414f52019-07-16 12:32:53 -0400335 /*
Herbert Xuf5015132020-05-21 16:48:45 -0400336 * Ensure the addition to the reorder list is ordered correctly
Daniel Jordan4b414f52019-07-16 12:32:53 -0400337 * with the trylock of pd->lock in padata_reorder. Pairs with smp_mb
338 * in padata_reorder.
339 */
340 smp_mb__after_atomic();
341
Herbert Xuf5015132020-05-21 16:48:45 -0400342 padata_reorder(pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100343}
344EXPORT_SYMBOL(padata_do_serial);
345
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400346static int padata_setup_cpumasks(struct parallel_data *pd,
347 const struct cpumask *pcpumask,
348 const struct cpumask *cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100349{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400350 if (!alloc_cpumask_var(&pd->cpumask.pcpu, GFP_KERNEL))
351 return -ENOMEM;
352
Steffen Klassert13614e02012-03-28 08:43:21 +0200353 cpumask_and(pd->cpumask.pcpu, pcpumask, cpu_online_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400354 if (!alloc_cpumask_var(&pd->cpumask.cbcpu, GFP_KERNEL)) {
Jason A. Donenfeld62403772017-04-07 02:33:30 +0200355 free_cpumask_var(pd->cpumask.pcpu);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400356 return -ENOMEM;
357 }
358
Steffen Klassert13614e02012-03-28 08:43:21 +0200359 cpumask_and(pd->cpumask.cbcpu, cbcpumask, cpu_online_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400360 return 0;
361}
362
363static void __padata_list_init(struct padata_list *pd_list)
364{
365 INIT_LIST_HEAD(&pd_list->list);
366 spin_lock_init(&pd_list->lock);
367}
368
369/* Initialize all percpu queues used by serial workers */
370static void padata_init_squeues(struct parallel_data *pd)
371{
372 int cpu;
373 struct padata_serial_queue *squeue;
374
375 for_each_cpu(cpu, pd->cpumask.cbcpu) {
376 squeue = per_cpu_ptr(pd->squeue, cpu);
377 squeue->pd = pd;
378 __padata_list_init(&squeue->serial);
379 INIT_WORK(&squeue->work, padata_serial_worker);
380 }
381}
382
383/* Initialize all percpu queues used by parallel workers */
384static void padata_init_pqueues(struct parallel_data *pd)
385{
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +0100386 int cpu_index, cpu;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400387 struct padata_parallel_queue *pqueue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100388
389 cpu_index = 0;
Mathias Krause251716d2020-05-21 16:48:44 -0400390 for_each_possible_cpu(cpu) {
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400391 pqueue = per_cpu_ptr(pd->pqueue, cpu);
Mathias Krause251716d2020-05-21 16:48:44 -0400392
393 if (!cpumask_test_cpu(cpu, pd->cpumask.pcpu)) {
394 pqueue->cpu_index = -1;
395 continue;
396 }
397
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400398 pqueue->cpu_index = cpu_index;
Steffen Klassertfad3a902010-07-20 08:48:34 +0200399 cpu_index++;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400400
401 __padata_list_init(&pqueue->reorder);
402 __padata_list_init(&pqueue->parallel);
403 INIT_WORK(&pqueue->work, padata_parallel_worker);
404 atomic_set(&pqueue->num_obj, 0);
405 }
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400406}
407
408/* Allocate and initialize the internal cpumask dependend resources. */
409static struct parallel_data *padata_alloc_pd(struct padata_instance *pinst,
410 const struct cpumask *pcpumask,
411 const struct cpumask *cbcpumask)
412{
413 struct parallel_data *pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100414
415 pd = kzalloc(sizeof(struct parallel_data), GFP_KERNEL);
416 if (!pd)
417 goto err;
418
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400419 pd->pqueue = alloc_percpu(struct padata_parallel_queue);
420 if (!pd->pqueue)
Steffen Klassert16295be2010-01-06 19:47:10 +1100421 goto err_free_pd;
422
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400423 pd->squeue = alloc_percpu(struct padata_serial_queue);
424 if (!pd->squeue)
425 goto err_free_pqueue;
426 if (padata_setup_cpumasks(pd, pcpumask, cbcpumask) < 0)
427 goto err_free_squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100428
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400429 padata_init_pqueues(pd);
430 padata_init_squeues(pd);
Mathias Krause0b6b0982013-10-25 12:14:15 +0200431 atomic_set(&pd->seq_nr, -1);
Steffen Klassert16295be2010-01-06 19:47:10 +1100432 atomic_set(&pd->reorder_objects, 0);
Herbert Xu928cf3d2019-11-19 13:17:31 +0800433 atomic_set(&pd->refcnt, 1);
Steffen Klassert16295be2010-01-06 19:47:10 +1100434 pd->pinst = pinst;
435 spin_lock_init(&pd->lock);
Daniel Jordan52a3af12020-05-21 16:48:46 -0400436 pd->cpu = cpumask_first(pd->cpumask.pcpu);
Herbert Xuf5015132020-05-21 16:48:45 -0400437 INIT_WORK(&pd->reorder_work, invoke_padata_reorder);
Steffen Klassert16295be2010-01-06 19:47:10 +1100438
439 return pd;
440
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400441err_free_squeue:
442 free_percpu(pd->squeue);
443err_free_pqueue:
444 free_percpu(pd->pqueue);
Steffen Klassert16295be2010-01-06 19:47:10 +1100445err_free_pd:
446 kfree(pd);
447err:
448 return NULL;
449}
450
451static void padata_free_pd(struct parallel_data *pd)
452{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400453 free_cpumask_var(pd->cpumask.pcpu);
454 free_cpumask_var(pd->cpumask.cbcpu);
455 free_percpu(pd->pqueue);
456 free_percpu(pd->squeue);
Steffen Klassert16295be2010-01-06 19:47:10 +1100457 kfree(pd);
458}
459
Steffen Klassert4c879172010-07-07 15:30:10 +0200460static void __padata_start(struct padata_instance *pinst)
461{
462 pinst->flags |= PADATA_INIT;
463}
464
Steffen Klassertee836552010-07-07 15:30:47 +0200465static void __padata_stop(struct padata_instance *pinst)
466{
467 if (!(pinst->flags & PADATA_INIT))
468 return;
469
470 pinst->flags &= ~PADATA_INIT;
471
472 synchronize_rcu();
Steffen Klassertee836552010-07-07 15:30:47 +0200473}
474
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300475/* Replace the internal control structure with a new one. */
Steffen Klassert16295be2010-01-06 19:47:10 +1100476static void padata_replace(struct padata_instance *pinst,
477 struct parallel_data *pd_new)
478{
479 struct parallel_data *pd_old = pinst->pd;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400480 int notification_mask = 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100481
482 pinst->flags |= PADATA_RESET;
483
484 rcu_assign_pointer(pinst->pd, pd_new);
485
486 synchronize_rcu();
487
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400488 if (!cpumask_equal(pd_old->cpumask.pcpu, pd_new->cpumask.pcpu))
489 notification_mask |= PADATA_CPU_PARALLEL;
490 if (!cpumask_equal(pd_old->cpumask.cbcpu, pd_new->cpumask.cbcpu))
491 notification_mask |= PADATA_CPU_SERIAL;
Steffen Klassert16295be2010-01-06 19:47:10 +1100492
Herbert Xu928cf3d2019-11-19 13:17:31 +0800493 if (atomic_dec_and_test(&pd_old->refcnt))
494 padata_free_pd(pd_old);
Steffen Klassert16295be2010-01-06 19:47:10 +1100495
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400496 if (notification_mask)
497 blocking_notifier_call_chain(&pinst->cpumask_change_notifier,
Steffen Klassertc6356962010-07-27 07:15:50 +0200498 notification_mask,
499 &pd_new->cpumask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400500
Steffen Klassert16295be2010-01-06 19:47:10 +1100501 pinst->flags &= ~PADATA_RESET;
502}
503
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000504/**
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400505 * padata_register_cpumask_notifier - Registers a notifier that will be called
506 * if either pcpu or cbcpu or both cpumasks change.
Steffen Klassert16295be2010-01-06 19:47:10 +1100507 *
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400508 * @pinst: A poineter to padata instance
509 * @nblock: A pointer to notifier block.
Steffen Klassert16295be2010-01-06 19:47:10 +1100510 */
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400511int padata_register_cpumask_notifier(struct padata_instance *pinst,
512 struct notifier_block *nblock)
Steffen Klassert16295be2010-01-06 19:47:10 +1100513{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400514 return blocking_notifier_chain_register(&pinst->cpumask_change_notifier,
515 nblock);
516}
517EXPORT_SYMBOL(padata_register_cpumask_notifier);
Steffen Klassert16295be2010-01-06 19:47:10 +1100518
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400519/**
520 * padata_unregister_cpumask_notifier - Unregisters cpumask notifier
521 * registered earlier using padata_register_cpumask_notifier
522 *
523 * @pinst: A pointer to data instance.
524 * @nlock: A pointer to notifier block.
525 */
526int padata_unregister_cpumask_notifier(struct padata_instance *pinst,
527 struct notifier_block *nblock)
528{
529 return blocking_notifier_chain_unregister(
530 &pinst->cpumask_change_notifier,
531 nblock);
532}
533EXPORT_SYMBOL(padata_unregister_cpumask_notifier);
Steffen Klassert16295be2010-01-06 19:47:10 +1100534
Steffen Klassert6751fb32010-04-29 14:42:30 +0200535
Steffen Klassert33e54452010-07-07 15:31:26 +0200536/* If cpumask contains no active cpu, we mark the instance as invalid. */
537static bool padata_validate_cpumask(struct padata_instance *pinst,
538 const struct cpumask *cpumask)
539{
Steffen Klassert13614e02012-03-28 08:43:21 +0200540 if (!cpumask_intersects(cpumask, cpu_online_mask)) {
Steffen Klassert33e54452010-07-07 15:31:26 +0200541 pinst->flags |= PADATA_INVALID;
542 return false;
Steffen Klassert16295be2010-01-06 19:47:10 +1100543 }
544
Steffen Klassert33e54452010-07-07 15:31:26 +0200545 pinst->flags &= ~PADATA_INVALID;
546 return true;
547}
548
Steffen Klassert65ff5772010-07-27 07:15:06 +0200549static int __padata_set_cpumasks(struct padata_instance *pinst,
550 cpumask_var_t pcpumask,
551 cpumask_var_t cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100552{
Steffen Klassert33e54452010-07-07 15:31:26 +0200553 int valid;
Steffen Klassert65ff5772010-07-27 07:15:06 +0200554 struct parallel_data *pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100555
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400556 valid = padata_validate_cpumask(pinst, pcpumask);
557 if (!valid) {
558 __padata_stop(pinst);
559 goto out_replace;
560 }
561
562 valid = padata_validate_cpumask(pinst, cbcpumask);
Steffen Klassertb89661d2010-07-20 08:49:20 +0200563 if (!valid)
Steffen Klassert33e54452010-07-07 15:31:26 +0200564 __padata_stop(pinst);
Steffen Klassert33e54452010-07-07 15:31:26 +0200565
Steffen Klassertb89661d2010-07-20 08:49:20 +0200566out_replace:
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400567 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
Steffen Klassert65ff5772010-07-27 07:15:06 +0200568 if (!pd)
569 return -ENOMEM;
Steffen Klassert16295be2010-01-06 19:47:10 +1100570
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400571 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
572 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
Steffen Klassert16295be2010-01-06 19:47:10 +1100573
574 padata_replace(pinst, pd);
575
Steffen Klassert33e54452010-07-07 15:31:26 +0200576 if (valid)
577 __padata_start(pinst);
578
Steffen Klassert65ff5772010-07-27 07:15:06 +0200579 return 0;
580}
581
582/**
Steffen Klassert65ff5772010-07-27 07:15:06 +0200583 * padata_set_cpumask: Sets specified by @cpumask_type cpumask to the value
584 * equivalent to @cpumask.
585 *
586 * @pinst: padata instance
587 * @cpumask_type: PADATA_CPU_SERIAL or PADATA_CPU_PARALLEL corresponding
588 * to parallel and serial cpumasks respectively.
589 * @cpumask: the cpumask to use
590 */
591int padata_set_cpumask(struct padata_instance *pinst, int cpumask_type,
592 cpumask_var_t cpumask)
593{
594 struct cpumask *serial_mask, *parallel_mask;
595 int err = -EINVAL;
596
Steffen Klassert65ff5772010-07-27 07:15:06 +0200597 get_online_cpus();
Daniel Jordanb1d47d72019-12-03 14:31:11 -0500598 mutex_lock(&pinst->lock);
Steffen Klassert65ff5772010-07-27 07:15:06 +0200599
600 switch (cpumask_type) {
601 case PADATA_CPU_PARALLEL:
602 serial_mask = pinst->cpumask.cbcpu;
603 parallel_mask = cpumask;
604 break;
605 case PADATA_CPU_SERIAL:
606 parallel_mask = pinst->cpumask.pcpu;
607 serial_mask = cpumask;
608 break;
609 default:
610 goto out;
611 }
612
613 err = __padata_set_cpumasks(pinst, parallel_mask, serial_mask);
614
Steffen Klassert16295be2010-01-06 19:47:10 +1100615out:
616 mutex_unlock(&pinst->lock);
Daniel Jordanb1d47d72019-12-03 14:31:11 -0500617 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100618
619 return err;
620}
621EXPORT_SYMBOL(padata_set_cpumask);
622
Arnd Bergmann19d795b2016-05-19 17:09:59 -0700623/**
624 * padata_start - start the parallel processing
625 *
626 * @pinst: padata instance to start
627 */
628int padata_start(struct padata_instance *pinst)
629{
630 int err = 0;
631
632 mutex_lock(&pinst->lock);
633
634 if (pinst->flags & PADATA_INVALID)
635 err = -EINVAL;
636
637 __padata_start(pinst);
638
639 mutex_unlock(&pinst->lock);
640
641 return err;
642}
643EXPORT_SYMBOL(padata_start);
644
645/**
646 * padata_stop - stop the parallel processing
647 *
648 * @pinst: padata instance to stop
649 */
650void padata_stop(struct padata_instance *pinst)
651{
652 mutex_lock(&pinst->lock);
653 __padata_stop(pinst);
654 mutex_unlock(&pinst->lock);
655}
656EXPORT_SYMBOL(padata_stop);
657
658#ifdef CONFIG_HOTPLUG_CPU
659
Steffen Klassert16295be2010-01-06 19:47:10 +1100660static int __padata_add_cpu(struct padata_instance *pinst, int cpu)
661{
662 struct parallel_data *pd;
663
Steffen Klassert13614e02012-03-28 08:43:21 +0200664 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400665 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
666 pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100667 if (!pd)
668 return -ENOMEM;
669
670 padata_replace(pinst, pd);
Steffen Klassert33e54452010-07-07 15:31:26 +0200671
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400672 if (padata_validate_cpumask(pinst, pinst->cpumask.pcpu) &&
673 padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
Steffen Klassert33e54452010-07-07 15:31:26 +0200674 __padata_start(pinst);
Steffen Klassert16295be2010-01-06 19:47:10 +1100675 }
676
677 return 0;
678}
679
Steffen Klassert16295be2010-01-06 19:47:10 +1100680static int __padata_remove_cpu(struct padata_instance *pinst, int cpu)
681{
Steffen Klassert33e54452010-07-07 15:31:26 +0200682 struct parallel_data *pd = NULL;
Steffen Klassert16295be2010-01-06 19:47:10 +1100683
684 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
Steffen Klassert33e54452010-07-07 15:31:26 +0200685
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400686 if (!padata_validate_cpumask(pinst, pinst->cpumask.pcpu) ||
Steffen Klassertb89661d2010-07-20 08:49:20 +0200687 !padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
Steffen Klassert33e54452010-07-07 15:31:26 +0200688 __padata_stop(pinst);
Steffen Klassert33e54452010-07-07 15:31:26 +0200689
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400690 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
691 pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100692 if (!pd)
693 return -ENOMEM;
694
695 padata_replace(pinst, pd);
Steffen Klassert96120902012-03-28 08:44:07 +0200696
697 cpumask_clear_cpu(cpu, pd->cpumask.cbcpu);
698 cpumask_clear_cpu(cpu, pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100699 }
700
701 return 0;
702}
703
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400704 /**
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300705 * padata_remove_cpu - remove a cpu from the one or both(serial and parallel)
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400706 * padata cpumasks.
Steffen Klassert16295be2010-01-06 19:47:10 +1100707 *
708 * @pinst: padata instance
709 * @cpu: cpu to remove
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400710 * @mask: bitmask specifying from which cpumask @cpu should be removed
711 * The @mask may be any combination of the following flags:
712 * PADATA_CPU_SERIAL - serial cpumask
713 * PADATA_CPU_PARALLEL - parallel cpumask
Steffen Klassert16295be2010-01-06 19:47:10 +1100714 */
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400715int padata_remove_cpu(struct padata_instance *pinst, int cpu, int mask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100716{
717 int err;
718
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400719 if (!(mask & (PADATA_CPU_SERIAL | PADATA_CPU_PARALLEL)))
720 return -EINVAL;
721
Steffen Klassert16295be2010-01-06 19:47:10 +1100722 mutex_lock(&pinst->lock);
723
Steffen Klassert6751fb32010-04-29 14:42:30 +0200724 get_online_cpus();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400725 if (mask & PADATA_CPU_SERIAL)
726 cpumask_clear_cpu(cpu, pinst->cpumask.cbcpu);
727 if (mask & PADATA_CPU_PARALLEL)
728 cpumask_clear_cpu(cpu, pinst->cpumask.pcpu);
729
Steffen Klassert16295be2010-01-06 19:47:10 +1100730 err = __padata_remove_cpu(pinst, cpu);
Steffen Klassert6751fb32010-04-29 14:42:30 +0200731 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100732
733 mutex_unlock(&pinst->lock);
734
735 return err;
736}
737EXPORT_SYMBOL(padata_remove_cpu);
738
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400739static inline int pinst_has_cpu(struct padata_instance *pinst, int cpu)
740{
741 return cpumask_test_cpu(cpu, pinst->cpumask.pcpu) ||
742 cpumask_test_cpu(cpu, pinst->cpumask.cbcpu);
743}
744
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200745static int padata_cpu_online(unsigned int cpu, struct hlist_node *node)
Steffen Klassert16295be2010-01-06 19:47:10 +1100746{
Steffen Klassert16295be2010-01-06 19:47:10 +1100747 struct padata_instance *pinst;
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200748 int ret;
Steffen Klassert16295be2010-01-06 19:47:10 +1100749
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200750 pinst = hlist_entry_safe(node, struct padata_instance, node);
751 if (!pinst_has_cpu(pinst, cpu))
752 return 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100753
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200754 mutex_lock(&pinst->lock);
755 ret = __padata_add_cpu(pinst, cpu);
756 mutex_unlock(&pinst->lock);
757 return ret;
Steffen Klassert16295be2010-01-06 19:47:10 +1100758}
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200759
760static int padata_cpu_prep_down(unsigned int cpu, struct hlist_node *node)
761{
762 struct padata_instance *pinst;
763 int ret;
764
765 pinst = hlist_entry_safe(node, struct padata_instance, node);
766 if (!pinst_has_cpu(pinst, cpu))
767 return 0;
768
769 mutex_lock(&pinst->lock);
770 ret = __padata_remove_cpu(pinst, cpu);
771 mutex_unlock(&pinst->lock);
772 return ret;
773}
774
775static enum cpuhp_state hp_online;
Steffen Klasserte2cb2f12010-04-29 14:40:10 +0200776#endif
Steffen Klassert16295be2010-01-06 19:47:10 +1100777
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400778static void __padata_free(struct padata_instance *pinst)
779{
780#ifdef CONFIG_HOTPLUG_CPU
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200781 cpuhp_state_remove_instance_nocalls(hp_online, &pinst->node);
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400782#endif
783
784 padata_stop(pinst);
785 padata_free_pd(pinst->pd);
786 free_cpumask_var(pinst->cpumask.pcpu);
787 free_cpumask_var(pinst->cpumask.cbcpu);
788 kfree(pinst);
789}
790
791#define kobj2pinst(_kobj) \
792 container_of(_kobj, struct padata_instance, kobj)
793#define attr2pentry(_attr) \
794 container_of(_attr, struct padata_sysfs_entry, attr)
795
796static void padata_sysfs_release(struct kobject *kobj)
797{
798 struct padata_instance *pinst = kobj2pinst(kobj);
799 __padata_free(pinst);
800}
801
802struct padata_sysfs_entry {
803 struct attribute attr;
804 ssize_t (*show)(struct padata_instance *, struct attribute *, char *);
805 ssize_t (*store)(struct padata_instance *, struct attribute *,
806 const char *, size_t);
807};
808
809static ssize_t show_cpumask(struct padata_instance *pinst,
810 struct attribute *attr, char *buf)
811{
812 struct cpumask *cpumask;
813 ssize_t len;
814
815 mutex_lock(&pinst->lock);
816 if (!strcmp(attr->name, "serial_cpumask"))
817 cpumask = pinst->cpumask.cbcpu;
818 else
819 cpumask = pinst->cpumask.pcpu;
820
Tejun Heo4497da62015-02-13 14:38:05 -0800821 len = snprintf(buf, PAGE_SIZE, "%*pb\n",
822 nr_cpu_ids, cpumask_bits(cpumask));
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400823 mutex_unlock(&pinst->lock);
Tejun Heo4497da62015-02-13 14:38:05 -0800824 return len < PAGE_SIZE ? len : -EINVAL;
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400825}
826
827static ssize_t store_cpumask(struct padata_instance *pinst,
828 struct attribute *attr,
829 const char *buf, size_t count)
830{
831 cpumask_var_t new_cpumask;
832 ssize_t ret;
833 int mask_type;
834
835 if (!alloc_cpumask_var(&new_cpumask, GFP_KERNEL))
836 return -ENOMEM;
837
838 ret = bitmap_parse(buf, count, cpumask_bits(new_cpumask),
839 nr_cpumask_bits);
840 if (ret < 0)
841 goto out;
842
843 mask_type = !strcmp(attr->name, "serial_cpumask") ?
844 PADATA_CPU_SERIAL : PADATA_CPU_PARALLEL;
845 ret = padata_set_cpumask(pinst, mask_type, new_cpumask);
846 if (!ret)
847 ret = count;
848
849out:
850 free_cpumask_var(new_cpumask);
851 return ret;
852}
853
854#define PADATA_ATTR_RW(_name, _show_name, _store_name) \
855 static struct padata_sysfs_entry _name##_attr = \
856 __ATTR(_name, 0644, _show_name, _store_name)
857#define PADATA_ATTR_RO(_name, _show_name) \
858 static struct padata_sysfs_entry _name##_attr = \
859 __ATTR(_name, 0400, _show_name, NULL)
860
861PADATA_ATTR_RW(serial_cpumask, show_cpumask, store_cpumask);
862PADATA_ATTR_RW(parallel_cpumask, show_cpumask, store_cpumask);
863
864/*
865 * Padata sysfs provides the following objects:
866 * serial_cpumask [RW] - cpumask for serial workers
867 * parallel_cpumask [RW] - cpumask for parallel workers
Steffen Klassert16295be2010-01-06 19:47:10 +1100868 */
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400869static struct attribute *padata_default_attrs[] = {
870 &serial_cpumask_attr.attr,
871 &parallel_cpumask_attr.attr,
872 NULL,
873};
874
875static ssize_t padata_sysfs_show(struct kobject *kobj,
876 struct attribute *attr, char *buf)
Steffen Klassert16295be2010-01-06 19:47:10 +1100877{
Steffen Klassert16295be2010-01-06 19:47:10 +1100878 struct padata_instance *pinst;
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400879 struct padata_sysfs_entry *pentry;
880 ssize_t ret = -EIO;
881
882 pinst = kobj2pinst(kobj);
883 pentry = attr2pentry(attr);
884 if (pentry->show)
885 ret = pentry->show(pinst, attr, buf);
886
887 return ret;
888}
889
890static ssize_t padata_sysfs_store(struct kobject *kobj, struct attribute *attr,
891 const char *buf, size_t count)
892{
893 struct padata_instance *pinst;
894 struct padata_sysfs_entry *pentry;
895 ssize_t ret = -EIO;
896
897 pinst = kobj2pinst(kobj);
898 pentry = attr2pentry(attr);
899 if (pentry->show)
900 ret = pentry->store(pinst, attr, buf, count);
901
902 return ret;
903}
904
905static const struct sysfs_ops padata_sysfs_ops = {
906 .show = padata_sysfs_show,
907 .store = padata_sysfs_store,
908};
909
910static struct kobj_type padata_attr_type = {
911 .sysfs_ops = &padata_sysfs_ops,
912 .default_attrs = padata_default_attrs,
913 .release = padata_sysfs_release,
914};
915
Steffen Klassert16295be2010-01-06 19:47:10 +1100916/**
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200917 * padata_alloc_possible - Allocate and initialize padata instance.
918 * Use the cpu_possible_mask for serial and
919 * parallel workers.
Steffen Klassert16295be2010-01-06 19:47:10 +1100920 *
Steffen Klassert16295be2010-01-06 19:47:10 +1100921 * @wq: workqueue to use for the allocated padata instance
922 */
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200923struct padata_instance *padata_alloc_possible(struct workqueue_struct *wq)
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400924{
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200925 return padata_alloc(wq, cpu_possible_mask, cpu_possible_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400926}
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200927EXPORT_SYMBOL(padata_alloc_possible);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400928
929/**
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200930 * padata_alloc - allocate and initialize a padata instance and specify
931 * cpumasks for serial and parallel workers.
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400932 *
933 * @wq: workqueue to use for the allocated padata instance
934 * @pcpumask: cpumask that will be used for padata parallelization
935 * @cbcpumask: cpumask that will be used for padata serialization
936 */
Steffen Klasserte6cc1172010-07-27 07:14:28 +0200937struct padata_instance *padata_alloc(struct workqueue_struct *wq,
938 const struct cpumask *pcpumask,
939 const struct cpumask *cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100940{
941 struct padata_instance *pinst;
Steffen Klassert33e54452010-07-07 15:31:26 +0200942 struct parallel_data *pd = NULL;
Steffen Klassert16295be2010-01-06 19:47:10 +1100943
944 pinst = kzalloc(sizeof(struct padata_instance), GFP_KERNEL);
945 if (!pinst)
946 goto err;
947
Steffen Klassert6751fb32010-04-29 14:42:30 +0200948 get_online_cpus();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400949 if (!alloc_cpumask_var(&pinst->cpumask.pcpu, GFP_KERNEL))
Steffen Klassert16295be2010-01-06 19:47:10 +1100950 goto err_free_inst;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400951 if (!alloc_cpumask_var(&pinst->cpumask.cbcpu, GFP_KERNEL)) {
952 free_cpumask_var(pinst->cpumask.pcpu);
953 goto err_free_inst;
Steffen Klassert33e54452010-07-07 15:31:26 +0200954 }
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400955 if (!padata_validate_cpumask(pinst, pcpumask) ||
956 !padata_validate_cpumask(pinst, cbcpumask))
957 goto err_free_masks;
Steffen Klassert16295be2010-01-06 19:47:10 +1100958
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400959 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
960 if (!pd)
961 goto err_free_masks;
Steffen Klassert74781382010-03-04 13:30:22 +0800962
Steffen Klassert16295be2010-01-06 19:47:10 +1100963 rcu_assign_pointer(pinst->pd, pd);
964
965 pinst->wq = wq;
966
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400967 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
968 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
Steffen Klassert16295be2010-01-06 19:47:10 +1100969
970 pinst->flags = 0;
971
Steffen Klassert6751fb32010-04-29 14:42:30 +0200972 put_online_cpus();
973
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400974 BLOCKING_INIT_NOTIFIER_HEAD(&pinst->cpumask_change_notifier);
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400975 kobject_init(&pinst->kobj, &padata_attr_type);
Steffen Klassert16295be2010-01-06 19:47:10 +1100976 mutex_init(&pinst->lock);
977
Richard Weinbergerb8b4a412013-08-23 13:12:33 +0200978#ifdef CONFIG_HOTPLUG_CPU
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +0200979 cpuhp_state_add_instance_nocalls(hp_online, &pinst->node);
Richard Weinbergerb8b4a412013-08-23 13:12:33 +0200980#endif
Steffen Klassert16295be2010-01-06 19:47:10 +1100981 return pinst;
982
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400983err_free_masks:
984 free_cpumask_var(pinst->cpumask.pcpu);
985 free_cpumask_var(pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100986err_free_inst:
987 kfree(pinst);
Steffen Klassert6751fb32010-04-29 14:42:30 +0200988 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100989err:
990 return NULL;
991}
Steffen Klassert16295be2010-01-06 19:47:10 +1100992
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000993/**
Steffen Klassert16295be2010-01-06 19:47:10 +1100994 * padata_free - free a padata instance
995 *
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000996 * @padata_inst: padata instance to free
Steffen Klassert16295be2010-01-06 19:47:10 +1100997 */
998void padata_free(struct padata_instance *pinst)
999{
Dan Kruchinin5e017dc2010-07-14 14:33:08 +04001000 kobject_put(&pinst->kobj);
Steffen Klassert16295be2010-01-06 19:47:10 +11001001}
1002EXPORT_SYMBOL(padata_free);
Sebastian Andrzej Siewior30e92152016-09-06 19:04:49 +02001003
1004#ifdef CONFIG_HOTPLUG_CPU
1005
1006static __init int padata_driver_init(void)
1007{
1008 int ret;
1009
1010 ret = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, "padata:online",
1011 padata_cpu_online,
1012 padata_cpu_prep_down);
1013 if (ret < 0)
1014 return ret;
1015 hp_online = ret;
1016 return 0;
1017}
1018module_init(padata_driver_init);
1019
1020static __exit void padata_driver_exit(void)
1021{
1022 cpuhp_remove_multi_state(hp_online);
1023}
1024module_exit(padata_driver_exit);
1025#endif