Blame view

kernel/linux-imx6_3.14.28/kernel/task_work.c 3.36 KB
6b13f685e   김민수   BSP 최초 추가
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
  #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 */
  
  /**
   * task_work_add - ask the @task to execute @work->func()
   * @task: the task which should run the callback
   * @work: the callback to run
   * @notify: send the notification if true
   *
   * Queue @work for task_work_run() below and notify the @task if @notify.
   * Fails if the @task is exiting/exited and thus it can't process this @work.
   * Otherwise @work->func() will be called when the @task returns from kernel
   * mode or exits.
   *
   * This is like the signal handler which runs in kernel mode, but it doesn't
   * try to wake up the @task.
   *
   * RETURNS:
   * 0 if succeeds or -ESRCH.
   */
  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;
  }
  
  /**
   * task_work_cancel - cancel a pending work added by task_work_add()
   * @task: the task which should execute the work
   * @func: identifies the work to remove
   *
   * Find the last queued pending work with ->func == @func and remove
   * it from queue.
   *
   * RETURNS:
   * The found work or NULL if not found.
   */
  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;
  	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))) {
  		smp_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;
  }
  
  /**
   * task_work_run - execute the works added by task_work_add()
   *
   * Flush the pending works. Should be used by the core kernel code.
   * Called before the task returns to the user-mode or stops, or when
   * it exits. In the latter case task_work_add() can no longer add the
   * new work after task_work_run() returns.
   */
  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);
  	}
  }