| #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); |
| } |
| } |