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