| #include <linux/spinlock.h> | |
| #include <linux/task_work.h> | |
| #include <linux/tracehook.h> | |
| static struct callback_head work_exited; /* all we need is ->next == NULL */ | |
| int | |
| task_work_add(struct task_struct *task, struct callback_head *work, bool notify) | |
| { | |
| struct callback_head *head; | |
| do { | |
| head = ACCESS_ONCE(task->task_works); | |
| if (unlikely(head == &work_exited)) | |
| return -ESRCH; | |
| work->next = head; | |
| } while (cmpxchg(&task->task_works, head, work) != head); | |
| if (notify) | |
| set_notify_resume(task); | |
| return 0; | |
| } | |
| struct callback_head * | |
| task_work_cancel(struct task_struct *task, task_work_func_t func) | |
| { | |
| struct callback_head **pprev = &task->task_works; | |
| struct callback_head *work = NULL; | |
| unsigned long flags; | |
| /* | |
| * If cmpxchg() fails we continue without updating pprev. | |
| * Either we raced with task_work_add() which added the | |
| * new entry before this work, we will find it again. Or | |
| * we raced with task_work_run(), *pprev == NULL/exited. | |
| */ | |
| raw_spin_lock_irqsave(&task->pi_lock, flags); | |
| while ((work = ACCESS_ONCE(*pprev))) { | |
| read_barrier_depends(); | |
| if (work->func != func) | |
| pprev = &work->next; | |
| else if (cmpxchg(pprev, work, work->next) == work) | |
| break; | |
| } | |
| raw_spin_unlock_irqrestore(&task->pi_lock, flags); | |
| return work; | |
| } | |
| void task_work_run(void) | |
| { | |
| struct task_struct *task = current; | |
| struct callback_head *work, *head, *next; | |
| for (;;) { | |
| /* | |
| * work->func() can do task_work_add(), do not set | |
| * work_exited unless the list is empty. | |
| */ | |
| do { | |
| work = ACCESS_ONCE(task->task_works); | |
| head = !work && (task->flags & PF_EXITING) ? | |
| &work_exited : NULL; | |
| } while (cmpxchg(&task->task_works, work, head) != work); | |
| if (!work) | |
| break; | |
| /* | |
| * Synchronize with task_work_cancel(). It can't remove | |
| * the first entry == work, cmpxchg(task_works) should | |
| * fail, but it can play with *work and other entries. | |
| */ | |
| raw_spin_unlock_wait(&task->pi_lock); | |
| smp_mb(); | |
| /* Reverse the list to run the works in fifo order */ | |
| head = NULL; | |
| do { | |
| next = work->next; | |
| work->next = head; | |
| head = work; | |
| work = next; | |
| } while (work); | |
| work = head; | |
| do { | |
| next = work->next; | |
| work->func(work); | |
| work = next; | |
| cond_resched(); | |
| } while (work); | |
| } | |
| } |