| #include <linux/spinlock.h> | |
| #include <linux/task_work.h> | |
| #include <linux/tracehook.h> | |
| int | |
| task_work_add(struct task_struct *task, struct task_work *twork, bool notify) | |
| { | |
| unsigned long flags; | |
| int err = -ESRCH; | |
| #ifndef TIF_NOTIFY_RESUME | |
| if (notify) | |
| return -ENOTSUPP; | |
| #endif | |
| /* | |
| * We must not insert the new work if the task has already passed | |
| * exit_task_work(). We rely on do_exit()->raw_spin_unlock_wait() | |
| * and check PF_EXITING under pi_lock. | |
| */ | |
| raw_spin_lock_irqsave(&task->pi_lock, flags); | |
| if (likely(!(task->flags & PF_EXITING))) { | |
| hlist_add_head(&twork->hlist, &task->task_works); | |
| err = 0; | |
| } | |
| raw_spin_unlock_irqrestore(&task->pi_lock, flags); | |
| /* test_and_set_bit() implies mb(), see tracehook_notify_resume(). */ | |
| if (likely(!err) && notify) | |
| set_notify_resume(task); | |
| return err; | |
| } | |
| struct task_work * | |
| task_work_cancel(struct task_struct *task, task_work_func_t func) | |
| { | |
| unsigned long flags; | |
| struct task_work *twork; | |
| struct hlist_node *pos; | |
| raw_spin_lock_irqsave(&task->pi_lock, flags); | |
| hlist_for_each_entry(twork, pos, &task->task_works, hlist) { | |
| if (twork->func == func) { | |
| hlist_del(&twork->hlist); | |
| goto found; | |
| } | |
| } | |
| twork = NULL; | |
| found: | |
| raw_spin_unlock_irqrestore(&task->pi_lock, flags); | |
| return twork; | |
| } | |
| void task_work_run(void) | |
| { | |
| struct task_struct *task = current; | |
| struct hlist_head task_works; | |
| struct hlist_node *pos; | |
| raw_spin_lock_irq(&task->pi_lock); | |
| hlist_move_list(&task->task_works, &task_works); | |
| raw_spin_unlock_irq(&task->pi_lock); | |
| if (unlikely(hlist_empty(&task_works))) | |
| return; | |
| /* | |
| * We use hlist to save the space in task_struct, but we want fifo. | |
| * Find the last entry, the list should be short, then process them | |
| * in reverse order. | |
| */ | |
| for (pos = task_works.first; pos->next; pos = pos->next) | |
| ; | |
| for (;;) { | |
| struct hlist_node **pprev = pos->pprev; | |
| struct task_work *twork = container_of(pos, struct task_work, | |
| hlist); | |
| twork->func(twork); | |
| if (pprev == &task_works.first) | |
| break; | |
| pos = container_of(pprev, struct hlist_node, next); | |
| } | |
| } |