]> git.proxmox.com Git - mirror_ubuntu-zesty-kernel.git/blame - kernel/padata.c
UBUNTU: Ubuntu-raspi2-4.10.0-1003.5
[mirror_ubuntu-zesty-kernel.git] / kernel / padata.c
CommitLineData
16295bec
SK
1/*
2 * padata.c - generic interface to process data streams in parallel
3 *
107f8bda
SK
4 * See Documentation/padata.txt for an api documentation.
5 *
16295bec
SK
6 * 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
9984de1a 23#include <linux/export.h>
16295bec
SK
24#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>
5a0e3ad6 30#include <linux/slab.h>
5e017dc3 31#include <linux/sysfs.h>
16295bec 32#include <linux/rcupdate.h>
30e92153 33#include <linux/module.h>
16295bec 34
97e3d94a 35#define MAX_OBJ_NUM 1000
16295bec
SK
36
37static int padata_index_to_cpu(struct parallel_data *pd, int cpu_index)
38{
39 int cpu, target_cpu;
40
e15bacbe 41 target_cpu = cpumask_first(pd->cpumask.pcpu);
16295bec 42 for (cpu = 0; cpu < cpu_index; cpu++)
e15bacbe 43 target_cpu = cpumask_next(target_cpu, pd->cpumask.pcpu);
16295bec
SK
44
45 return target_cpu;
46}
47
2dc9b5db 48static int padata_cpu_hash(struct parallel_data *pd)
16295bec 49{
0b6b098e 50 unsigned int seq_nr;
16295bec 51 int cpu_index;
16295bec
SK
52
53 /*
54 * Hash the sequence numbers to the cpus by taking
55 * seq_nr mod. number of cpus in use.
56 */
2dc9b5db 57
0b6b098e
MK
58 seq_nr = atomic_inc_return(&pd->seq_nr);
59 cpu_index = seq_nr % cpumask_weight(pd->cpumask.pcpu);
16295bec
SK
60
61 return padata_index_to_cpu(pd, cpu_index);
62}
63
e15bacbe 64static void padata_parallel_worker(struct work_struct *parallel_work)
16295bec 65{
e15bacbe 66 struct padata_parallel_queue *pqueue;
16295bec
SK
67 LIST_HEAD(local_list);
68
69 local_bh_disable();
e15bacbe
DK
70 pqueue = container_of(parallel_work,
71 struct padata_parallel_queue, work);
16295bec 72
e15bacbe
DK
73 spin_lock(&pqueue->parallel.lock);
74 list_replace_init(&pqueue->parallel.list, &local_list);
75 spin_unlock(&pqueue->parallel.lock);
16295bec
SK
76
77 while (!list_empty(&local_list)) {
78 struct padata_priv *padata;
79
80 padata = list_entry(local_list.next,
81 struct padata_priv, list);
82
83 list_del_init(&padata->list);
84
85 padata->parallel(padata);
86 }
87
88 local_bh_enable();
89}
90
0198ffd1 91/**
16295bec
SK
92 * padata_do_parallel - padata parallelization function
93 *
94 * @pinst: padata instance
95 * @padata: object to be parallelized
96 * @cb_cpu: cpu the serialization callback function will run on,
e15bacbe 97 * must be in the serial cpumask of padata(i.e. cpumask.cbcpu).
16295bec
SK
98 *
99 * The parallelization callback function will run with BHs off.
100 * Note: Every object which is parallelized by padata_do_parallel
101 * must be seen by padata_do_serial.
102 */
103int padata_do_parallel(struct padata_instance *pinst,
104 struct padata_priv *padata, int cb_cpu)
105{
106 int target_cpu, err;
e15bacbe 107 struct padata_parallel_queue *queue;
16295bec
SK
108 struct parallel_data *pd;
109
110 rcu_read_lock_bh();
111
c0e656b7 112 pd = rcu_dereference_bh(pinst->pd);
16295bec 113
83f619f3 114 err = -EINVAL;
7424713b 115 if (!(pinst->flags & PADATA_INIT) || pinst->flags & PADATA_INVALID)
16295bec
SK
116 goto out;
117
e15bacbe 118 if (!cpumask_test_cpu(cb_cpu, pd->cpumask.cbcpu))
16295bec
SK
119 goto out;
120
121 err = -EBUSY;
122 if ((pinst->flags & PADATA_RESET))
123 goto out;
124
125 if (atomic_read(&pd->refcnt) >= MAX_OBJ_NUM)
126 goto out;
127
83f619f3 128 err = 0;
16295bec
SK
129 atomic_inc(&pd->refcnt);
130 padata->pd = pd;
131 padata->cb_cpu = cb_cpu;
132
2dc9b5db 133 target_cpu = padata_cpu_hash(pd);
e15bacbe 134 queue = per_cpu_ptr(pd->pqueue, target_cpu);
16295bec
SK
135
136 spin_lock(&queue->parallel.lock);
137 list_add_tail(&padata->list, &queue->parallel.list);
138 spin_unlock(&queue->parallel.lock);
139
e15bacbe 140 queue_work_on(target_cpu, pinst->wq, &queue->work);
16295bec
SK
141
142out:
143 rcu_read_unlock_bh();
144
145 return err;
146}
147EXPORT_SYMBOL(padata_do_parallel);
148
0198ffd1
SK
149/*
150 * padata_get_next - Get the next object that needs serialization.
151 *
152 * Return values are:
153 *
154 * A pointer to the control struct of the next object that needs
155 * serialization, if present in one of the percpu reorder queues.
156 *
157 * NULL, if all percpu reorder queues are empty.
158 *
159 * -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 */
16295bec
SK
166static struct padata_priv *padata_get_next(struct parallel_data *pd)
167{
5f1a8c1b 168 int cpu, num_cpus;
2dc9b5db 169 unsigned int next_nr, next_index;
f0fcf200 170 struct padata_parallel_queue *next_queue;
16295bec
SK
171 struct padata_priv *padata;
172 struct padata_list *reorder;
173
e15bacbe 174 num_cpus = cpumask_weight(pd->cpumask.pcpu);
16295bec 175
5f1a8c1b
SK
176 /*
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);
e15bacbe 183 next_queue = per_cpu_ptr(pd->pqueue, cpu);
5f1a8c1b 184
16295bec
SK
185 padata = NULL;
186
16295bec
SK
187 reorder = &next_queue->reorder;
188
9c512a43 189 spin_lock(&reorder->lock);
16295bec
SK
190 if (!list_empty(&reorder->list)) {
191 padata = list_entry(reorder->list.next,
192 struct padata_priv, list);
193
16295bec
SK
194 list_del_init(&padata->list);
195 atomic_dec(&pd->reorder_objects);
16295bec 196
5f1a8c1b 197 pd->processed++;
16295bec 198
9c512a43 199 spin_unlock(&reorder->lock);
16295bec
SK
200 goto out;
201 }
9c512a43 202 spin_unlock(&reorder->lock);
16295bec 203
f0fcf200 204 if (__this_cpu_read(pd->pqueue->cpu_index) == next_queue->cpu_index) {
16295bec
SK
205 padata = ERR_PTR(-ENODATA);
206 goto out;
207 }
208
209 padata = ERR_PTR(-EINPROGRESS);
210out:
211 return padata;
212}
213
214static void padata_reorder(struct parallel_data *pd)
215{
3047817b 216 int cb_cpu;
16295bec 217 struct padata_priv *padata;
e15bacbe 218 struct padata_serial_queue *squeue;
16295bec
SK
219 struct padata_instance *pinst = pd->pinst;
220
0198ffd1
SK
221 /*
222 * We need to ensure that only one cpu can work on dequeueing of
223 * the reorder queue the time. Calculating in which percpu reorder
224 * queue the next object will arrive takes some time. A spinlock
225 * would be highly contended. Also it is not clear in which order
226 * the objects arrive to the reorder queues. So a cpu could wait to
227 * get the lock just to notice that there is nothing to do at the
228 * moment. Therefore we use a trylock and let the holder of the lock
229 * care for all the objects enqueued during the holdtime of the lock.
230 */
16295bec 231 if (!spin_trylock_bh(&pd->lock))
d46a5ac7 232 return;
16295bec
SK
233
234 while (1) {
235 padata = padata_get_next(pd);
236
0198ffd1
SK
237 /*
238 * All reorder queues are empty, or the next object that needs
239 * serialization is parallel processed by another cpu and is
240 * still on it's way to the cpu's reorder queue, nothing to
241 * do for now.
242 */
16295bec
SK
243 if (!padata || PTR_ERR(padata) == -EINPROGRESS)
244 break;
245
0198ffd1
SK
246 /*
247 * This cpu has to do the parallel processing of the next
248 * object. It's waiting in the cpu's parallelization queue,
25985edc 249 * so exit immediately.
0198ffd1 250 */
16295bec 251 if (PTR_ERR(padata) == -ENODATA) {
d46a5ac7 252 del_timer(&pd->timer);
16295bec 253 spin_unlock_bh(&pd->lock);
d46a5ac7 254 return;
16295bec
SK
255 }
256
3047817b
SK
257 cb_cpu = padata->cb_cpu;
258 squeue = per_cpu_ptr(pd->squeue, cb_cpu);
16295bec 259
e15bacbe
DK
260 spin_lock(&squeue->serial.lock);
261 list_add_tail(&padata->list, &squeue->serial.list);
262 spin_unlock(&squeue->serial.lock);
16295bec 263
3047817b 264 queue_work_on(cb_cpu, pinst->wq, &squeue->work);
16295bec
SK
265 }
266
267 spin_unlock_bh(&pd->lock);
268
0198ffd1
SK
269 /*
270 * The next object that needs serialization might have arrived to
271 * the reorder queues in the meantime, we will be called again
25985edc 272 * from the timer function if no one else cares for it.
0198ffd1 273 */
d46a5ac7
SK
274 if (atomic_read(&pd->reorder_objects)
275 && !(pinst->flags & PADATA_RESET))
276 mod_timer(&pd->timer, jiffies + HZ);
277 else
278 del_timer(&pd->timer);
16295bec 279
16295bec
SK
280 return;
281}
282
d46a5ac7
SK
283static void padata_reorder_timer(unsigned long arg)
284{
285 struct parallel_data *pd = (struct parallel_data *)arg;
286
287 padata_reorder(pd);
288}
289
e15bacbe 290static void padata_serial_worker(struct work_struct *serial_work)
16295bec 291{
e15bacbe 292 struct padata_serial_queue *squeue;
16295bec
SK
293 struct parallel_data *pd;
294 LIST_HEAD(local_list);
295
296 local_bh_disable();
e15bacbe
DK
297 squeue = container_of(serial_work, struct padata_serial_queue, work);
298 pd = squeue->pd;
16295bec 299
e15bacbe
DK
300 spin_lock(&squeue->serial.lock);
301 list_replace_init(&squeue->serial.list, &local_list);
302 spin_unlock(&squeue->serial.lock);
16295bec
SK
303
304 while (!list_empty(&local_list)) {
305 struct padata_priv *padata;
306
307 padata = list_entry(local_list.next,
308 struct padata_priv, list);
309
310 list_del_init(&padata->list);
311
312 padata->serial(padata);
313 atomic_dec(&pd->refcnt);
314 }
315 local_bh_enable();
316}
317
0198ffd1 318/**
16295bec
SK
319 * padata_do_serial - padata serialization function
320 *
321 * @padata: object to be serialized.
322 *
323 * padata_do_serial must be called for every parallelized object.
324 * The serialization callback function will run with BHs off.
325 */
326void padata_do_serial(struct padata_priv *padata)
327{
328 int cpu;
e15bacbe 329 struct padata_parallel_queue *pqueue;
16295bec
SK
330 struct parallel_data *pd;
331
332 pd = padata->pd;
333
334 cpu = get_cpu();
e15bacbe 335 pqueue = per_cpu_ptr(pd->pqueue, cpu);
16295bec 336
e15bacbe 337 spin_lock(&pqueue->reorder.lock);
16295bec 338 atomic_inc(&pd->reorder_objects);
e15bacbe
DK
339 list_add_tail(&padata->list, &pqueue->reorder.list);
340 spin_unlock(&pqueue->reorder.lock);
16295bec
SK
341
342 put_cpu();
343
344 padata_reorder(pd);
345}
346EXPORT_SYMBOL(padata_do_serial);
347
e15bacbe
DK
348static int padata_setup_cpumasks(struct parallel_data *pd,
349 const struct cpumask *pcpumask,
350 const struct cpumask *cbcpumask)
16295bec 351{
e15bacbe
DK
352 if (!alloc_cpumask_var(&pd->cpumask.pcpu, GFP_KERNEL))
353 return -ENOMEM;
16295bec 354
13614e0f 355 cpumask_and(pd->cpumask.pcpu, pcpumask, cpu_online_mask);
e15bacbe 356 if (!alloc_cpumask_var(&pd->cpumask.cbcpu, GFP_KERNEL)) {
ce319ece 357 free_cpumask_var(pd->cpumask.pcpu);
e15bacbe
DK
358 return -ENOMEM;
359 }
16295bec 360
13614e0f 361 cpumask_and(pd->cpumask.cbcpu, cbcpumask, cpu_online_mask);
e15bacbe
DK
362 return 0;
363}
16295bec 364
e15bacbe
DK
365static void __padata_list_init(struct padata_list *pd_list)
366{
367 INIT_LIST_HEAD(&pd_list->list);
368 spin_lock_init(&pd_list->lock);
369}
16295bec 370
e15bacbe
DK
371/* Initialize all percpu queues used by serial workers */
372static void padata_init_squeues(struct parallel_data *pd)
373{
374 int cpu;
375 struct padata_serial_queue *squeue;
7b389b2c 376
e15bacbe
DK
377 for_each_cpu(cpu, pd->cpumask.cbcpu) {
378 squeue = per_cpu_ptr(pd->squeue, cpu);
379 squeue->pd = pd;
380 __padata_list_init(&squeue->serial);
381 INIT_WORK(&squeue->work, padata_serial_worker);
382 }
383}
16295bec 384
e15bacbe
DK
385/* Initialize all percpu queues used by parallel workers */
386static void padata_init_pqueues(struct parallel_data *pd)
387{
2dc9b5db 388 int cpu_index, cpu;
e15bacbe 389 struct padata_parallel_queue *pqueue;
16295bec 390
e15bacbe
DK
391 cpu_index = 0;
392 for_each_cpu(cpu, pd->cpumask.pcpu) {
393 pqueue = per_cpu_ptr(pd->pqueue, cpu);
394 pqueue->pd = pd;
395 pqueue->cpu_index = cpu_index;
7b389b2c 396 cpu_index++;
16295bec 397
e15bacbe
DK
398 __padata_list_init(&pqueue->reorder);
399 __padata_list_init(&pqueue->parallel);
400 INIT_WORK(&pqueue->work, padata_parallel_worker);
401 atomic_set(&pqueue->num_obj, 0);
16295bec 402 }
e15bacbe 403}
16295bec 404
e15bacbe
DK
405/* Allocate and initialize the internal cpumask dependend resources. */
406static struct parallel_data *padata_alloc_pd(struct padata_instance *pinst,
407 const struct cpumask *pcpumask,
408 const struct cpumask *cbcpumask)
409{
410 struct parallel_data *pd;
16295bec 411
e15bacbe
DK
412 pd = kzalloc(sizeof(struct parallel_data), GFP_KERNEL);
413 if (!pd)
414 goto err;
16295bec 415
e15bacbe
DK
416 pd->pqueue = alloc_percpu(struct padata_parallel_queue);
417 if (!pd->pqueue)
418 goto err_free_pd;
419
420 pd->squeue = alloc_percpu(struct padata_serial_queue);
421 if (!pd->squeue)
422 goto err_free_pqueue;
423 if (padata_setup_cpumasks(pd, pcpumask, cbcpumask) < 0)
424 goto err_free_squeue;
16295bec 425
e15bacbe
DK
426 padata_init_pqueues(pd);
427 padata_init_squeues(pd);
d46a5ac7 428 setup_timer(&pd->timer, padata_reorder_timer, (unsigned long)pd);
0b6b098e 429 atomic_set(&pd->seq_nr, -1);
16295bec
SK
430 atomic_set(&pd->reorder_objects, 0);
431 atomic_set(&pd->refcnt, 0);
432 pd->pinst = pinst;
433 spin_lock_init(&pd->lock);
434
435 return pd;
436
e15bacbe
DK
437err_free_squeue:
438 free_percpu(pd->squeue);
439err_free_pqueue:
440 free_percpu(pd->pqueue);
16295bec
SK
441err_free_pd:
442 kfree(pd);
443err:
444 return NULL;
445}
446
447static void padata_free_pd(struct parallel_data *pd)
448{
e15bacbe
DK
449 free_cpumask_var(pd->cpumask.pcpu);
450 free_cpumask_var(pd->cpumask.cbcpu);
451 free_percpu(pd->pqueue);
452 free_percpu(pd->squeue);
16295bec
SK
453 kfree(pd);
454}
455
0198ffd1 456/* Flush all objects out of the padata queues. */
2b73b07a
SK
457static void padata_flush_queues(struct parallel_data *pd)
458{
459 int cpu;
e15bacbe
DK
460 struct padata_parallel_queue *pqueue;
461 struct padata_serial_queue *squeue;
2b73b07a 462
e15bacbe
DK
463 for_each_cpu(cpu, pd->cpumask.pcpu) {
464 pqueue = per_cpu_ptr(pd->pqueue, cpu);
465 flush_work(&pqueue->work);
2b73b07a
SK
466 }
467
468 del_timer_sync(&pd->timer);
469
470 if (atomic_read(&pd->reorder_objects))
471 padata_reorder(pd);
472
e15bacbe
DK
473 for_each_cpu(cpu, pd->cpumask.cbcpu) {
474 squeue = per_cpu_ptr(pd->squeue, cpu);
475 flush_work(&squeue->work);
2b73b07a
SK
476 }
477
478 BUG_ON(atomic_read(&pd->refcnt) != 0);
479}
480
4c879170
SK
481static void __padata_start(struct padata_instance *pinst)
482{
483 pinst->flags |= PADATA_INIT;
484}
485
ee836555
SK
486static void __padata_stop(struct padata_instance *pinst)
487{
488 if (!(pinst->flags & PADATA_INIT))
489 return;
490
491 pinst->flags &= ~PADATA_INIT;
492
493 synchronize_rcu();
494
495 get_online_cpus();
496 padata_flush_queues(pinst->pd);
497 put_online_cpus();
498}
499
25985edc 500/* Replace the internal control structure with a new one. */
16295bec
SK
501static void padata_replace(struct padata_instance *pinst,
502 struct parallel_data *pd_new)
503{
504 struct parallel_data *pd_old = pinst->pd;
e15bacbe 505 int notification_mask = 0;
16295bec
SK
506
507 pinst->flags |= PADATA_RESET;
508
509 rcu_assign_pointer(pinst->pd, pd_new);
510
511 synchronize_rcu();
512
e15bacbe
DK
513 if (!cpumask_equal(pd_old->cpumask.pcpu, pd_new->cpumask.pcpu))
514 notification_mask |= PADATA_CPU_PARALLEL;
515 if (!cpumask_equal(pd_old->cpumask.cbcpu, pd_new->cpumask.cbcpu))
516 notification_mask |= PADATA_CPU_SERIAL;
517
2b73b07a 518 padata_flush_queues(pd_old);
16295bec
SK
519 padata_free_pd(pd_old);
520
e15bacbe
DK
521 if (notification_mask)
522 blocking_notifier_call_chain(&pinst->cpumask_change_notifier,
c635696c
SK
523 notification_mask,
524 &pd_new->cpumask);
16295bec
SK
525
526 pinst->flags &= ~PADATA_RESET;
527}
528
0198ffd1 529/**
e15bacbe
DK
530 * padata_register_cpumask_notifier - Registers a notifier that will be called
531 * if either pcpu or cbcpu or both cpumasks change.
16295bec 532 *
e15bacbe
DK
533 * @pinst: A poineter to padata instance
534 * @nblock: A pointer to notifier block.
16295bec 535 */
e15bacbe
DK
536int padata_register_cpumask_notifier(struct padata_instance *pinst,
537 struct notifier_block *nblock)
16295bec 538{
e15bacbe
DK
539 return blocking_notifier_chain_register(&pinst->cpumask_change_notifier,
540 nblock);
541}
542EXPORT_SYMBOL(padata_register_cpumask_notifier);
543
544/**
545 * padata_unregister_cpumask_notifier - Unregisters cpumask notifier
546 * registered earlier using padata_register_cpumask_notifier
547 *
548 * @pinst: A pointer to data instance.
549 * @nlock: A pointer to notifier block.
550 */
551int padata_unregister_cpumask_notifier(struct padata_instance *pinst,
552 struct notifier_block *nblock)
553{
554 return blocking_notifier_chain_unregister(
555 &pinst->cpumask_change_notifier,
556 nblock);
557}
558EXPORT_SYMBOL(padata_unregister_cpumask_notifier);
559
560
33e54450
SK
561/* If cpumask contains no active cpu, we mark the instance as invalid. */
562static bool padata_validate_cpumask(struct padata_instance *pinst,
563 const struct cpumask *cpumask)
564{
13614e0f 565 if (!cpumask_intersects(cpumask, cpu_online_mask)) {
33e54450
SK
566 pinst->flags |= PADATA_INVALID;
567 return false;
568 }
569
570 pinst->flags &= ~PADATA_INVALID;
571 return true;
572}
573
65ff577e
SK
574static int __padata_set_cpumasks(struct padata_instance *pinst,
575 cpumask_var_t pcpumask,
576 cpumask_var_t cbcpumask)
577{
578 int valid;
16295bec 579 struct parallel_data *pd;
65ff577e
SK
580
581 valid = padata_validate_cpumask(pinst, pcpumask);
582 if (!valid) {
583 __padata_stop(pinst);
584 goto out_replace;
585 }
586
587 valid = padata_validate_cpumask(pinst, cbcpumask);
588 if (!valid)
589 __padata_stop(pinst);
590
591out_replace:
592 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
593 if (!pd)
594 return -ENOMEM;
595
596 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
597 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
598
599 padata_replace(pinst, pd);
600
601 if (valid)
602 __padata_start(pinst);
603
604 return 0;
605}
606
e15bacbe
DK
607/**
608 * padata_set_cpumask: Sets specified by @cpumask_type cpumask to the value
609 * equivalent to @cpumask.
16295bec
SK
610 *
611 * @pinst: padata instance
e15bacbe
DK
612 * @cpumask_type: PADATA_CPU_SERIAL or PADATA_CPU_PARALLEL corresponding
613 * to parallel and serial cpumasks respectively.
16295bec
SK
614 * @cpumask: the cpumask to use
615 */
e15bacbe
DK
616int padata_set_cpumask(struct padata_instance *pinst, int cpumask_type,
617 cpumask_var_t cpumask)
618{
619 struct cpumask *serial_mask, *parallel_mask;
65ff577e
SK
620 int err = -EINVAL;
621
622 mutex_lock(&pinst->lock);
6751fb3c
SK
623 get_online_cpus();
624
e15bacbe
DK
625 switch (cpumask_type) {
626 case PADATA_CPU_PARALLEL:
627 serial_mask = pinst->cpumask.cbcpu;
628 parallel_mask = cpumask;
629 break;
630 case PADATA_CPU_SERIAL:
631 parallel_mask = pinst->cpumask.pcpu;
632 serial_mask = cpumask;
633 break;
634 default:
65ff577e 635 goto out;
16295bec
SK
636 }
637
65ff577e 638 err = __padata_set_cpumasks(pinst, parallel_mask, serial_mask);
16295bec
SK
639
640out:
6751fb3c 641 put_online_cpus();
16295bec
SK
642 mutex_unlock(&pinst->lock);
643
644 return err;
645}
646EXPORT_SYMBOL(padata_set_cpumask);
647
19d795b6
AB
648/**
649 * padata_start - start the parallel processing
650 *
651 * @pinst: padata instance to start
652 */
653int padata_start(struct padata_instance *pinst)
654{
655 int err = 0;
656
657 mutex_lock(&pinst->lock);
658
659 if (pinst->flags & PADATA_INVALID)
660 err = -EINVAL;
661
662 __padata_start(pinst);
663
664 mutex_unlock(&pinst->lock);
665
666 return err;
667}
668EXPORT_SYMBOL(padata_start);
669
670/**
671 * padata_stop - stop the parallel processing
672 *
673 * @pinst: padata instance to stop
674 */
675void padata_stop(struct padata_instance *pinst)
676{
677 mutex_lock(&pinst->lock);
678 __padata_stop(pinst);
679 mutex_unlock(&pinst->lock);
680}
681EXPORT_SYMBOL(padata_stop);
682
683#ifdef CONFIG_HOTPLUG_CPU
684
16295bec
SK
685static int __padata_add_cpu(struct padata_instance *pinst, int cpu)
686{
687 struct parallel_data *pd;
688
13614e0f 689 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
e15bacbe
DK
690 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
691 pinst->cpumask.cbcpu);
16295bec
SK
692 if (!pd)
693 return -ENOMEM;
694
695 padata_replace(pinst, pd);
33e54450 696
e15bacbe
DK
697 if (padata_validate_cpumask(pinst, pinst->cpumask.pcpu) &&
698 padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
33e54450 699 __padata_start(pinst);
16295bec
SK
700 }
701
702 return 0;
703}
704
16295bec
SK
705static int __padata_remove_cpu(struct padata_instance *pinst, int cpu)
706{
33e54450 707 struct parallel_data *pd = NULL;
16295bec
SK
708
709 if (cpumask_test_cpu(cpu, cpu_online_mask)) {
33e54450 710
e15bacbe 711 if (!padata_validate_cpumask(pinst, pinst->cpumask.pcpu) ||
b89661df 712 !padata_validate_cpumask(pinst, pinst->cpumask.cbcpu))
33e54450 713 __padata_stop(pinst);
33e54450 714
e15bacbe
DK
715 pd = padata_alloc_pd(pinst, pinst->cpumask.pcpu,
716 pinst->cpumask.cbcpu);
16295bec
SK
717 if (!pd)
718 return -ENOMEM;
719
720 padata_replace(pinst, pd);
96120905
SK
721
722 cpumask_clear_cpu(cpu, pd->cpumask.cbcpu);
723 cpumask_clear_cpu(cpu, pd->cpumask.pcpu);
16295bec
SK
724 }
725
726 return 0;
727}
728
e15bacbe 729 /**
25985edc 730 * padata_remove_cpu - remove a cpu from the one or both(serial and parallel)
e15bacbe 731 * padata cpumasks.
16295bec
SK
732 *
733 * @pinst: padata instance
734 * @cpu: cpu to remove
e15bacbe
DK
735 * @mask: bitmask specifying from which cpumask @cpu should be removed
736 * The @mask may be any combination of the following flags:
737 * PADATA_CPU_SERIAL - serial cpumask
738 * PADATA_CPU_PARALLEL - parallel cpumask
16295bec 739 */
e15bacbe 740int padata_remove_cpu(struct padata_instance *pinst, int cpu, int mask)
16295bec
SK
741{
742 int err;
743
e15bacbe
DK
744 if (!(mask & (PADATA_CPU_SERIAL | PADATA_CPU_PARALLEL)))
745 return -EINVAL;
746
16295bec
SK
747 mutex_lock(&pinst->lock);
748
6751fb3c 749 get_online_cpus();
e15bacbe
DK
750 if (mask & PADATA_CPU_SERIAL)
751 cpumask_clear_cpu(cpu, pinst->cpumask.cbcpu);
752 if (mask & PADATA_CPU_PARALLEL)
753 cpumask_clear_cpu(cpu, pinst->cpumask.pcpu);
754
16295bec 755 err = __padata_remove_cpu(pinst, cpu);
6751fb3c 756 put_online_cpus();
16295bec
SK
757
758 mutex_unlock(&pinst->lock);
759
760 return err;
761}
762EXPORT_SYMBOL(padata_remove_cpu);
763
e15bacbe
DK
764static inline int pinst_has_cpu(struct padata_instance *pinst, int cpu)
765{
766 return cpumask_test_cpu(cpu, pinst->cpumask.pcpu) ||
767 cpumask_test_cpu(cpu, pinst->cpumask.cbcpu);
768}
769
30e92153 770static int padata_cpu_online(unsigned int cpu, struct hlist_node *node)
16295bec 771{
16295bec 772 struct padata_instance *pinst;
30e92153 773 int ret;
16295bec 774
30e92153
SAS
775 pinst = hlist_entry_safe(node, struct padata_instance, node);
776 if (!pinst_has_cpu(pinst, cpu))
777 return 0;
16295bec 778
30e92153
SAS
779 mutex_lock(&pinst->lock);
780 ret = __padata_add_cpu(pinst, cpu);
781 mutex_unlock(&pinst->lock);
782 return ret;
783}
16295bec 784
30e92153
SAS
785static int padata_cpu_prep_down(unsigned int cpu, struct hlist_node *node)
786{
787 struct padata_instance *pinst;
788 int ret;
789
790 pinst = hlist_entry_safe(node, struct padata_instance, node);
791 if (!pinst_has_cpu(pinst, cpu))
792 return 0;
16295bec 793
30e92153
SAS
794 mutex_lock(&pinst->lock);
795 ret = __padata_remove_cpu(pinst, cpu);
796 mutex_unlock(&pinst->lock);
797 return ret;
16295bec 798}
30e92153
SAS
799
800static enum cpuhp_state hp_online;
e2cb2f1c 801#endif
16295bec 802
5e017dc3
DK
803static void __padata_free(struct padata_instance *pinst)
804{
805#ifdef CONFIG_HOTPLUG_CPU
30e92153 806 cpuhp_state_remove_instance_nocalls(hp_online, &pinst->node);
5e017dc3
DK
807#endif
808
809 padata_stop(pinst);
810 padata_free_pd(pinst->pd);
811 free_cpumask_var(pinst->cpumask.pcpu);
812 free_cpumask_var(pinst->cpumask.cbcpu);
813 kfree(pinst);
814}
815
816#define kobj2pinst(_kobj) \
817 container_of(_kobj, struct padata_instance, kobj)
818#define attr2pentry(_attr) \
819 container_of(_attr, struct padata_sysfs_entry, attr)
820
821static void padata_sysfs_release(struct kobject *kobj)
822{
823 struct padata_instance *pinst = kobj2pinst(kobj);
824 __padata_free(pinst);
825}
826
827struct padata_sysfs_entry {
828 struct attribute attr;
829 ssize_t (*show)(struct padata_instance *, struct attribute *, char *);
830 ssize_t (*store)(struct padata_instance *, struct attribute *,
831 const char *, size_t);
832};
833
834static ssize_t show_cpumask(struct padata_instance *pinst,
835 struct attribute *attr, char *buf)
836{
837 struct cpumask *cpumask;
838 ssize_t len;
839
840 mutex_lock(&pinst->lock);
841 if (!strcmp(attr->name, "serial_cpumask"))
842 cpumask = pinst->cpumask.cbcpu;
843 else
844 cpumask = pinst->cpumask.pcpu;
845
4497da6f
TH
846 len = snprintf(buf, PAGE_SIZE, "%*pb\n",
847 nr_cpu_ids, cpumask_bits(cpumask));
5e017dc3 848 mutex_unlock(&pinst->lock);
4497da6f 849 return len < PAGE_SIZE ? len : -EINVAL;
5e017dc3
DK
850}
851
852static ssize_t store_cpumask(struct padata_instance *pinst,
853 struct attribute *attr,
854 const char *buf, size_t count)
855{
856 cpumask_var_t new_cpumask;
857 ssize_t ret;
858 int mask_type;
859
860 if (!alloc_cpumask_var(&new_cpumask, GFP_KERNEL))
861 return -ENOMEM;
862
863 ret = bitmap_parse(buf, count, cpumask_bits(new_cpumask),
864 nr_cpumask_bits);
865 if (ret < 0)
866 goto out;
867
868 mask_type = !strcmp(attr->name, "serial_cpumask") ?
869 PADATA_CPU_SERIAL : PADATA_CPU_PARALLEL;
870 ret = padata_set_cpumask(pinst, mask_type, new_cpumask);
871 if (!ret)
872 ret = count;
873
874out:
875 free_cpumask_var(new_cpumask);
876 return ret;
877}
878
879#define PADATA_ATTR_RW(_name, _show_name, _store_name) \
880 static struct padata_sysfs_entry _name##_attr = \
881 __ATTR(_name, 0644, _show_name, _store_name)
882#define PADATA_ATTR_RO(_name, _show_name) \
883 static struct padata_sysfs_entry _name##_attr = \
884 __ATTR(_name, 0400, _show_name, NULL)
885
886PADATA_ATTR_RW(serial_cpumask, show_cpumask, store_cpumask);
887PADATA_ATTR_RW(parallel_cpumask, show_cpumask, store_cpumask);
888
889/*
890 * Padata sysfs provides the following objects:
891 * serial_cpumask [RW] - cpumask for serial workers
892 * parallel_cpumask [RW] - cpumask for parallel workers
893 */
894static struct attribute *padata_default_attrs[] = {
895 &serial_cpumask_attr.attr,
896 &parallel_cpumask_attr.attr,
897 NULL,
898};
899
900static ssize_t padata_sysfs_show(struct kobject *kobj,
901 struct attribute *attr, char *buf)
902{
903 struct padata_instance *pinst;
904 struct padata_sysfs_entry *pentry;
905 ssize_t ret = -EIO;
906
907 pinst = kobj2pinst(kobj);
908 pentry = attr2pentry(attr);
909 if (pentry->show)
910 ret = pentry->show(pinst, attr, buf);
911
912 return ret;
913}
914
915static ssize_t padata_sysfs_store(struct kobject *kobj, struct attribute *attr,
916 const char *buf, size_t count)
917{
918 struct padata_instance *pinst;
919 struct padata_sysfs_entry *pentry;
920 ssize_t ret = -EIO;
921
922 pinst = kobj2pinst(kobj);
923 pentry = attr2pentry(attr);
924 if (pentry->show)
925 ret = pentry->store(pinst, attr, buf, count);
926
927 return ret;
928}
929
930static const struct sysfs_ops padata_sysfs_ops = {
931 .show = padata_sysfs_show,
932 .store = padata_sysfs_store,
933};
934
935static struct kobj_type padata_attr_type = {
936 .sysfs_ops = &padata_sysfs_ops,
937 .default_attrs = padata_default_attrs,
938 .release = padata_sysfs_release,
939};
940
0198ffd1 941/**
e6cc1170
SK
942 * padata_alloc_possible - Allocate and initialize padata instance.
943 * Use the cpu_possible_mask for serial and
944 * parallel workers.
16295bec 945 *
16295bec
SK
946 * @wq: workqueue to use for the allocated padata instance
947 */
e6cc1170 948struct padata_instance *padata_alloc_possible(struct workqueue_struct *wq)
e15bacbe 949{
e6cc1170 950 return padata_alloc(wq, cpu_possible_mask, cpu_possible_mask);
e15bacbe 951}
e6cc1170 952EXPORT_SYMBOL(padata_alloc_possible);
e15bacbe
DK
953
954/**
e6cc1170
SK
955 * padata_alloc - allocate and initialize a padata instance and specify
956 * cpumasks for serial and parallel workers.
16295bec 957 *
16295bec 958 * @wq: workqueue to use for the allocated padata instance
e15bacbe
DK
959 * @pcpumask: cpumask that will be used for padata parallelization
960 * @cbcpumask: cpumask that will be used for padata serialization
16295bec 961 */
e6cc1170
SK
962struct padata_instance *padata_alloc(struct workqueue_struct *wq,
963 const struct cpumask *pcpumask,
964 const struct cpumask *cbcpumask)
16295bec 965{
16295bec 966 struct padata_instance *pinst;
33e54450 967 struct parallel_data *pd = NULL;
16295bec
SK
968
969 pinst = kzalloc(sizeof(struct padata_instance), GFP_KERNEL);
970 if (!pinst)
971 goto err;
972
6751fb3c 973 get_online_cpus();
e15bacbe 974 if (!alloc_cpumask_var(&pinst->cpumask.pcpu, GFP_KERNEL))
16295bec 975 goto err_free_inst;
e15bacbe
DK
976 if (!alloc_cpumask_var(&pinst->cpumask.cbcpu, GFP_KERNEL)) {
977 free_cpumask_var(pinst->cpumask.pcpu);
16295bec 978 goto err_free_inst;
33e54450 979 }
e15bacbe
DK
980 if (!padata_validate_cpumask(pinst, pcpumask) ||
981 !padata_validate_cpumask(pinst, cbcpumask))
982 goto err_free_masks;
16295bec 983
e15bacbe
DK
984 pd = padata_alloc_pd(pinst, pcpumask, cbcpumask);
985 if (!pd)
986 goto err_free_masks;
74781387 987
16295bec
SK
988 rcu_assign_pointer(pinst->pd, pd);
989
990 pinst->wq = wq;
991
e15bacbe
DK
992 cpumask_copy(pinst->cpumask.pcpu, pcpumask);
993 cpumask_copy(pinst->cpumask.cbcpu, cbcpumask);
16295bec
SK
994
995 pinst->flags = 0;
996
6751fb3c
SK
997 put_online_cpus();
998
e15bacbe 999 BLOCKING_INIT_NOTIFIER_HEAD(&pinst->cpumask_change_notifier);
5e017dc3 1000 kobject_init(&pinst->kobj, &padata_attr_type);
16295bec
SK
1001 mutex_init(&pinst->lock);
1002
b8b4a416 1003#ifdef CONFIG_HOTPLUG_CPU
30e92153 1004 cpuhp_state_add_instance_nocalls(hp_online, &pinst->node);
b8b4a416 1005#endif
16295bec
SK
1006 return pinst;
1007
e15bacbe
DK
1008err_free_masks:
1009 free_cpumask_var(pinst->cpumask.pcpu);
1010 free_cpumask_var(pinst->cpumask.cbcpu);
16295bec
SK
1011err_free_inst:
1012 kfree(pinst);
6751fb3c 1013 put_online_cpus();
16295bec
SK
1014err:
1015 return NULL;
1016}
16295bec 1017
0198ffd1 1018/**
16295bec
SK
1019 * padata_free - free a padata instance
1020 *
0198ffd1 1021 * @padata_inst: padata instance to free
16295bec
SK
1022 */
1023void padata_free(struct padata_instance *pinst)
1024{
5e017dc3 1025 kobject_put(&pinst->kobj);
16295bec
SK
1026}
1027EXPORT_SYMBOL(padata_free);
30e92153
SAS
1028
1029#ifdef CONFIG_HOTPLUG_CPU
1030
1031static __init int padata_driver_init(void)
1032{
1033 int ret;
1034
1035 ret = cpuhp_setup_state_multi(CPUHP_AP_ONLINE_DYN, "padata:online",
1036 padata_cpu_online,
1037 padata_cpu_prep_down);
1038 if (ret < 0)
1039 return ret;
1040 hp_online = ret;
1041 return 0;
1042}
1043module_init(padata_driver_init);
1044
1045static __exit void padata_driver_exit(void)
1046{
1047 cpuhp_remove_multi_state(hp_online);
1048}
1049module_exit(padata_driver_exit);
1050#endif