blob: 8aef48c3267b337c282558e8d026714f432a2d75 [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>
33
Steffen Klassert97e3d942010-04-29 14:37:32 +020034#define MAX_OBJ_NUM 1000
Steffen Klassert16295be2010-01-06 19:47:10 +110035
Herbert Xu7a2ccb62019-11-19 13:17:31 +080036static void padata_free_pd(struct parallel_data *pd);
37
Steffen Klassert16295be2010-01-06 19:47:10 +110038static int padata_index_to_cpu(struct parallel_data *pd, int cpu_index)
39{
40 int cpu, target_cpu;
41
Dan Kruchinine15bacb2010-07-14 14:31:57 +040042 target_cpu = cpumask_first(pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110043 for (cpu = 0; cpu < cpu_index; cpu++)
Dan Kruchinine15bacb2010-07-14 14:31:57 +040044 target_cpu = cpumask_next(target_cpu, pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110045
46 return target_cpu;
47}
48
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +010049static int padata_cpu_hash(struct parallel_data *pd)
Steffen Klassert16295be2010-01-06 19:47:10 +110050{
Mathias Krause0b6b0982013-10-25 12:14:15 +020051 unsigned int seq_nr;
Steffen Klassert16295be2010-01-06 19:47:10 +110052 int cpu_index;
Steffen Klassert16295be2010-01-06 19:47:10 +110053
54 /*
55 * Hash the sequence numbers to the cpus by taking
56 * seq_nr mod. number of cpus in use.
57 */
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +010058
Mathias Krause0b6b0982013-10-25 12:14:15 +020059 seq_nr = atomic_inc_return(&pd->seq_nr);
60 cpu_index = seq_nr % cpumask_weight(pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +110061
62 return padata_index_to_cpu(pd, cpu_index);
63}
64
Dan Kruchinine15bacb2010-07-14 14:31:57 +040065static void padata_parallel_worker(struct work_struct *parallel_work)
Steffen Klassert16295be2010-01-06 19:47:10 +110066{
Dan Kruchinine15bacb2010-07-14 14:31:57 +040067 struct padata_parallel_queue *pqueue;
Steffen Klassert16295be2010-01-06 19:47:10 +110068 LIST_HEAD(local_list);
69
70 local_bh_disable();
Dan Kruchinine15bacb2010-07-14 14:31:57 +040071 pqueue = container_of(parallel_work,
72 struct padata_parallel_queue, work);
Steffen Klassert16295be2010-01-06 19:47:10 +110073
Dan Kruchinine15bacb2010-07-14 14:31:57 +040074 spin_lock(&pqueue->parallel.lock);
75 list_replace_init(&pqueue->parallel.list, &local_list);
76 spin_unlock(&pqueue->parallel.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +110077
78 while (!list_empty(&local_list)) {
79 struct padata_priv *padata;
80
81 padata = list_entry(local_list.next,
82 struct padata_priv, list);
83
84 list_del_init(&padata->list);
85
86 padata->parallel(padata);
87 }
88
89 local_bh_enable();
90}
91
Steffen Klassert0198ffd2010-05-19 13:44:27 +100092/**
Steffen Klassert16295be2010-01-06 19:47:10 +110093 * padata_do_parallel - padata parallelization function
94 *
95 * @pinst: padata instance
96 * @padata: object to be parallelized
97 * @cb_cpu: cpu the serialization callback function will run on,
Dan Kruchinine15bacb2010-07-14 14:31:57 +040098 * must be in the serial cpumask of padata(i.e. cpumask.cbcpu).
Steffen Klassert16295be2010-01-06 19:47:10 +110099 *
100 * The parallelization callback function will run with BHs off.
101 * Note: Every object which is parallelized by padata_do_parallel
102 * must be seen by padata_do_serial.
103 */
104int padata_do_parallel(struct padata_instance *pinst,
105 struct padata_priv *padata, int cb_cpu)
106{
107 int target_cpu, err;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400108 struct padata_parallel_queue *queue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100109 struct parallel_data *pd;
110
111 rcu_read_lock_bh();
112
Mathias Krausec0e656b2013-11-28 19:20:05 +0100113 pd = rcu_dereference_bh(pinst->pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100114
Steffen Klassert83f619f2010-07-07 15:32:02 +0200115 err = -EINVAL;
Steffen Klassert74247132010-07-20 08:51:25 +0200116 if (!(pinst->flags & PADATA_INIT) || pinst->flags & PADATA_INVALID)
Steffen Klassert16295be2010-01-06 19:47:10 +1100117 goto out;
118
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400119 if (!cpumask_test_cpu(cb_cpu, pd->cpumask.cbcpu))
Steffen Klassert16295be2010-01-06 19:47:10 +1100120 goto out;
121
122 err = -EBUSY;
123 if ((pinst->flags & PADATA_RESET))
124 goto out;
125
126 if (atomic_read(&pd->refcnt) >= MAX_OBJ_NUM)
127 goto out;
128
Steffen Klassert83f619f2010-07-07 15:32:02 +0200129 err = 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100130 atomic_inc(&pd->refcnt);
131 padata->pd = pd;
132 padata->cb_cpu = cb_cpu;
133
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +0100134 target_cpu = padata_cpu_hash(pd);
Mathias Krause3c74e592017-09-08 20:57:11 +0200135 padata->cpu = target_cpu;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400136 queue = per_cpu_ptr(pd->pqueue, target_cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100137
138 spin_lock(&queue->parallel.lock);
139 list_add_tail(&padata->list, &queue->parallel.list);
140 spin_unlock(&queue->parallel.lock);
141
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400142 queue_work_on(target_cpu, pinst->wq, &queue->work);
Steffen Klassert16295be2010-01-06 19:47:10 +1100143
144out:
145 rcu_read_unlock_bh();
146
147 return err;
148}
149EXPORT_SYMBOL(padata_do_parallel);
150
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000151/*
152 * padata_get_next - Get the next object that needs serialization.
153 *
154 * Return values are:
155 *
156 * A pointer to the control struct of the next object that needs
157 * serialization, if present in one of the percpu reorder queues.
158 *
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000159 * -EINPROGRESS, if the next object that needs serialization will
160 * be parallel processed by another cpu and is not yet present in
161 * the cpu's reorder queue.
162 *
163 * -ENODATA, if this cpu has to do the parallel processing for
164 * the next object.
165 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100166static struct padata_priv *padata_get_next(struct parallel_data *pd)
167{
Steffen Klassert5f1a8c12010-07-07 15:32:39 +0200168 int cpu, num_cpus;
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +0100169 unsigned int next_nr, next_index;
Shan Weif0fcf202012-12-06 17:16:23 +0800170 struct padata_parallel_queue *next_queue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100171 struct padata_priv *padata;
172 struct padata_list *reorder;
173
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400174 num_cpus = cpumask_weight(pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100175
Steffen Klassert5f1a8c12010-07-07 15:32:39 +0200176 /*
177 * Calculate the percpu reorder queue and the sequence
178 * number of the next object.
179 */
180 next_nr = pd->processed;
181 next_index = next_nr % num_cpus;
182 cpu = padata_index_to_cpu(pd, next_index);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400183 next_queue = per_cpu_ptr(pd->pqueue, cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100184
Steffen Klassert16295be2010-01-06 19:47:10 +1100185 reorder = &next_queue->reorder;
186
Jason A. Donenfeld84bd21a2017-03-23 12:24:43 +0100187 spin_lock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100188 if (!list_empty(&reorder->list)) {
189 padata = list_entry(reorder->list.next,
190 struct padata_priv, list);
191
Steffen Klassert16295be2010-01-06 19:47:10 +1100192 list_del_init(&padata->list);
193 atomic_dec(&pd->reorder_objects);
Steffen Klassert16295be2010-01-06 19:47:10 +1100194
Steffen Klassert5f1a8c12010-07-07 15:32:39 +0200195 pd->processed++;
Steffen Klassert16295be2010-01-06 19:47:10 +1100196
Jason A. Donenfeld84bd21a2017-03-23 12:24:43 +0100197 spin_unlock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100198 goto out;
199 }
Jason A. Donenfeld84bd21a2017-03-23 12:24:43 +0100200 spin_unlock(&reorder->lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100201
Shan Weif0fcf202012-12-06 17:16:23 +0800202 if (__this_cpu_read(pd->pqueue->cpu_index) == next_queue->cpu_index) {
Steffen Klassert16295be2010-01-06 19:47:10 +1100203 padata = ERR_PTR(-ENODATA);
204 goto out;
205 }
206
207 padata = ERR_PTR(-EINPROGRESS);
208out:
209 return padata;
210}
211
212static void padata_reorder(struct parallel_data *pd)
213{
Steffen Klassert30478172012-03-09 07:20:12 +0100214 int cb_cpu;
Steffen Klassert16295be2010-01-06 19:47:10 +1100215 struct padata_priv *padata;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400216 struct padata_serial_queue *squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100217 struct padata_instance *pinst = pd->pinst;
218
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000219 /*
220 * We need to ensure that only one cpu can work on dequeueing of
221 * the reorder queue the time. Calculating in which percpu reorder
222 * queue the next object will arrive takes some time. A spinlock
223 * would be highly contended. Also it is not clear in which order
224 * the objects arrive to the reorder queues. So a cpu could wait to
225 * get the lock just to notice that there is nothing to do at the
226 * moment. Therefore we use a trylock and let the holder of the lock
227 * care for all the objects enqueued during the holdtime of the lock.
228 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100229 if (!spin_trylock_bh(&pd->lock))
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000230 return;
Steffen Klassert16295be2010-01-06 19:47:10 +1100231
232 while (1) {
233 padata = padata_get_next(pd);
234
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000235 /*
Jason A. Donenfelda46bec62017-04-12 10:40:19 +0200236 * If the next object that needs serialization is parallel
237 * processed by another cpu and is still on it's way to the
238 * cpu's reorder queue, nothing to do for now.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000239 */
Jason A. Donenfelda46bec62017-04-12 10:40:19 +0200240 if (PTR_ERR(padata) == -EINPROGRESS)
Steffen Klassert16295be2010-01-06 19:47:10 +1100241 break;
242
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000243 /*
244 * This cpu has to do the parallel processing of the next
245 * object. It's waiting in the cpu's parallelization queue,
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300246 * so exit immediately.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000247 */
Steffen Klassert16295be2010-01-06 19:47:10 +1100248 if (PTR_ERR(padata) == -ENODATA) {
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000249 del_timer(&pd->timer);
Steffen Klassert16295be2010-01-06 19:47:10 +1100250 spin_unlock_bh(&pd->lock);
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000251 return;
Steffen Klassert16295be2010-01-06 19:47:10 +1100252 }
253
Steffen Klassert30478172012-03-09 07:20:12 +0100254 cb_cpu = padata->cb_cpu;
255 squeue = per_cpu_ptr(pd->squeue, cb_cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100256
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400257 spin_lock(&squeue->serial.lock);
258 list_add_tail(&padata->list, &squeue->serial.list);
259 spin_unlock(&squeue->serial.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100260
Steffen Klassert30478172012-03-09 07:20:12 +0100261 queue_work_on(cb_cpu, pinst->wq, &squeue->work);
Steffen Klassert16295be2010-01-06 19:47:10 +1100262 }
263
264 spin_unlock_bh(&pd->lock);
265
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000266 /*
267 * The next object that needs serialization might have arrived to
268 * the reorder queues in the meantime, we will be called again
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300269 * from the timer function if no one else cares for it.
Daniel Jordane5899602019-07-16 12:32:53 -0400270 *
271 * Ensure reorder_objects is read after pd->lock is dropped so we see
272 * an increment from another task in padata_do_serial. Pairs with
273 * smp_mb__after_atomic in padata_do_serial.
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000274 */
Daniel Jordane5899602019-07-16 12:32:53 -0400275 smp_mb();
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000276 if (atomic_read(&pd->reorder_objects)
277 && !(pinst->flags & PADATA_RESET))
278 mod_timer(&pd->timer, jiffies + HZ);
279 else
280 del_timer(&pd->timer);
Steffen Klassert16295be2010-01-06 19:47:10 +1100281
Steffen Klassert16295be2010-01-06 19:47:10 +1100282 return;
283}
284
Mathias Krausef4fb6f12017-09-08 20:57:10 +0200285static void invoke_padata_reorder(struct work_struct *work)
286{
287 struct padata_parallel_queue *pqueue;
288 struct parallel_data *pd;
289
290 local_bh_disable();
291 pqueue = container_of(work, struct padata_parallel_queue, reorder_work);
292 pd = pqueue->pd;
293 padata_reorder(pd);
294 local_bh_enable();
295}
296
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000297static void padata_reorder_timer(unsigned long arg)
298{
299 struct parallel_data *pd = (struct parallel_data *)arg;
Mathias Krausef4fb6f12017-09-08 20:57:10 +0200300 unsigned int weight;
301 int target_cpu, cpu;
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000302
Mathias Krausef4fb6f12017-09-08 20:57:10 +0200303 cpu = get_cpu();
304
305 /* We don't lock pd here to not interfere with parallel processing
306 * padata_reorder() calls on other CPUs. We just need any CPU out of
307 * the cpumask.pcpu set. It would be nice if it's the right one but
308 * it doesn't matter if we're off to the next one by using an outdated
309 * pd->processed value.
310 */
311 weight = cpumask_weight(pd->cpumask.pcpu);
312 target_cpu = padata_index_to_cpu(pd, pd->processed % weight);
313
314 /* ensure to call the reorder callback on the correct CPU */
315 if (cpu != target_cpu) {
316 struct padata_parallel_queue *pqueue;
317 struct padata_instance *pinst;
318
319 /* The timer function is serialized wrt itself -- no locking
320 * needed.
321 */
322 pinst = pd->pinst;
323 pqueue = per_cpu_ptr(pd->pqueue, target_cpu);
324 queue_work_on(target_cpu, pinst->wq, &pqueue->reorder_work);
325 } else {
326 padata_reorder(pd);
327 }
328
329 put_cpu();
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000330}
331
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400332static void padata_serial_worker(struct work_struct *serial_work)
Steffen Klassert16295be2010-01-06 19:47:10 +1100333{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400334 struct padata_serial_queue *squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100335 struct parallel_data *pd;
336 LIST_HEAD(local_list);
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800337 int cnt;
Steffen Klassert16295be2010-01-06 19:47:10 +1100338
339 local_bh_disable();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400340 squeue = container_of(serial_work, struct padata_serial_queue, work);
341 pd = squeue->pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100342
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400343 spin_lock(&squeue->serial.lock);
344 list_replace_init(&squeue->serial.list, &local_list);
345 spin_unlock(&squeue->serial.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100346
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800347 cnt = 0;
348
Steffen Klassert16295be2010-01-06 19:47:10 +1100349 while (!list_empty(&local_list)) {
350 struct padata_priv *padata;
351
352 padata = list_entry(local_list.next,
353 struct padata_priv, list);
354
355 list_del_init(&padata->list);
356
357 padata->serial(padata);
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800358 cnt++;
Steffen Klassert16295be2010-01-06 19:47:10 +1100359 }
360 local_bh_enable();
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800361
362 if (atomic_sub_and_test(cnt, &pd->refcnt))
363 padata_free_pd(pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100364}
365
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000366/**
Steffen Klassert16295be2010-01-06 19:47:10 +1100367 * padata_do_serial - padata serialization function
368 *
369 * @padata: object to be serialized.
370 *
371 * padata_do_serial must be called for every parallelized object.
372 * The serialization callback function will run with BHs off.
373 */
374void padata_do_serial(struct padata_priv *padata)
375{
376 int cpu;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400377 struct padata_parallel_queue *pqueue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100378 struct parallel_data *pd;
Mathias Krause3c74e592017-09-08 20:57:11 +0200379 int reorder_via_wq = 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100380
381 pd = padata->pd;
382
383 cpu = get_cpu();
Mathias Krause3c74e592017-09-08 20:57:11 +0200384
385 /* We need to run on the same CPU padata_do_parallel(.., padata, ..)
386 * was called on -- or, at least, enqueue the padata object into the
387 * correct per-cpu queue.
388 */
389 if (cpu != padata->cpu) {
390 reorder_via_wq = 1;
391 cpu = padata->cpu;
392 }
393
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400394 pqueue = per_cpu_ptr(pd->pqueue, cpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100395
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400396 spin_lock(&pqueue->reorder.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100397 atomic_inc(&pd->reorder_objects);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400398 list_add_tail(&padata->list, &pqueue->reorder.list);
399 spin_unlock(&pqueue->reorder.lock);
Steffen Klassert16295be2010-01-06 19:47:10 +1100400
Daniel Jordane5899602019-07-16 12:32:53 -0400401 /*
402 * Ensure the atomic_inc of reorder_objects above is ordered correctly
403 * with the trylock of pd->lock in padata_reorder. Pairs with smp_mb
404 * in padata_reorder.
405 */
406 smp_mb__after_atomic();
407
Steffen Klassert16295be2010-01-06 19:47:10 +1100408 put_cpu();
409
Mathias Krause3c74e592017-09-08 20:57:11 +0200410 /* If we're running on the wrong CPU, call padata_reorder() via a
411 * kernel worker.
412 */
413 if (reorder_via_wq)
414 queue_work_on(cpu, pd->pinst->wq, &pqueue->reorder_work);
415 else
416 padata_reorder(pd);
Steffen Klassert16295be2010-01-06 19:47:10 +1100417}
418EXPORT_SYMBOL(padata_do_serial);
419
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400420static int padata_setup_cpumasks(struct parallel_data *pd,
421 const struct cpumask *pcpumask,
422 const struct cpumask *cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100423{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400424 if (!alloc_cpumask_var(&pd->cpumask.pcpu, GFP_KERNEL))
425 return -ENOMEM;
426
Steffen Klassert13614e02012-03-28 08:43:21 +0200427 cpumask_and(pd->cpumask.pcpu, pcpumask, cpu_online_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400428 if (!alloc_cpumask_var(&pd->cpumask.cbcpu, GFP_KERNEL)) {
Jason A. Donenfeldf08bc4d2017-04-07 02:33:30 +0200429 free_cpumask_var(pd->cpumask.pcpu);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400430 return -ENOMEM;
431 }
432
Steffen Klassert13614e02012-03-28 08:43:21 +0200433 cpumask_and(pd->cpumask.cbcpu, cbcpumask, cpu_online_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400434 return 0;
435}
436
437static void __padata_list_init(struct padata_list *pd_list)
438{
439 INIT_LIST_HEAD(&pd_list->list);
440 spin_lock_init(&pd_list->lock);
441}
442
443/* Initialize all percpu queues used by serial workers */
444static void padata_init_squeues(struct parallel_data *pd)
445{
446 int cpu;
447 struct padata_serial_queue *squeue;
448
449 for_each_cpu(cpu, pd->cpumask.cbcpu) {
450 squeue = per_cpu_ptr(pd->squeue, cpu);
451 squeue->pd = pd;
452 __padata_list_init(&squeue->serial);
453 INIT_WORK(&squeue->work, padata_serial_worker);
454 }
455}
456
457/* Initialize all percpu queues used by parallel workers */
458static void padata_init_pqueues(struct parallel_data *pd)
459{
Steffen Klassert2dc9b5d2012-03-09 07:20:49 +0100460 int cpu_index, cpu;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400461 struct padata_parallel_queue *pqueue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100462
463 cpu_index = 0;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400464 for_each_cpu(cpu, pd->cpumask.pcpu) {
465 pqueue = per_cpu_ptr(pd->pqueue, cpu);
466 pqueue->pd = pd;
467 pqueue->cpu_index = cpu_index;
Steffen Klassertfad3a902010-07-20 08:48:34 +0200468 cpu_index++;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400469
470 __padata_list_init(&pqueue->reorder);
471 __padata_list_init(&pqueue->parallel);
472 INIT_WORK(&pqueue->work, padata_parallel_worker);
Mathias Krausef4fb6f12017-09-08 20:57:10 +0200473 INIT_WORK(&pqueue->reorder_work, invoke_padata_reorder);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400474 atomic_set(&pqueue->num_obj, 0);
475 }
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400476}
477
478/* Allocate and initialize the internal cpumask dependend resources. */
479static struct parallel_data *padata_alloc_pd(struct padata_instance *pinst,
480 const struct cpumask *pcpumask,
481 const struct cpumask *cbcpumask)
482{
483 struct parallel_data *pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100484
485 pd = kzalloc(sizeof(struct parallel_data), GFP_KERNEL);
486 if (!pd)
487 goto err;
488
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400489 pd->pqueue = alloc_percpu(struct padata_parallel_queue);
490 if (!pd->pqueue)
Steffen Klassert16295be2010-01-06 19:47:10 +1100491 goto err_free_pd;
492
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400493 pd->squeue = alloc_percpu(struct padata_serial_queue);
494 if (!pd->squeue)
495 goto err_free_pqueue;
496 if (padata_setup_cpumasks(pd, pcpumask, cbcpumask) < 0)
497 goto err_free_squeue;
Steffen Klassert16295be2010-01-06 19:47:10 +1100498
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400499 padata_init_pqueues(pd);
500 padata_init_squeues(pd);
Steffen Klassertd46a5ac2010-05-19 13:43:14 +1000501 setup_timer(&pd->timer, padata_reorder_timer, (unsigned long)pd);
Mathias Krause0b6b0982013-10-25 12:14:15 +0200502 atomic_set(&pd->seq_nr, -1);
Steffen Klassert16295be2010-01-06 19:47:10 +1100503 atomic_set(&pd->reorder_objects, 0);
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800504 atomic_set(&pd->refcnt, 1);
Steffen Klassert16295be2010-01-06 19:47:10 +1100505 pd->pinst = pinst;
506 spin_lock_init(&pd->lock);
507
508 return pd;
509
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400510err_free_squeue:
511 free_percpu(pd->squeue);
512err_free_pqueue:
513 free_percpu(pd->pqueue);
Steffen Klassert16295be2010-01-06 19:47:10 +1100514err_free_pd:
515 kfree(pd);
516err:
517 return NULL;
518}
519
520static void padata_free_pd(struct parallel_data *pd)
521{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400522 free_cpumask_var(pd->cpumask.pcpu);
523 free_cpumask_var(pd->cpumask.cbcpu);
524 free_percpu(pd->pqueue);
525 free_percpu(pd->squeue);
Steffen Klassert16295be2010-01-06 19:47:10 +1100526 kfree(pd);
527}
528
Steffen Klassert4c879172010-07-07 15:30:10 +0200529static void __padata_start(struct padata_instance *pinst)
530{
531 pinst->flags |= PADATA_INIT;
532}
533
Steffen Klassertee836552010-07-07 15:30:47 +0200534static void __padata_stop(struct padata_instance *pinst)
535{
536 if (!(pinst->flags & PADATA_INIT))
537 return;
538
539 pinst->flags &= ~PADATA_INIT;
540
541 synchronize_rcu();
Steffen Klassertee836552010-07-07 15:30:47 +0200542}
543
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300544/* Replace the internal control structure with a new one. */
Steffen Klassert16295be2010-01-06 19:47:10 +1100545static void padata_replace(struct padata_instance *pinst,
546 struct parallel_data *pd_new)
547{
548 struct parallel_data *pd_old = pinst->pd;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400549 int notification_mask = 0;
Steffen Klassert16295be2010-01-06 19:47:10 +1100550
551 pinst->flags |= PADATA_RESET;
552
553 rcu_assign_pointer(pinst->pd, pd_new);
554
555 synchronize_rcu();
556
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400557 if (!cpumask_equal(pd_old->cpumask.pcpu, pd_new->cpumask.pcpu))
558 notification_mask |= PADATA_CPU_PARALLEL;
559 if (!cpumask_equal(pd_old->cpumask.cbcpu, pd_new->cpumask.cbcpu))
560 notification_mask |= PADATA_CPU_SERIAL;
Steffen Klassert16295be2010-01-06 19:47:10 +1100561
Herbert Xu7a2ccb62019-11-19 13:17:31 +0800562 if (atomic_dec_and_test(&pd_old->refcnt))
563 padata_free_pd(pd_old);
Steffen Klassert16295be2010-01-06 19:47:10 +1100564
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400565 if (notification_mask)
566 blocking_notifier_call_chain(&pinst->cpumask_change_notifier,
Steffen Klassertc6356962010-07-27 07:15:50 +0200567 notification_mask,
568 &pd_new->cpumask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400569
Steffen Klassert16295be2010-01-06 19:47:10 +1100570 pinst->flags &= ~PADATA_RESET;
571}
572
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000573/**
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400574 * padata_register_cpumask_notifier - Registers a notifier that will be called
575 * if either pcpu or cbcpu or both cpumasks change.
Steffen Klassert16295be2010-01-06 19:47:10 +1100576 *
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400577 * @pinst: A poineter to padata instance
578 * @nblock: A pointer to notifier block.
Steffen Klassert16295be2010-01-06 19:47:10 +1100579 */
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400580int padata_register_cpumask_notifier(struct padata_instance *pinst,
581 struct notifier_block *nblock)
Steffen Klassert16295be2010-01-06 19:47:10 +1100582{
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400583 return blocking_notifier_chain_register(&pinst->cpumask_change_notifier,
584 nblock);
585}
586EXPORT_SYMBOL(padata_register_cpumask_notifier);
Steffen Klassert16295be2010-01-06 19:47:10 +1100587
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400588/**
589 * padata_unregister_cpumask_notifier - Unregisters cpumask notifier
590 * registered earlier using padata_register_cpumask_notifier
591 *
592 * @pinst: A pointer to data instance.
593 * @nlock: A pointer to notifier block.
594 */
595int padata_unregister_cpumask_notifier(struct padata_instance *pinst,
596 struct notifier_block *nblock)
597{
598 return blocking_notifier_chain_unregister(
599 &pinst->cpumask_change_notifier,
600 nblock);
601}
602EXPORT_SYMBOL(padata_unregister_cpumask_notifier);
Steffen Klassert16295be2010-01-06 19:47:10 +1100603
Steffen Klassert6751fb32010-04-29 14:42:30 +0200604
Steffen Klassert33e54452010-07-07 15:31:26 +0200605/* If cpumask contains no active cpu, we mark the instance as invalid. */
606static bool padata_validate_cpumask(struct padata_instance *pinst,
607 const struct cpumask *cpumask)
608{
Steffen Klassert13614e02012-03-28 08:43:21 +0200609 if (!cpumask_intersects(cpumask, cpu_online_mask)) {
Steffen Klassert33e54452010-07-07 15:31:26 +0200610 pinst->flags |= PADATA_INVALID;
611 return false;
Steffen Klassert16295be2010-01-06 19:47:10 +1100612 }
613
Steffen Klassert33e54452010-07-07 15:31:26 +0200614 pinst->flags &= ~PADATA_INVALID;
615 return true;
616}
617
Steffen Klassert65ff5772010-07-27 07:15:06 +0200618static int __padata_set_cpumasks(struct padata_instance *pinst,
619 cpumask_var_t pcpumask,
620 cpumask_var_t cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100621{
Steffen Klassert33e54452010-07-07 15:31:26 +0200622 int valid;
Steffen Klassert65ff5772010-07-27 07:15:06 +0200623 struct parallel_data *pd;
Steffen Klassert16295be2010-01-06 19:47:10 +1100624
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400625 valid = padata_validate_cpumask(pinst, pcpumask);
626 if (!valid) {
627 __padata_stop(pinst);
628 goto out_replace;
629 }
630
631 valid = padata_validate_cpumask(pinst, cbcpumask);
Steffen Klassertb89661d2010-07-20 08:49:20 +0200632 if (!valid)
Steffen Klassert33e54452010-07-07 15:31:26 +0200633 __padata_stop(pinst);
Steffen Klassert33e54452010-07-07 15:31:26 +0200634
Steffen Klassertb89661d2010-07-20 08:49:20 +0200635out_replace:
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400636 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
Steffen Klassert65ff5772010-07-27 07:15:06 +0200637 if (!pd)
638 return -ENOMEM;
Steffen Klassert16295be2010-01-06 19:47:10 +1100639
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400640 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
641 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
Steffen Klassert16295be2010-01-06 19:47:10 +1100642
643 padata_replace(pinst, pd);
644
Steffen Klassert33e54452010-07-07 15:31:26 +0200645 if (valid)
646 __padata_start(pinst);
647
Steffen Klassert65ff5772010-07-27 07:15:06 +0200648 return 0;
649}
650
651/**
652 * padata_set_cpumasks - Set both parallel and serial cpumasks. The first
653 * one is used by parallel workers and the second one
654 * by the wokers doing serialization.
655 *
656 * @pinst: padata instance
657 * @pcpumask: the cpumask to use for parallel workers
658 * @cbcpumask: the cpumsak to use for serial workers
659 */
660int padata_set_cpumasks(struct padata_instance *pinst, cpumask_var_t pcpumask,
661 cpumask_var_t cbcpumask)
662{
663 int err;
664
665 mutex_lock(&pinst->lock);
666 get_online_cpus();
667
668 err = __padata_set_cpumasks(pinst, pcpumask, cbcpumask);
669
Steffen Klassert6751fb32010-04-29 14:42:30 +0200670 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100671 mutex_unlock(&pinst->lock);
672
673 return err;
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400674
Steffen Klassert16295be2010-01-06 19:47:10 +1100675}
Steffen Klassert65ff5772010-07-27 07:15:06 +0200676EXPORT_SYMBOL(padata_set_cpumasks);
677
678/**
679 * padata_set_cpumask: Sets specified by @cpumask_type cpumask to the value
680 * equivalent to @cpumask.
681 *
682 * @pinst: padata instance
683 * @cpumask_type: PADATA_CPU_SERIAL or PADATA_CPU_PARALLEL corresponding
684 * to parallel and serial cpumasks respectively.
685 * @cpumask: the cpumask to use
686 */
687int padata_set_cpumask(struct padata_instance *pinst, int cpumask_type,
688 cpumask_var_t cpumask)
689{
690 struct cpumask *serial_mask, *parallel_mask;
691 int err = -EINVAL;
692
Steffen Klassert65ff5772010-07-27 07:15:06 +0200693 get_online_cpus();
Daniel Jordan80c4e3a2019-12-03 14:31:11 -0500694 mutex_lock(&pinst->lock);
Steffen Klassert65ff5772010-07-27 07:15:06 +0200695
696 switch (cpumask_type) {
697 case PADATA_CPU_PARALLEL:
698 serial_mask = pinst->cpumask.cbcpu;
699 parallel_mask = cpumask;
700 break;
701 case PADATA_CPU_SERIAL:
702 parallel_mask = pinst->cpumask.pcpu;
703 serial_mask = cpumask;
704 break;
705 default:
706 goto out;
707 }
708
709 err = __padata_set_cpumasks(pinst, parallel_mask, serial_mask);
710
Steffen Klassert16295be2010-01-06 19:47:10 +1100711out:
Steffen Klassert16295be2010-01-06 19:47:10 +1100712 mutex_unlock(&pinst->lock);
Daniel Jordan80c4e3a2019-12-03 14:31:11 -0500713 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100714
715 return err;
716}
717EXPORT_SYMBOL(padata_set_cpumask);
718
719static int __padata_add_cpu(struct padata_instance *pinst, int cpu)
720{
721 struct parallel_data *pd;
722
Steffen Klassert13614e02012-03-28 08:43:21 +0200723 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400724 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
725 pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100726 if (!pd)
727 return -ENOMEM;
728
729 padata_replace(pinst, pd);
Steffen Klassert33e54452010-07-07 15:31:26 +0200730
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400731 if (padata_validate_cpumask(pinst, pinst->cpumask.pcpu) &&
732 padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
Steffen Klassert33e54452010-07-07 15:31:26 +0200733 __padata_start(pinst);
Steffen Klassert16295be2010-01-06 19:47:10 +1100734 }
735
736 return 0;
737}
738
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400739 /**
740 * padata_add_cpu - add a cpu to one or both(parallel and serial)
741 * padata cpumasks.
Steffen Klassert16295be2010-01-06 19:47:10 +1100742 *
743 * @pinst: padata instance
744 * @cpu: cpu to add
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400745 * @mask: bitmask of flags specifying to which cpumask @cpu shuld be added.
746 * The @mask may be any combination of the following flags:
747 * PADATA_CPU_SERIAL - serial cpumask
748 * PADATA_CPU_PARALLEL - parallel cpumask
Steffen Klassert16295be2010-01-06 19:47:10 +1100749 */
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400750
751int padata_add_cpu(struct padata_instance *pinst, int cpu, int mask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100752{
753 int err;
754
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400755 if (!(mask & (PADATA_CPU_SERIAL | PADATA_CPU_PARALLEL)))
756 return -EINVAL;
757
Steffen Klassert16295be2010-01-06 19:47:10 +1100758 mutex_lock(&pinst->lock);
759
Steffen Klassert6751fb32010-04-29 14:42:30 +0200760 get_online_cpus();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400761 if (mask & PADATA_CPU_SERIAL)
762 cpumask_set_cpu(cpu, pinst->cpumask.cbcpu);
763 if (mask & PADATA_CPU_PARALLEL)
764 cpumask_set_cpu(cpu, pinst->cpumask.pcpu);
765
Steffen Klassert16295be2010-01-06 19:47:10 +1100766 err = __padata_add_cpu(pinst, cpu);
Steffen Klassert6751fb32010-04-29 14:42:30 +0200767 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100768
769 mutex_unlock(&pinst->lock);
770
771 return err;
772}
773EXPORT_SYMBOL(padata_add_cpu);
774
775static int __padata_remove_cpu(struct padata_instance *pinst, int cpu)
776{
Steffen Klassert33e54452010-07-07 15:31:26 +0200777 struct parallel_data *pd = NULL;
Steffen Klassert16295be2010-01-06 19:47:10 +1100778
779 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
Steffen Klassert33e54452010-07-07 15:31:26 +0200780
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400781 if (!padata_validate_cpumask(pinst, pinst->cpumask.pcpu) ||
Steffen Klassertb89661d2010-07-20 08:49:20 +0200782 !padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
Steffen Klassert33e54452010-07-07 15:31:26 +0200783 __padata_stop(pinst);
Steffen Klassert33e54452010-07-07 15:31:26 +0200784
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400785 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
786 pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100787 if (!pd)
788 return -ENOMEM;
789
790 padata_replace(pinst, pd);
Steffen Klassert96120902012-03-28 08:44:07 +0200791
792 cpumask_clear_cpu(cpu, pd->cpumask.cbcpu);
793 cpumask_clear_cpu(cpu, pd->cpumask.pcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +1100794 }
795
796 return 0;
797}
798
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400799 /**
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300800 * padata_remove_cpu - remove a cpu from the one or both(serial and parallel)
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400801 * padata cpumasks.
Steffen Klassert16295be2010-01-06 19:47:10 +1100802 *
803 * @pinst: padata instance
804 * @cpu: cpu to remove
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400805 * @mask: bitmask specifying from which cpumask @cpu should be removed
806 * The @mask may be any combination of the following flags:
807 * PADATA_CPU_SERIAL - serial cpumask
808 * PADATA_CPU_PARALLEL - parallel cpumask
Steffen Klassert16295be2010-01-06 19:47:10 +1100809 */
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400810int padata_remove_cpu(struct padata_instance *pinst, int cpu, int mask)
Steffen Klassert16295be2010-01-06 19:47:10 +1100811{
812 int err;
813
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400814 if (!(mask & (PADATA_CPU_SERIAL | PADATA_CPU_PARALLEL)))
815 return -EINVAL;
816
Steffen Klassert16295be2010-01-06 19:47:10 +1100817 mutex_lock(&pinst->lock);
818
Steffen Klassert6751fb32010-04-29 14:42:30 +0200819 get_online_cpus();
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400820 if (mask & PADATA_CPU_SERIAL)
821 cpumask_clear_cpu(cpu, pinst->cpumask.cbcpu);
822 if (mask & PADATA_CPU_PARALLEL)
823 cpumask_clear_cpu(cpu, pinst->cpumask.pcpu);
824
Steffen Klassert16295be2010-01-06 19:47:10 +1100825 err = __padata_remove_cpu(pinst, cpu);
Steffen Klassert6751fb32010-04-29 14:42:30 +0200826 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +1100827
828 mutex_unlock(&pinst->lock);
829
830 return err;
831}
832EXPORT_SYMBOL(padata_remove_cpu);
833
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000834/**
Steffen Klassert16295be2010-01-06 19:47:10 +1100835 * padata_start - start the parallel processing
836 *
837 * @pinst: padata instance to start
838 */
Steffen Klassert4c879172010-07-07 15:30:10 +0200839int padata_start(struct padata_instance *pinst)
Steffen Klassert16295be2010-01-06 19:47:10 +1100840{
Steffen Klassert4c879172010-07-07 15:30:10 +0200841 int err = 0;
842
Steffen Klassert16295be2010-01-06 19:47:10 +1100843 mutex_lock(&pinst->lock);
Steffen Klassert4c879172010-07-07 15:30:10 +0200844
845 if (pinst->flags & PADATA_INVALID)
846 err =-EINVAL;
847
848 __padata_start(pinst);
849
Steffen Klassert16295be2010-01-06 19:47:10 +1100850 mutex_unlock(&pinst->lock);
Steffen Klassert4c879172010-07-07 15:30:10 +0200851
852 return err;
Steffen Klassert16295be2010-01-06 19:47:10 +1100853}
854EXPORT_SYMBOL(padata_start);
855
Steffen Klassert0198ffd2010-05-19 13:44:27 +1000856/**
Steffen Klassert16295be2010-01-06 19:47:10 +1100857 * padata_stop - stop the parallel processing
858 *
859 * @pinst: padata instance to stop
860 */
861void padata_stop(struct padata_instance *pinst)
862{
Steffen Klassert16295be2010-01-06 19:47:10 +1100863 mutex_lock(&pinst->lock);
Steffen Klassertee836552010-07-07 15:30:47 +0200864 __padata_stop(pinst);
Steffen Klassert16295be2010-01-06 19:47:10 +1100865 mutex_unlock(&pinst->lock);
866}
867EXPORT_SYMBOL(padata_stop);
868
Steffen Klasserte2cb2f12010-04-29 14:40:10 +0200869#ifdef CONFIG_HOTPLUG_CPU
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400870
871static inline int pinst_has_cpu(struct padata_instance *pinst, int cpu)
872{
873 return cpumask_test_cpu(cpu, pinst->cpumask.pcpu) ||
874 cpumask_test_cpu(cpu, pinst->cpumask.cbcpu);
875}
876
877
Henrik Kretzschmar975d2602010-03-29 16:15:31 +0800878static int padata_cpu_callback(struct notifier_block *nfb,
879 unsigned long action, void *hcpu)
Steffen Klassert16295be2010-01-06 19:47:10 +1100880{
881 int err;
882 struct padata_instance *pinst;
883 int cpu = (unsigned long)hcpu;
884
885 pinst = container_of(nfb, struct padata_instance, cpu_notifier);
886
887 switch (action) {
888 case CPU_ONLINE:
889 case CPU_ONLINE_FROZEN:
Chen Gang9c823f92013-08-22 06:43:37 +0000890 case CPU_DOWN_FAILED:
891 case CPU_DOWN_FAILED_FROZEN:
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400892 if (!pinst_has_cpu(pinst, cpu))
Steffen Klassert16295be2010-01-06 19:47:10 +1100893 break;
894 mutex_lock(&pinst->lock);
895 err = __padata_add_cpu(pinst, cpu);
896 mutex_unlock(&pinst->lock);
897 if (err)
Akinobu Mita80b51842010-05-26 14:43:32 -0700898 return notifier_from_errno(err);
Steffen Klassert16295be2010-01-06 19:47:10 +1100899 break;
900
901 case CPU_DOWN_PREPARE:
902 case CPU_DOWN_PREPARE_FROZEN:
Chen Gang9c823f92013-08-22 06:43:37 +0000903 case CPU_UP_CANCELED:
904 case CPU_UP_CANCELED_FROZEN:
Dan Kruchinine15bacb2010-07-14 14:31:57 +0400905 if (!pinst_has_cpu(pinst, cpu))
Steffen Klassert16295be2010-01-06 19:47:10 +1100906 break;
907 mutex_lock(&pinst->lock);
908 err = __padata_remove_cpu(pinst, cpu);
909 mutex_unlock(&pinst->lock);
910 if (err)
Akinobu Mita80b51842010-05-26 14:43:32 -0700911 return notifier_from_errno(err);
Steffen Klassert16295be2010-01-06 19:47:10 +1100912 break;
Steffen Klassert16295be2010-01-06 19:47:10 +1100913 }
914
915 return NOTIFY_OK;
916}
Steffen Klasserte2cb2f12010-04-29 14:40:10 +0200917#endif
Steffen Klassert16295be2010-01-06 19:47:10 +1100918
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400919static void __padata_free(struct padata_instance *pinst)
920{
921#ifdef CONFIG_HOTPLUG_CPU
922 unregister_hotcpu_notifier(&pinst->cpu_notifier);
923#endif
924
925 padata_stop(pinst);
926 padata_free_pd(pinst->pd);
927 free_cpumask_var(pinst->cpumask.pcpu);
928 free_cpumask_var(pinst->cpumask.cbcpu);
929 kfree(pinst);
930}
931
932#define kobj2pinst(_kobj) \
933 container_of(_kobj, struct padata_instance, kobj)
934#define attr2pentry(_attr) \
935 container_of(_attr, struct padata_sysfs_entry, attr)
936
937static void padata_sysfs_release(struct kobject *kobj)
938{
939 struct padata_instance *pinst = kobj2pinst(kobj);
940 __padata_free(pinst);
941}
942
943struct padata_sysfs_entry {
944 struct attribute attr;
945 ssize_t (*show)(struct padata_instance *, struct attribute *, char *);
946 ssize_t (*store)(struct padata_instance *, struct attribute *,
947 const char *, size_t);
948};
949
950static ssize_t show_cpumask(struct padata_instance *pinst,
951 struct attribute *attr, char *buf)
952{
953 struct cpumask *cpumask;
954 ssize_t len;
955
956 mutex_lock(&pinst->lock);
957 if (!strcmp(attr->name, "serial_cpumask"))
958 cpumask = pinst->cpumask.cbcpu;
959 else
960 cpumask = pinst->cpumask.pcpu;
961
Tejun Heo4497da62015-02-13 14:38:05 -0800962 len = snprintf(buf, PAGE_SIZE, "%*pb\n",
963 nr_cpu_ids, cpumask_bits(cpumask));
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400964 mutex_unlock(&pinst->lock);
Tejun Heo4497da62015-02-13 14:38:05 -0800965 return len < PAGE_SIZE ? len : -EINVAL;
Dan Kruchinin5e017dc2010-07-14 14:33:08 +0400966}
967
968static ssize_t store_cpumask(struct padata_instance *pinst,
969 struct attribute *attr,
970 const char *buf, size_t count)
971{
972 cpumask_var_t new_cpumask;
973 ssize_t ret;
974 int mask_type;
975
976 if (!alloc_cpumask_var(&new_cpumask, GFP_KERNEL))
977 return -ENOMEM;
978
979 ret = bitmap_parse(buf, count, cpumask_bits(new_cpumask),
980 nr_cpumask_bits);
981 if (ret < 0)
982 goto out;
983
984 mask_type = !strcmp(attr->name, "serial_cpumask") ?
985 PADATA_CPU_SERIAL : PADATA_CPU_PARALLEL;
986 ret = padata_set_cpumask(pinst, mask_type, new_cpumask);
987 if (!ret)
988 ret = count;
989
990out:
991 free_cpumask_var(new_cpumask);
992 return ret;
993}
994
995#define PADATA_ATTR_RW(_name, _show_name, _store_name) \
996 static struct padata_sysfs_entry _name##_attr = \
997 __ATTR(_name, 0644, _show_name, _store_name)
998#define PADATA_ATTR_RO(_name, _show_name) \
999 static struct padata_sysfs_entry _name##_attr = \
1000 __ATTR(_name, 0400, _show_name, NULL)
1001
1002PADATA_ATTR_RW(serial_cpumask, show_cpumask, store_cpumask);
1003PADATA_ATTR_RW(parallel_cpumask, show_cpumask, store_cpumask);
1004
1005/*
1006 * Padata sysfs provides the following objects:
1007 * serial_cpumask [RW] - cpumask for serial workers
1008 * parallel_cpumask [RW] - cpumask for parallel workers
Steffen Klassert16295be2010-01-06 19:47:10 +11001009 */
Dan Kruchinin5e017dc2010-07-14 14:33:08 +04001010static struct attribute *padata_default_attrs[] = {
1011 &serial_cpumask_attr.attr,
1012 &parallel_cpumask_attr.attr,
1013 NULL,
1014};
1015
1016static ssize_t padata_sysfs_show(struct kobject *kobj,
1017 struct attribute *attr, char *buf)
Steffen Klassert16295be2010-01-06 19:47:10 +11001018{
Steffen Klassert16295be2010-01-06 19:47:10 +11001019 struct padata_instance *pinst;
Dan Kruchinin5e017dc2010-07-14 14:33:08 +04001020 struct padata_sysfs_entry *pentry;
1021 ssize_t ret = -EIO;
1022
1023 pinst = kobj2pinst(kobj);
1024 pentry = attr2pentry(attr);
1025 if (pentry->show)
1026 ret = pentry->show(pinst, attr, buf);
1027
1028 return ret;
1029}
1030
1031static ssize_t padata_sysfs_store(struct kobject *kobj, struct attribute *attr,
1032 const char *buf, size_t count)
1033{
1034 struct padata_instance *pinst;
1035 struct padata_sysfs_entry *pentry;
1036 ssize_t ret = -EIO;
1037
1038 pinst = kobj2pinst(kobj);
1039 pentry = attr2pentry(attr);
1040 if (pentry->show)
1041 ret = pentry->store(pinst, attr, buf, count);
1042
1043 return ret;
1044}
1045
1046static const struct sysfs_ops padata_sysfs_ops = {
1047 .show = padata_sysfs_show,
1048 .store = padata_sysfs_store,
1049};
1050
1051static struct kobj_type padata_attr_type = {
1052 .sysfs_ops = &padata_sysfs_ops,
1053 .default_attrs = padata_default_attrs,
1054 .release = padata_sysfs_release,
1055};
1056
Steffen Klassert16295be2010-01-06 19:47:10 +11001057/**
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001058 * padata_alloc_possible - Allocate and initialize padata instance.
1059 * Use the cpu_possible_mask for serial and
1060 * parallel workers.
Steffen Klassert16295be2010-01-06 19:47:10 +11001061 *
Steffen Klassert16295be2010-01-06 19:47:10 +11001062 * @wq: workqueue to use for the allocated padata instance
1063 */
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001064struct padata_instance *padata_alloc_possible(struct workqueue_struct *wq)
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001065{
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001066 return padata_alloc(wq, cpu_possible_mask, cpu_possible_mask);
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001067}
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001068EXPORT_SYMBOL(padata_alloc_possible);
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001069
1070/**
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001071 * padata_alloc - allocate and initialize a padata instance and specify
1072 * cpumasks for serial and parallel workers.
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001073 *
1074 * @wq: workqueue to use for the allocated padata instance
1075 * @pcpumask: cpumask that will be used for padata parallelization
1076 * @cbcpumask: cpumask that will be used for padata serialization
1077 */
Steffen Klasserte6cc1172010-07-27 07:14:28 +02001078struct padata_instance *padata_alloc(struct workqueue_struct *wq,
1079 const struct cpumask *pcpumask,
1080 const struct cpumask *cbcpumask)
Steffen Klassert16295be2010-01-06 19:47:10 +11001081{
1082 struct padata_instance *pinst;
Steffen Klassert33e54452010-07-07 15:31:26 +02001083 struct parallel_data *pd = NULL;
Steffen Klassert16295be2010-01-06 19:47:10 +11001084
1085 pinst = kzalloc(sizeof(struct padata_instance), GFP_KERNEL);
1086 if (!pinst)
1087 goto err;
1088
Steffen Klassert6751fb32010-04-29 14:42:30 +02001089 get_online_cpus();
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001090 if (!alloc_cpumask_var(&pinst->cpumask.pcpu, GFP_KERNEL))
Steffen Klassert16295be2010-01-06 19:47:10 +11001091 goto err_free_inst;
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001092 if (!alloc_cpumask_var(&pinst->cpumask.cbcpu, GFP_KERNEL)) {
1093 free_cpumask_var(pinst->cpumask.pcpu);
1094 goto err_free_inst;
Steffen Klassert33e54452010-07-07 15:31:26 +02001095 }
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001096 if (!padata_validate_cpumask(pinst, pcpumask) ||
1097 !padata_validate_cpumask(pinst, cbcpumask))
1098 goto err_free_masks;
Steffen Klassert16295be2010-01-06 19:47:10 +11001099
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001100 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
1101 if (!pd)
1102 goto err_free_masks;
Steffen Klassert74781382010-03-04 13:30:22 +08001103
Steffen Klassert16295be2010-01-06 19:47:10 +11001104 rcu_assign_pointer(pinst->pd, pd);
1105
1106 pinst->wq = wq;
1107
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001108 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
1109 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
Steffen Klassert16295be2010-01-06 19:47:10 +11001110
1111 pinst->flags = 0;
1112
Steffen Klassert6751fb32010-04-29 14:42:30 +02001113 put_online_cpus();
1114
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001115 BLOCKING_INIT_NOTIFIER_HEAD(&pinst->cpumask_change_notifier);
Dan Kruchinin5e017dc2010-07-14 14:33:08 +04001116 kobject_init(&pinst->kobj, &padata_attr_type);
Steffen Klassert16295be2010-01-06 19:47:10 +11001117 mutex_init(&pinst->lock);
1118
Richard Weinbergerb8b4a412013-08-23 13:12:33 +02001119#ifdef CONFIG_HOTPLUG_CPU
1120 pinst->cpu_notifier.notifier_call = padata_cpu_callback;
1121 pinst->cpu_notifier.priority = 0;
1122 register_hotcpu_notifier(&pinst->cpu_notifier);
1123#endif
1124
Steffen Klassert16295be2010-01-06 19:47:10 +11001125 return pinst;
1126
Dan Kruchinine15bacb2010-07-14 14:31:57 +04001127err_free_masks:
1128 free_cpumask_var(pinst->cpumask.pcpu);
1129 free_cpumask_var(pinst->cpumask.cbcpu);
Steffen Klassert16295be2010-01-06 19:47:10 +11001130err_free_inst:
1131 kfree(pinst);
Steffen Klassert6751fb32010-04-29 14:42:30 +02001132 put_online_cpus();
Steffen Klassert16295be2010-01-06 19:47:10 +11001133err:
1134 return NULL;
1135}
1136EXPORT_SYMBOL(padata_alloc);
1137
Steffen Klassert0198ffd2010-05-19 13:44:27 +10001138/**
Steffen Klassert16295be2010-01-06 19:47:10 +11001139 * padata_free - free a padata instance
1140 *
Steffen Klassert0198ffd2010-05-19 13:44:27 +10001141 * @padata_inst: padata instance to free
Steffen Klassert16295be2010-01-06 19:47:10 +11001142 */
1143void padata_free(struct padata_instance *pinst)
1144{
Dan Kruchinin5e017dc2010-07-14 14:33:08 +04001145 kobject_put(&pinst->kobj);
Steffen Klassert16295be2010-01-06 19:47:10 +11001146}
1147EXPORT_SYMBOL(padata_free);