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