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
|
// SPDX-License-Identifier: GPL-2.0+ OR Apache-2.0
#include <pthread.h>
#include <stdlib.h>
#include "erofs/workqueue.h"
static void *worker_thread(void *arg)
{
struct erofs_workqueue *wq = arg;
struct erofs_work *work;
void *tlsp = NULL;
if (wq->on_start)
tlsp = (wq->on_start)(wq, NULL);
while (true) {
pthread_mutex_lock(&wq->lock);
while (!wq->job_count && !wq->shutdown)
pthread_cond_wait(&wq->cond_empty, &wq->lock);
if (!wq->job_count && wq->shutdown) {
pthread_mutex_unlock(&wq->lock);
break;
}
work = wq->head;
wq->head = work->next;
if (!wq->head)
wq->tail = NULL;
wq->job_count--;
if (wq->job_count == wq->max_jobs - 1)
pthread_cond_broadcast(&wq->cond_full);
pthread_mutex_unlock(&wq->lock);
work->fn(work, tlsp);
}
if (wq->on_exit)
(void)(wq->on_exit)(wq, tlsp);
return NULL;
}
int erofs_destroy_workqueue(struct erofs_workqueue *wq)
{
if (!wq)
return -EINVAL;
pthread_mutex_lock(&wq->lock);
wq->shutdown = true;
pthread_cond_broadcast(&wq->cond_empty);
pthread_mutex_unlock(&wq->lock);
while (wq->nworker) {
int ret = -pthread_join(wq->workers[wq->nworker - 1], NULL);
if (ret)
return ret;
--wq->nworker;
}
free(wq->workers);
pthread_mutex_destroy(&wq->lock);
pthread_cond_destroy(&wq->cond_empty);
pthread_cond_destroy(&wq->cond_full);
return 0;
}
int erofs_alloc_workqueue(struct erofs_workqueue *wq, unsigned int nworker,
unsigned int max_jobs, erofs_wq_func_t on_start,
erofs_wq_func_t on_exit)
{
unsigned int i;
int ret;
if (!wq || nworker <= 0 || max_jobs <= 0)
return -EINVAL;
wq->head = wq->tail = NULL;
wq->max_jobs = max_jobs;
wq->job_count = 0;
wq->shutdown = false;
wq->on_start = on_start;
wq->on_exit = on_exit;
pthread_mutex_init(&wq->lock, NULL);
pthread_cond_init(&wq->cond_empty, NULL);
pthread_cond_init(&wq->cond_full, NULL);
wq->workers = malloc(nworker * sizeof(pthread_t));
if (!wq->workers)
return -ENOMEM;
for (i = 0; i < nworker; i++) {
ret = -pthread_create(&wq->workers[i], NULL, worker_thread, wq);
if (ret)
break;
}
wq->nworker = i;
if (ret)
erofs_destroy_workqueue(wq);
return ret;
}
int erofs_queue_work(struct erofs_workqueue *wq, struct erofs_work *work)
{
if (!wq || !work)
return -EINVAL;
pthread_mutex_lock(&wq->lock);
while (wq->job_count == wq->max_jobs)
pthread_cond_wait(&wq->cond_full, &wq->lock);
work->next = NULL;
if (!wq->head)
wq->head = work;
else
wq->tail->next = work;
wq->tail = work;
wq->job_count++;
pthread_cond_signal(&wq->cond_empty);
pthread_mutex_unlock(&wq->lock);
return 0;
}
|
