kernel/kthread.c

   1 /* Kernel thread helper functions.
   2  *   Copyright (C) 2004 IBM Corporation, Rusty Russell.
   3  *
   4  * Creation is done via kthreadd, so that we get a clean environment
   5  * even if we're invoked from userspace (think modprobe, hotplug cpu,
   6  * etc.).
   7  */
   8 #include <uapi/linux/sched/types.h>
   9 #include <linux/sched.h>
  10 #include <linux/sched/task.h>
  11 #include <linux/kthread.h>
  12 #include <linux/completion.h>
  13 #include <linux/err.h>
  14 #include <linux/cpuset.h>
  15 #include <linux/unistd.h>
  16 #include <linux/file.h>
  17 #include <linux/export.h>
  18 #include <linux/mutex.h>
  19 #include <linux/slab.h>
  20 #include <linux/freezer.h>
  21 #include <linux/ptrace.h>
  22 #include <linux/uaccess.h>
  23 #include <linux/cgroup.h>
  24 #include <trace/events/sched.h>
  25
  26 static DEFINE_SPINLOCK(kthread_create_lock);
  27 static LIST_HEAD(kthread_create_list);
  28 struct task_struct *kthreadd_task;
  29
  30 struct kthread_create_info
  31 {
  32         /* Information passed to kthread() from kthreadd. */
  33         int (*threadfn)(void *data);
  34         void *data;
  35         int node;
  36
  37         /* Result passed back to kthread_create() from kthreadd. */
  38         struct task_struct *result;
  39         struct completion *done;
  40
  41         struct list_head list;
  42 };
  43
  44 struct kthread {
  45         unsigned long flags;
  46         unsigned int cpu;
  47         void *data;
  48         struct completion parked;
  49         struct completion exited;
  50 };
  51
  52 enum KTHREAD_BITS {
  53         KTHREAD_IS_PER_CPU = 0,
  54         KTHREAD_SHOULD_STOP,
  55         KTHREAD_SHOULD_PARK,
  56         KTHREAD_IS_PARKED,
  57 };
  58
  59 static inline void set_kthread_struct(void *kthread)
  60 {
  61         /*
  62          * We abuse ->set_child_tid to avoid the new member and because it
  63          * can't be wrongly copied by copy_process(). We also rely on fact
  64          * that the caller can't exec, so PF_KTHREAD can't be cleared.
  65          */
  66         current->set_child_tid = (__force void __user *)kthread;
  67 }
  68
  69 static inline struct kthread *to_kthread(struct task_struct *k)
  70 {
  71         WARN_ON(!(k->flags & PF_KTHREAD));
  72         return (__force void *)k->set_child_tid;
  73 }
  74
  75 void free_kthread_struct(struct task_struct *k)
  76 {
  77         /*
  78          * Can be NULL if this kthread was created by kernel_thread()
  79          * or if kmalloc() in kthread() failed.
  80          */
  81         kfree(to_kthread(k));
  82 }
  83
  84 /**
  85  * kthread_should_stop - should this kthread return now?
  86  *
  87  * When someone calls kthread_stop() on your kthread, it will be woken
  88  * and this will return true.  You should then return, and your return
  89  * value will be passed through to kthread_stop().
  90  */
  91 bool kthread_should_stop(void)
  92 {
  93         return test_bit(KTHREAD_SHOULD_STOP, &to_kthread(current)->flags);
  94 }
  95 EXPORT_SYMBOL(kthread_should_stop);
  96
  97 /**
  98  * kthread_should_park - should this kthread park now?
  99  *
 100  * When someone calls kthread_park() on your kthread, it will be woken
 101  * and this will return true.  You should then do the necessary
 102  * cleanup and call kthread_parkme()
 103  *
 104  * Similar to kthread_should_stop(), but this keeps the thread alive
 105  * and in a park position. kthread_unpark() "restarts" the thread and
 106  * calls the thread function again.
 107  */
 108 bool kthread_should_park(void)
 109 {
 110         return test_bit(KTHREAD_SHOULD_PARK, &to_kthread(current)->flags);
 111 }
 112 EXPORT_SYMBOL_GPL(kthread_should_park);
 113
 114 /**
 115  * kthread_freezable_should_stop - should this freezable kthread return now?
 116  * @was_frozen: optional out parameter, indicates whether %current was frozen
 117  *
 118  * kthread_should_stop() for freezable kthreads, which will enter
 119  * refrigerator if necessary.  This function is safe from kthread_stop() /
 120  * freezer deadlock and freezable kthreads should use this function instead
 121  * of calling try_to_freeze() directly.
 122  */
 123 bool kthread_freezable_should_stop(bool *was_frozen)
 124 {
 125         bool frozen = false;
 126
 127         might_sleep();
 128
 129         if (unlikely(freezing(current)))
 130                 frozen = __refrigerator(true);
 131
 132         if (was_frozen)
 133                 *was_frozen = frozen;
 134
 135         return kthread_should_stop();
 136 }
 137 EXPORT_SYMBOL_GPL(kthread_freezable_should_stop);
 138
 139 /**
 140  * kthread_data - return data value specified on kthread creation
 141  * @task: kthread task in question
 142  *
 143  * Return the data value specified when kthread @task was created.
 144  * The caller is responsible for ensuring the validity of @task when
 145  * calling this function.
 146  */
 147 void *kthread_data(struct task_struct *task)
 148 {
 149         return to_kthread(task)->data;
 150 }
 151
 152 /**
 153  * kthread_probe_data - speculative version of kthread_data()
 154  * @task: possible kthread task in question
 155  *
 156  * @task could be a kthread task.  Return the data value specified when it
 157  * was created if accessible.  If @task isn't a kthread task or its data is
 158  * inaccessible for any reason, %NULL is returned.  This function requires
 159  * that @task itself is safe to dereference.
 160  */
 161 void *kthread_probe_data(struct task_struct *task)
 162 {
 163         struct kthread *kthread = to_kthread(task);
 164         void *data = NULL;
 165
 166         probe_kernel_read(&data, &kthread->data, sizeof(data));
 167         return data;
 168 }
 169
 170 static void __kthread_parkme(struct kthread *self)
 171 {
 172         for (;;) {
 173                 set_current_state(TASK_PARKED);
 174                 if (!test_bit(KTHREAD_SHOULD_PARK, &self->flags))
 175                         break;
 176                 if (!test_and_set_bit(KTHREAD_IS_PARKED, &self->flags))
 177                         complete(&self->parked);
 178                 schedule();
 179         }
 180         clear_bit(KTHREAD_IS_PARKED, &self->flags);
 181         __set_current_state(TASK_RUNNING);
 182 }
 183
 184 void kthread_parkme(void)
 185 {
 186         __kthread_parkme(to_kthread(current));
 187 }
 188 EXPORT_SYMBOL_GPL(kthread_parkme);
 189
 190 static int kthread(void *_create)
 191 {
 192         /* Copy data: it's on kthread's stack */
 193         struct kthread_create_info *create = _create;
 194         int (*threadfn)(void *data) = create->threadfn;
 195         void *data = create->data;
 196         struct completion *done;
 197         struct kthread *self;
 198         int ret;
 199
 200         self = kmalloc(sizeof(*self), GFP_KERNEL);
 201         set_kthread_struct(self);
 202
 203         /* If user was SIGKILLed, I release the structure. */
 204         done = xchg(&create->done, NULL);
 205         if (!done) {
 206                 kfree(create);
 207                 do_exit(-EINTR);
 208         }
 209
 210         if (!self) {
 211                 create->result = ERR_PTR(-ENOMEM);
 212                 complete(done);
 213                 do_exit(-ENOMEM);
 214         }
 215
 216         self->flags = 0;
 217         self->data = data;
 218         init_completion(&self->exited);
 219         init_completion(&self->parked);
 220         current->vfork_done = &self->exited;
 221
 222         /* OK, tell user we're spawned, wait for stop or wakeup */
 223         __set_current_state(TASK_UNINTERRUPTIBLE);
 224         create->result = current;
 225         complete(done);
 226         schedule();
 227
 228         ret = -EINTR;
 229         if (!test_bit(KTHREAD_SHOULD_STOP, &self->flags)) {
 230                 cgroup_kthread_ready();
 231                 __kthread_parkme(self);
 232                 ret = threadfn(data);
 233         }
 234         do_exit(ret);
 235 }
 236
 237 /* called from do_fork() to get node information for about to be created task */
 238 int tsk_fork_get_node(struct task_struct *tsk)
 239 {
 240 #ifdef CONFIG_NUMA
 241         if (tsk == kthreadd_task)
 242                 return tsk->pref_node_fork;
 243 #endif
 244         return NUMA_NO_NODE;
 245 }
 246
 247 static void create_kthread(struct kthread_create_info *create)
 248 {
 249         int pid;
 250
 251 #ifdef CONFIG_NUMA
 252         current->pref_node_fork = create->node;
 253 #endif
 254         /* We want our own signal handler (we take no signals by default). */
 255         pid = kernel_thread(kthread, create, CLONE_FS | CLONE_FILES | SIGCHLD);
 256         if (pid < 0) {
 257                 /* If user was SIGKILLed, I release the structure. */
 258                 struct completion *done = xchg(&create->done, NULL);
 259
 260                 if (!done) {
 261                         kfree(create);
 262                         return;
 263                 }
 264                 create->result = ERR_PTR(pid);
 265                 complete(done);
 266         }
 267 }
 268
 269 static __printf(4, 0)
 270 struct task_struct *__kthread_create_on_node(int (*threadfn)(void *data),
 271                                                     void *data, int node,
 272                                                     const char namefmt[],
 273                                                     va_list args)
 274 {
 275         DECLARE_COMPLETION_ONSTACK(done);
 276         struct task_struct *task;
 277         struct kthread_create_info *create = kmalloc(sizeof(*create),
 278                                                      GFP_KERNEL);
 279
 280         if (!create)
 281                 return ERR_PTR(-ENOMEM);
 282         create->threadfn = threadfn;
 283         create->data = data;
 284         create->node = node;
 285         create->done = &done;
 286
 287         spin_lock(&kthread_create_lock);
 288         list_add_tail(&create->list, &kthread_create_list);
 289         spin_unlock(&kthread_create_lock);
 290
 291         wake_up_process(kthreadd_task);
 292         /*
 293          * Wait for completion in killable state, for I might be chosen by
 294          * the OOM killer while kthreadd is trying to allocate memory for
 295          * new kernel thread.
 296          */
 297         if (unlikely(wait_for_completion_killable(&done))) {
 298                 /*
 299                  * If I was SIGKILLed before kthreadd (or new kernel thread)
 300                  * calls complete(), leave the cleanup of this structure to
 301                  * that thread.
 302                  */
 303                 if (xchg(&create->done, NULL))
 304                         return ERR_PTR(-EINTR);
 305                 /*
 306                  * kthreadd (or new kernel thread) will call complete()
 307                  * shortly.
 308                  */
 309                 wait_for_completion(&done);
 310         }
 311         task = create->result;
 312         if (!IS_ERR(task)) {
 313                 static const struct sched_param param = { .sched_priority = 0 };
 314                 char name[TASK_COMM_LEN];
 315
 316                 /*
 317                  * task is already visible to other tasks, so updating
 318                  * COMM must be protected.
 319                  */
 320                 vsnprintf(name, sizeof(name), namefmt, args);
 321                 set_task_comm(task, name);
 322                 /*
 323                  * root may have changed our (kthreadd's) priority or CPU mask.
 324                  * The kernel thread should not inherit these properties.
 325                  */
 326                 sched_setscheduler_nocheck(task, SCHED_NORMAL, &param);
 327                 set_cpus_allowed_ptr(task, cpu_all_mask);
 328         }
 329         kfree(create);
 330         return task;
 331 }
 332
 333 /**
 334  * kthread_create_on_node - create a kthread.
 335  * @threadfn: the function to run until signal_pending(current).
 336  * @data: data ptr for @threadfn.
 337  * @node: task and thread structures for the thread are allocated on this node
 338  * @namefmt: printf-style name for the thread.
 339  *
 340  * Description: This helper function creates and names a kernel
 341  * thread.  The thread will be stopped: use wake_up_process() to start
 342  * it.  See also kthread_run().  The new thread has SCHED_NORMAL policy and
 343  * is affine to all CPUs.
 344  *
 345  * If thread is going to be bound on a particular cpu, give its node
 346  * in @node, to get NUMA affinity for kthread stack, or else give NUMA_NO_NODE.
 347  * When woken, the thread will run @threadfn() with @data as its
 348  * argument. @threadfn() can either call do_exit() directly if it is a
 349  * standalone thread for which no one will call kthread_stop(), or
 350  * return when 'kthread_should_stop()' is true (which means
 351  * kthread_stop() has been called).  The return value should be zero
 352  * or a negative error number; it will be passed to kthread_stop().
 353  *
 354  * Returns a task_struct or ERR_PTR(-ENOMEM) or ERR_PTR(-EINTR).
 355  */
 356 struct task_struct *kthread_create_on_node(int (*threadfn)(void *data),
 357                                            void *data, int node,
 358                                            const char namefmt[],
 359                                            ...)
 360 {
 361         struct task_struct *task;
 362         va_list args;
 363
 364         va_start(args, namefmt);
 365         task = __kthread_create_on_node(threadfn, data, node, namefmt, args);
 366         va_end(args);
 367
 368         return task;
 369 }
 370 EXPORT_SYMBOL(kthread_create_on_node);
 371
 372 static void __kthread_bind_mask(struct task_struct *p, const struct cpumask *mask, long state)
 373 {
 374         unsigned long flags;
 375
 376         if (!wait_task_inactive(p, state)) {
 377                 WARN_ON(1);
 378                 return;
 379         }
 380
 381         /* It's safe because the task is inactive. */
 382         raw_spin_lock_irqsave(&p->pi_lock, flags);
 383         do_set_cpus_allowed(p, mask);
 384         p->flags |= PF_NO_SETAFFINITY;
 385         raw_spin_unlock_irqrestore(&p->pi_lock, flags);
 386 }
 387
 388 static void __kthread_bind(struct task_struct *p, unsigned int cpu, long state)
 389 {
 390         __kthread_bind_mask(p, cpumask_of(cpu), state);
 391 }
 392
 393 void kthread_bind_mask(struct task_struct *p, const struct cpumask *mask)
 394 {
 395         __kthread_bind_mask(p, mask, TASK_UNINTERRUPTIBLE);
 396 }
 397
 398 /**
 399  * kthread_bind - bind a just-created kthread to a cpu.
 400  * @p: thread created by kthread_create().
 401  * @cpu: cpu (might not be online, must be possible) for @k to run on.
 402  *
 403  * Description: This function is equivalent to set_cpus_allowed(),
 404  * except that @cpu doesn't need to be online, and the thread must be
 405  * stopped (i.e., just returned from kthread_create()).
 406  */
 407 void kthread_bind(struct task_struct *p, unsigned int cpu)
 408 {
 409         __kthread_bind(p, cpu, TASK_UNINTERRUPTIBLE);
 410 }
 411 EXPORT_SYMBOL(kthread_bind);
 412
 413 /**
 414  * kthread_create_on_cpu - Create a cpu bound kthread
 415  * @threadfn: the function to run until signal_pending(current).
 416  * @data: data ptr for @threadfn.
 417  * @cpu: The cpu on which the thread should be bound,
 418  * @namefmt: printf-style name for the thread. Format is restricted
 419  *           to "name.*%u". Code fills in cpu number.
 420  *
 421  * Description: This helper function creates and names a kernel thread
 422  * The thread will be woken and put into park mode.
 423  */
 424 struct task_struct *kthread_create_on_cpu(int (*threadfn)(void *data),
 425                                           void *data, unsigned int cpu,
 426                                           const char *namefmt)
 427 {
 428         struct task_struct *p;
 429
 430         p = kthread_create_on_node(threadfn, data, cpu_to_node(cpu), namefmt,
 431                                    cpu);
 432         if (IS_ERR(p))
 433                 return p;
 434         kthread_bind(p, cpu);
 435         /* CPU hotplug need to bind once again when unparking the thread. */
 436         to_kthread(p)->cpu = cpu;
 437         return p;
 438 }
 439
 440 void kthread_set_per_cpu(struct task_struct *k, int cpu)
 441 {
 442         struct kthread *kthread = to_kthread(k);
 443         if (!kthread)
 444                 return;
 445
 446         WARN_ON_ONCE(!(k->flags & PF_NO_SETAFFINITY));
 447
 448         if (cpu < 0) {
 449                 clear_bit(KTHREAD_IS_PER_CPU, &kthread->flags);
 450                 return;
 451         }
 452
 453         kthread->cpu = cpu;
 454         set_bit(KTHREAD_IS_PER_CPU, &kthread->flags);
 455 }
 456
 457 bool kthread_is_per_cpu(struct task_struct *k)
 458 {
 459         struct kthread *kthread = to_kthread(k);
 460         if (!kthread)
 461                 return false;
 462
 463         return test_bit(KTHREAD_IS_PER_CPU, &kthread->flags);
 464 }
 465
 466 /**
 467  * kthread_unpark - unpark a thread created by kthread_create().
 468  * @k:          thread created by kthread_create().
 469  *
 470  * Sets kthread_should_park() for @k to return false, wakes it, and
 471  * waits for it to return. If the thread is marked percpu then its
 472  * bound to the cpu again.
 473  */
 474 void kthread_unpark(struct task_struct *k)
 475 {
 476         struct kthread *kthread = to_kthread(k);
 477
 478         clear_bit(KTHREAD_SHOULD_PARK, &kthread->flags);
 479         /*
 480          * We clear the IS_PARKED bit here as we don't wait
 481          * until the task has left the park code. So if we'd
 482          * park before that happens we'd see the IS_PARKED bit
 483          * which might be about to be cleared.
 484          */
 485         if (test_and_clear_bit(KTHREAD_IS_PARKED, &kthread->flags)) {
 486                 /*
 487                  * Newly created kthread was parked when the CPU was offline.
 488                  * The binding was lost and we need to set it again.
 489                  */
 490                 if (test_bit(KTHREAD_IS_PER_CPU, &kthread->flags))
 491                         __kthread_bind(k, kthread->cpu, TASK_PARKED);
 492                 wake_up_state(k, TASK_PARKED);
 493         }
 494 }
 495 EXPORT_SYMBOL_GPL(kthread_unpark);
 496
 497 /**
 498  * kthread_park - park a thread created by kthread_create().
 499  * @k: thread created by kthread_create().
 500  *
 501  * Sets kthread_should_park() for @k to return true, wakes it, and
 502  * waits for it to return. This can also be called after kthread_create()
 503  * instead of calling wake_up_process(): the thread will park without
 504  * calling threadfn().
 505  *
 506  * Returns 0 if the thread is parked, -ENOSYS if the thread exited.
 507  * If called by the kthread itself just the park bit is set.
 508  */
 509 int kthread_park(struct task_struct *k)
 510 {
 511         struct kthread *kthread = to_kthread(k);
 512
 513         if (WARN_ON(k->flags & PF_EXITING))
 514                 return -ENOSYS;
 515
 516         if (!test_bit(KTHREAD_IS_PARKED, &kthread->flags)) {
 517                 set_bit(KTHREAD_SHOULD_PARK, &kthread->flags);
 518                 if (k != current) {
 519                         wake_up_process(k);
 520                         wait_for_completion(&kthread->parked);
 521                 }
 522         }
 523
 524         return 0;
 525 }
 526 EXPORT_SYMBOL_GPL(kthread_park);
 527
 528 /**
 529  * kthread_stop - stop a thread created by kthread_create().
 530  * @k: thread created by kthread_create().
 531  *
 532  * Sets kthread_should_stop() for @k to return true, wakes it, and
 533  * waits for it to exit. This can also be called after kthread_create()
 534  * instead of calling wake_up_process(): the thread will exit without
 535  * calling threadfn().
 536  *
 537  * If threadfn() may call do_exit() itself, the caller must ensure
 538  * task_struct can't go away.
 539  *
 540  * Returns the result of threadfn(), or %-EINTR if wake_up_process()
 541  * was never called.
 542  */
 543 int kthread_stop(struct task_struct *k)
 544 {
 545         struct kthread *kthread;
 546         int ret;
 547
 548         trace_sched_kthread_stop(k);
 549
 550         get_task_struct(k);
 551         kthread = to_kthread(k);
 552         set_bit(KTHREAD_SHOULD_STOP, &kthread->flags);
 553         kthread_unpark(k);
 554         wake_up_process(k);
 555         wait_for_completion(&kthread->exited);
 556         ret = k->exit_code;
 557         put_task_struct(k);
 558
 559         trace_sched_kthread_stop_ret(ret);
 560         return ret;
 561 }
 562 EXPORT_SYMBOL(kthread_stop);
 563
 564 int kthreadd(void *unused)
 565 {
 566         struct task_struct *tsk = current;
 567
 568         /* Setup a clean context for our children to inherit. */
 569         set_task_comm(tsk, "kthreadd");
 570         ignore_signals(tsk);
 571         set_cpus_allowed_ptr(tsk, cpu_all_mask);
 572         set_mems_allowed(node_states[N_MEMORY]);
 573
 574         current->flags |= PF_NOFREEZE;
 575         cgroup_init_kthreadd();
 576
 577         for (;;) {
 578                 set_current_state(TASK_INTERRUPTIBLE);
 579                 if (list_empty(&kthread_create_list))
 580                         schedule();
 581                 __set_current_state(TASK_RUNNING);
 582
 583                 spin_lock(&kthread_create_lock);
 584                 while (!list_empty(&kthread_create_list)) {
 585                         struct kthread_create_info *create;
 586
 587                         create = list_entry(kthread_create_list.next,
 588                                             struct kthread_create_info, list);
 589                         list_del_init(&create->list);
 590                         spin_unlock(&kthread_create_lock);
 591
 592                         create_kthread(create);
 593
 594                         spin_lock(&kthread_create_lock);
 595                 }
 596                 spin_unlock(&kthread_create_lock);
 597         }
 598
 599         return 0;
 600 }
 601
 602 void __kthread_init_worker(struct kthread_worker *worker,
 603                                 const char *name,
 604                                 struct lock_class_key *key)
 605 {
 606         memset(worker, 0, sizeof(struct kthread_worker));
 607         spin_lock_init(&worker->lock);
 608         lockdep_set_class_and_name(&worker->lock, key, name);
 609         INIT_LIST_HEAD(&worker->work_list);
 610         INIT_LIST_HEAD(&worker->delayed_work_list);
 611 }
 612 EXPORT_SYMBOL_GPL(__kthread_init_worker);
 613
 614 /**
 615  * kthread_worker_fn - kthread function to process kthread_worker
 616  * @worker_ptr: pointer to initialized kthread_worker
 617  *
 618  * This function implements the main cycle of kthread worker. It processes
 619  * work_list until it is stopped with kthread_stop(). It sleeps when the queue
 620  * is empty.
 621  *
 622  * The works are not allowed to keep any locks, disable preemption or interrupts
 623  * when they finish. There is defined a safe point for freezing when one work
 624  * finishes and before a new one is started.
 625  *
 626  * Also the works must not be handled by more than one worker at the same time,
 627  * see also kthread_queue_work().
 628  */
 629 int kthread_worker_fn(void *worker_ptr)
 630 {
 631         struct kthread_worker *worker = worker_ptr;
 632         struct kthread_work *work;
 633
 634         /*
 635          * FIXME: Update the check and remove the assignment when all kthread
 636          * worker users are created using kthread_create_worker*() functions.
 637          */
 638         WARN_ON(worker->task && worker->task != current);
 639         worker->task = current;
 640
 641         if (worker->flags & KTW_FREEZABLE)
 642                 set_freezable();
 643
 644 repeat:
 645         set_current_state(TASK_INTERRUPTIBLE);  /* mb paired w/ kthread_stop */
 646
 647         if (kthread_should_stop()) {
 648                 __set_current_state(TASK_RUNNING);
 649                 spin_lock_irq(&worker->lock);
 650                 worker->task = NULL;
 651                 spin_unlock_irq(&worker->lock);
 652                 return 0;
 653         }
 654
 655         work = NULL;
 656         spin_lock_irq(&worker->lock);
 657         if (!list_empty(&worker->work_list)) {
 658                 work = list_first_entry(&worker->work_list,
 659                                         struct kthread_work, node);
 660                 list_del_init(&work->node);
 661         }
 662         worker->current_work = work;
 663         spin_unlock_irq(&worker->lock);
 664
 665         if (work) {
 666                 __set_current_state(TASK_RUNNING);
 667                 work->func(work);
 668         } else if (!freezing(current))
 669                 schedule();
 670
 671         try_to_freeze();
 672         cond_resched();
 673         goto repeat;
 674 }
 675 EXPORT_SYMBOL_GPL(kthread_worker_fn);
 676
 677 static __printf(3, 0) struct kthread_worker *
 678 __kthread_create_worker(int cpu, unsigned int flags,
 679                         const char namefmt[], va_list args)
 680 {
 681         struct kthread_worker *worker;
 682         struct task_struct *task;
 683         int node = -1;
 684
 685         worker = kzalloc(sizeof(*worker), GFP_KERNEL);
 686         if (!worker)
 687                 return ERR_PTR(-ENOMEM);
 688
 689         kthread_init_worker(worker);
 690
 691         if (cpu >= 0)
 692                 node = cpu_to_node(cpu);
 693
 694         task = __kthread_create_on_node(kthread_worker_fn, worker,
 695                                                 node, namefmt, args);
 696         if (IS_ERR(task))
 697                 goto fail_task;
 698
 699         if (cpu >= 0)
 700                 kthread_bind(task, cpu);
 701
 702         worker->flags = flags;
 703         worker->task = task;
 704         wake_up_process(task);
 705         return worker;
 706
 707 fail_task:
 708         kfree(worker);
 709         return ERR_CAST(task);
 710 }
 711
 712 /**
 713  * kthread_create_worker - create a kthread worker
 714  * @flags: flags modifying the default behavior of the worker
 715  * @namefmt: printf-style name for the kthread worker (task).
 716  *
 717  * Returns a pointer to the allocated worker on success, ERR_PTR(-ENOMEM)
 718  * when the needed structures could not get allocated, and ERR_PTR(-EINTR)
 719  * when the worker was SIGKILLed.
 720  */
 721 struct kthread_worker *
 722 kthread_create_worker(unsigned int flags, const char namefmt[], ...)
 723 {
 724         struct kthread_worker *worker;
 725         va_list args;
 726
 727         va_start(args, namefmt);
 728         worker = __kthread_create_worker(-1, flags, namefmt, args);
 729         va_end(args);
 730
 731         return worker;
 732 }
 733 EXPORT_SYMBOL(kthread_create_worker);
 734
 735 /**
 736  * kthread_create_worker_on_cpu - create a kthread worker and bind it
 737  *      it to a given CPU and the associated NUMA node.
 738  * @cpu: CPU number
 739  * @flags: flags modifying the default behavior of the worker
 740  * @namefmt: printf-style name for the kthread worker (task).
 741  *
 742  * Use a valid CPU number if you want to bind the kthread worker
 743  * to the given CPU and the associated NUMA node.
 744  *
 745  * A good practice is to add the cpu number also into the worker name.
 746  * For example, use kthread_create_worker_on_cpu(cpu, "helper/%d", cpu).
 747  *
 748  * Returns a pointer to the allocated worker on success, ERR_PTR(-ENOMEM)
 749  * when the needed structures could not get allocated, and ERR_PTR(-EINTR)
 750  * when the worker was SIGKILLed.
 751  */
 752 struct kthread_worker *
 753 kthread_create_worker_on_cpu(int cpu, unsigned int flags,
 754                              const char namefmt[], ...)
 755 {
 756         struct kthread_worker *worker;
 757         va_list args;
 758
 759         va_start(args, namefmt);
 760         worker = __kthread_create_worker(cpu, flags, namefmt, args);
 761         va_end(args);
 762
 763         return worker;
 764 }
 765 EXPORT_SYMBOL(kthread_create_worker_on_cpu);
 766
 767 /*
 768  * Returns true when the work could not be queued at the moment.
 769  * It happens when it is already pending in a worker list
 770  * or when it is being cancelled.
 771  */
 772 static inline bool queuing_blocked(struct kthread_worker *worker,
 773                                    struct kthread_work *work)
 774 {
 775         lockdep_assert_held(&worker->lock);
 776
 777         return !list_empty(&work->node) || work->canceling;
 778 }
 779
 780 static void kthread_insert_work_sanity_check(struct kthread_worker *worker,
 781                                              struct kthread_work *work)
 782 {
 783         lockdep_assert_held(&worker->lock);
 784         WARN_ON_ONCE(!list_empty(&work->node));
 785         /* Do not use a work with >1 worker, see kthread_queue_work() */
 786         WARN_ON_ONCE(work->worker && work->worker != worker);
 787 }
 788
 789 /* insert @work before @pos in @worker */
 790 static void kthread_insert_work(struct kthread_worker *worker,
 791                                 struct kthread_work *work,
 792                                 struct list_head *pos)
 793 {
 794         kthread_insert_work_sanity_check(worker, work);
 795
 796         list_add_tail(&work->node, pos);
 797         work->worker = worker;
 798         if (!worker->current_work && likely(worker->task))
 799                 wake_up_process(worker->task);
 800 }
 801
 802 /**
 803  * kthread_queue_work - queue a kthread_work
 804  * @worker: target kthread_worker
 805  * @work: kthread_work to queue
 806  *
 807  * Queue @work to work processor @task for async execution.  @task
 808  * must have been created with kthread_worker_create().  Returns %true
 809  * if @work was successfully queued, %false if it was already pending.
 810  *
 811  * Reinitialize the work if it needs to be used by another worker.
 812  * For example, when the worker was stopped and started again.
 813  */
 814 bool kthread_queue_work(struct kthread_worker *worker,
 815                         struct kthread_work *work)
 816 {
 817         bool ret = false;
 818         unsigned long flags;
 819
 820         spin_lock_irqsave(&worker->lock, flags);
 821         if (!queuing_blocked(worker, work)) {
 822                 kthread_insert_work(worker, work, &worker->work_list);
 823                 ret = true;
 824         }
 825         spin_unlock_irqrestore(&worker->lock, flags);
 826         return ret;
 827 }
 828 EXPORT_SYMBOL_GPL(kthread_queue_work);
 829
 830 /**
 831  * kthread_delayed_work_timer_fn - callback that queues the associated kthread
 832  *      delayed work when the timer expires.
 833  * @__data: pointer to the data associated with the timer
 834  *
 835  * The format of the function is defined by struct timer_list.
 836  * It should have been called from irqsafe timer with irq already off.
 837  */
 838 void kthread_delayed_work_timer_fn(unsigned long __data)
 839 {
 840         struct kthread_delayed_work *dwork =
 841                 (struct kthread_delayed_work *)__data;
 842         struct kthread_work *work = &dwork->work;
 843         struct kthread_worker *worker = work->worker;
 844
 845         /*
 846          * This might happen when a pending work is reinitialized.
 847          * It means that it is used a wrong way.
 848          */
 849         if (WARN_ON_ONCE(!worker))
 850                 return;
 851
 852         spin_lock(&worker->lock);
 853         /* Work must not be used with >1 worker, see kthread_queue_work(). */
 854         WARN_ON_ONCE(work->worker != worker);
 855
 856         /* Move the work from worker->delayed_work_list. */
 857         WARN_ON_ONCE(list_empty(&work->node));
 858         list_del_init(&work->node);
 859         if (!work->canceling)
 860                 kthread_insert_work(worker, work, &worker->work_list);
 861
 862         spin_unlock(&worker->lock);
 863 }
 864 EXPORT_SYMBOL(kthread_delayed_work_timer_fn);
 865
 866 void __kthread_queue_delayed_work(struct kthread_worker *worker,
 867                                   struct kthread_delayed_work *dwork,
 868                                   unsigned long delay)
 869 {
 870         struct timer_list *timer = &dwork->timer;
 871         struct kthread_work *work = &dwork->work;
 872
 873         WARN_ON_ONCE(timer->function != kthread_delayed_work_timer_fn ||
 874                      timer->data != (unsigned long)dwork);
 875
 876         /*
 877          * If @delay is 0, queue @dwork->work immediately.  This is for
 878          * both optimization and correctness.  The earliest @timer can
 879          * expire is on the closest next tick and delayed_work users depend
 880          * on that there's no such delay when @delay is 0.
 881          */
 882         if (!delay) {
 883                 kthread_insert_work(worker, work, &worker->work_list);
 884                 return;
 885         }
 886
 887         /* Be paranoid and try to detect possible races already now. */
 888         kthread_insert_work_sanity_check(worker, work);
 889
 890         list_add(&work->node, &worker->delayed_work_list);
 891         work->worker = worker;
 892         timer->expires = jiffies + delay;
 893         add_timer(timer);
 894 }
 895
 896 /**
 897  * kthread_queue_delayed_work - queue the associated kthread work
 898  *      after a delay.
 899  * @worker: target kthread_worker
 900  * @dwork: kthread_delayed_work to queue
 901  * @delay: number of jiffies to wait before queuing
 902  *
 903  * If the work has not been pending it starts a timer that will queue
 904  * the work after the given @delay. If @delay is zero, it queues the
 905  * work immediately.
 906  *
 907  * Return: %false if the @work has already been pending. It means that
 908  * either the timer was running or the work was queued. It returns %true
 909  * otherwise.
 910  */
 911 bool kthread_queue_delayed_work(struct kthread_worker *worker,
 912                                 struct kthread_delayed_work *dwork,
 913                                 unsigned long delay)
 914 {
 915         struct kthread_work *work = &dwork->work;
 916         unsigned long flags;
 917         bool ret = false;
 918
 919         spin_lock_irqsave(&worker->lock, flags);
 920
 921         if (!queuing_blocked(worker, work)) {
 922                 __kthread_queue_delayed_work(worker, dwork, delay);
 923                 ret = true;
 924         }
 925
 926         spin_unlock_irqrestore(&worker->lock, flags);
 927         return ret;
 928 }
 929 EXPORT_SYMBOL_GPL(kthread_queue_delayed_work);
 930
 931 struct kthread_flush_work {
 932         struct kthread_work     work;
 933         struct completion       done;
 934 };
 935
 936 static void kthread_flush_work_fn(struct kthread_work *work)
 937 {
 938         struct kthread_flush_work *fwork =
 939                 container_of(work, struct kthread_flush_work, work);
 940         complete(&fwork->done);
 941 }
 942
 943 /**
 944  * kthread_flush_work - flush a kthread_work
 945  * @work: work to flush
 946  *
 947  * If @work is queued or executing, wait for it to finish execution.
 948  */
 949 void kthread_flush_work(struct kthread_work *work)
 950 {
 951         struct kthread_flush_work fwork = {
 952                 KTHREAD_WORK_INIT(fwork.work, kthread_flush_work_fn),
 953                 COMPLETION_INITIALIZER_ONSTACK(fwork.done),
 954         };
 955         struct kthread_worker *worker;
 956         bool noop = false;
 957
 958         worker = work->worker;
 959         if (!worker)
 960                 return;
 961
 962         spin_lock_irq(&worker->lock);
 963         /* Work must not be used with >1 worker, see kthread_queue_work(). */
 964         WARN_ON_ONCE(work->worker != worker);
 965
 966         if (!list_empty(&work->node))
 967                 kthread_insert_work(worker, &fwork.work, work->node.next);
 968         else if (worker->current_work == work)
 969                 kthread_insert_work(worker, &fwork.work,
 970                                     worker->work_list.next);
 971         else
 972                 noop = true;
 973
 974         spin_unlock_irq(&worker->lock);
 975
 976         if (!noop)
 977                 wait_for_completion(&fwork.done);
 978 }
 979 EXPORT_SYMBOL_GPL(kthread_flush_work);
 980
 981 /*
 982  * Make sure that the timer is neither set nor running and could
 983  * not manipulate the work list_head any longer.
 984  *
 985  * The function is called under worker->lock. The lock is temporary
 986  * released but the timer can't be set again in the meantime.
 987  */
 988 static void kthread_cancel_delayed_work_timer(struct kthread_work *work,
 989                                               unsigned long *flags)
 990 {
 991         struct kthread_delayed_work *dwork =
 992                 container_of(work, struct kthread_delayed_work, work);
 993         struct kthread_worker *worker = work->worker;
 994
 995         /*
 996          * del_timer_sync() must be called to make sure that the timer
 997          * callback is not running. The lock must be temporary released
 998          * to avoid a deadlock with the callback. In the meantime,
 999          * any queuing is blocked by setting the canceling counter.
1000          */
1001         work->canceling++;
1002         spin_unlock_irqrestore(&worker->lock, *flags);
1003         del_timer_sync(&dwork->timer);
1004         spin_lock_irqsave(&worker->lock, *flags);
1005         work->canceling--;
1006 }
1007
1008 /*
1009  * This function removes the work from the worker queue.
1010  *
1011  * It is called under worker->lock. The caller must make sure that
1012  * the timer used by delayed work is not running, e.g. by calling
1013  * kthread_cancel_delayed_work_timer().
1014  *
1015  * The work might still be in use when this function finishes. See the
1016  * current_work proceed by the worker.
1017  *
1018  * Return: %true if @work was pending and successfully canceled,
1019  *      %false if @work was not pending
1020  */
1021 static bool __kthread_cancel_work(struct kthread_work *work)
1022 {
1023         /*
1024          * Try to remove the work from a worker list. It might either
1025          * be from worker->work_list or from worker->delayed_work_list.
1026          */
1027         if (!list_empty(&work->node)) {
1028                 list_del_init(&work->node);
1029                 return true;
1030         }
1031
1032         return false;
1033 }
1034
1035 /**
1036  * kthread_mod_delayed_work - modify delay of or queue a kthread delayed work
1037  * @worker: kthread worker to use
1038  * @dwork: kthread delayed work to queue
1039  * @delay: number of jiffies to wait before queuing
1040  *
1041  * If @dwork is idle, equivalent to kthread_queue_delayed_work(). Otherwise,
1042  * modify @dwork's timer so that it expires after @delay. If @delay is zero,
1043  * @work is guaranteed to be queued immediately.
1044  *
1045  * Return: %true if @dwork was pending and its timer was modified,
1046  * %false otherwise.
1047  *
1048  * A special case is when the work is being canceled in parallel.
1049  * It might be caused either by the real kthread_cancel_delayed_work_sync()
1050  * or yet another kthread_mod_delayed_work() call. We let the other command
1051  * win and return %false here. The caller is supposed to synchronize these
1052  * operations a reasonable way.
1053  *
1054  * This function is safe to call from any context including IRQ handler.
1055  * See __kthread_cancel_work() and kthread_delayed_work_timer_fn()
1056  * for details.
1057  */
1058 bool kthread_mod_delayed_work(struct kthread_worker *worker,
1059                               struct kthread_delayed_work *dwork,
1060                               unsigned long delay)
1061 {
1062         struct kthread_work *work = &dwork->work;
1063         unsigned long flags;
1064         int ret = false;
1065
1066         spin_lock_irqsave(&worker->lock, flags);
1067
1068         /* Do not bother with canceling when never queued. */
1069         if (!work->worker)
1070                 goto fast_queue;
1071
1072         /* Work must not be used with >1 worker, see kthread_queue_work() */
1073         WARN_ON_ONCE(work->worker != worker);
1074
1075         /*
1076          * Temporary cancel the work but do not fight with another command
1077          * that is canceling the work as well.
1078          *
1079          * It is a bit tricky because of possible races with another
1080          * mod_delayed_work() and cancel_delayed_work() callers.
1081          *
1082          * The timer must be canceled first because worker->lock is released
1083          * when doing so. But the work can be removed from the queue (list)
1084          * only when it can be queued again so that the return value can
1085          * be used for reference counting.
1086          */
1087         kthread_cancel_delayed_work_timer(work, &flags);
1088         if (work->canceling)
1089                 goto out;
1090         ret = __kthread_cancel_work(work);
1091
1092 fast_queue:
1093         __kthread_queue_delayed_work(worker, dwork, delay);
1094 out:
1095         spin_unlock_irqrestore(&worker->lock, flags);
1096         return ret;
1097 }
1098 EXPORT_SYMBOL_GPL(kthread_mod_delayed_work);
1099
1100 static bool __kthread_cancel_work_sync(struct kthread_work *work, bool is_dwork)
1101 {
1102         struct kthread_worker *worker = work->worker;
1103         unsigned long flags;
1104         int ret = false;
1105
1106         if (!worker)
1107                 goto out;
1108
1109         spin_lock_irqsave(&worker->lock, flags);
1110         /* Work must not be used with >1 worker, see kthread_queue_work(). */
1111         WARN_ON_ONCE(work->worker != worker);
1112
1113         if (is_dwork)
1114                 kthread_cancel_delayed_work_timer(work, &flags);
1115
1116         ret = __kthread_cancel_work(work);
1117
1118         if (worker->current_work != work)
1119                 goto out_fast;
1120
1121         /*
1122          * The work is in progress and we need to wait with the lock released.
1123          * In the meantime, block any queuing by setting the canceling counter.
1124          */
1125         work->canceling++;
1126         spin_unlock_irqrestore(&worker->lock, flags);
1127         kthread_flush_work(work);
1128         spin_lock_irqsave(&worker->lock, flags);
1129         work->canceling--;
1130
1131 out_fast:
1132         spin_unlock_irqrestore(&worker->lock, flags);
1133 out:
1134         return ret;
1135 }
1136
1137 /**
1138  * kthread_cancel_work_sync - cancel a kthread work and wait for it to finish
1139  * @work: the kthread work to cancel
1140  *
1141  * Cancel @work and wait for its execution to finish.  This function
1142  * can be used even if the work re-queues itself. On return from this
1143  * function, @work is guaranteed to be not pending or executing on any CPU.
1144  *
1145  * kthread_cancel_work_sync(&delayed_work->work) must not be used for
1146  * delayed_work's. Use kthread_cancel_delayed_work_sync() instead.
1147  *
1148  * The caller must ensure that the worker on which @work was last
1149  * queued can't be destroyed before this function returns.
1150  *
1151  * Return: %true if @work was pending, %false otherwise.
1152  */
1153 bool kthread_cancel_work_sync(struct kthread_work *work)
1154 {
1155         return __kthread_cancel_work_sync(work, false);
1156 }
1157 EXPORT_SYMBOL_GPL(kthread_cancel_work_sync);
1158
1159 /**
1160  * kthread_cancel_delayed_work_sync - cancel a kthread delayed work and
1161  *      wait for it to finish.
1162  * @dwork: the kthread delayed work to cancel
1163  *
1164  * This is kthread_cancel_work_sync() for delayed works.
1165  *
1166  * Return: %true if @dwork was pending, %false otherwise.
1167  */
1168 bool kthread_cancel_delayed_work_sync(struct kthread_delayed_work *dwork)
1169 {
1170         return __kthread_cancel_work_sync(&dwork->work, true);
1171 }
1172 EXPORT_SYMBOL_GPL(kthread_cancel_delayed_work_sync);
1173
1174 /**
1175  * kthread_flush_worker - flush all current works on a kthread_worker
1176  * @worker: worker to flush
1177  *
1178  * Wait until all currently executing or pending works on @worker are
1179  * finished.
1180  */
1181 void kthread_flush_worker(struct kthread_worker *worker)
1182 {
1183         struct kthread_flush_work fwork = {
1184                 KTHREAD_WORK_INIT(fwork.work, kthread_flush_work_fn),
1185                 COMPLETION_INITIALIZER_ONSTACK(fwork.done),
1186         };
1187
1188         kthread_queue_work(worker, &fwork.work);
1189         wait_for_completion(&fwork.done);
1190 }
1191 EXPORT_SYMBOL_GPL(kthread_flush_worker);
1192
1193 /**
1194  * kthread_destroy_worker - destroy a kthread worker
1195  * @worker: worker to be destroyed
1196  *
1197  * Flush and destroy @worker.  The simple flush is enough because the kthread
1198  * worker API is used only in trivial scenarios.  There are no multi-step state
1199  * machines needed.
1200  */
1201 void kthread_destroy_worker(struct kthread_worker *worker)
1202 {
1203         struct task_struct *task;
1204
1205         task = worker->task;
1206         if (WARN_ON(!task))
1207                 return;
1208
1209         kthread_flush_worker(worker);
1210         kthread_stop(task);
1211         WARN_ON(!list_empty(&worker->work_list));
1212         kfree(worker);
1213 }
1214 EXPORT_SYMBOL(kthread_destroy_worker);