fix the cause register clear bug
[qemu/qemu-JZ.git] / posix-aio-compat.c
blobc919e3b22d4c96030a1656a4d58a6746318d0c24
1 /*
2 * QEMU posix-aio emulation
4 * Copyright IBM, Corp. 2008
6 * Authors:
7 * Anthony Liguori <aliguori@us.ibm.com>
9 * This work is licensed under the terms of the GNU GPL, version 2. See
10 * the COPYING file in the top-level directory.
14 #include <pthread.h>
15 #include <unistd.h>
16 #include <errno.h>
17 #include <sys/time.h>
18 #include "osdep.h"
20 #include "posix-aio-compat.h"
22 static pthread_mutex_t lock = PTHREAD_MUTEX_INITIALIZER;
23 static pthread_cond_t cond = PTHREAD_COND_INITIALIZER;
24 static pthread_t thread_id;
25 static int max_threads = 64;
26 static int cur_threads = 0;
27 static int idle_threads = 0;
28 static TAILQ_HEAD(, qemu_paiocb) request_list;
30 static void *aio_thread(void *unused)
32 sigset_t set;
34 /* block all signals */
35 sigfillset(&set);
36 sigprocmask(SIG_BLOCK, &set, NULL);
38 while (1) {
39 struct qemu_paiocb *aiocb;
40 size_t offset;
41 int ret = 0;
43 pthread_mutex_lock(&lock);
45 while (TAILQ_EMPTY(&request_list) &&
46 !(ret == ETIMEDOUT)) {
47 struct timespec ts = { 0 };
48 qemu_timeval tv;
50 qemu_gettimeofday(&tv);
51 ts.tv_sec = tv.tv_sec + 10;
52 ret = pthread_cond_timedwait(&cond, &lock, &ts);
55 if (ret == ETIMEDOUT)
56 break;
58 aiocb = TAILQ_FIRST(&request_list);
59 TAILQ_REMOVE(&request_list, aiocb, node);
61 offset = 0;
62 aiocb->active = 1;
64 idle_threads--;
65 pthread_mutex_unlock(&lock);
67 while (offset < aiocb->aio_nbytes) {
68 ssize_t len;
70 if (aiocb->is_write)
71 len = pwrite(aiocb->aio_fildes,
72 (const char *)aiocb->aio_buf + offset,
73 aiocb->aio_nbytes - offset,
74 aiocb->aio_offset + offset);
75 else
76 len = pread(aiocb->aio_fildes,
77 (char *)aiocb->aio_buf + offset,
78 aiocb->aio_nbytes - offset,
79 aiocb->aio_offset + offset);
81 if (len == -1 && errno == EINTR)
82 continue;
83 else if (len == -1) {
84 offset = -errno;
85 break;
86 } else if (len == 0)
87 break;
89 offset += len;
92 pthread_mutex_lock(&lock);
93 aiocb->ret = offset;
94 idle_threads++;
95 pthread_mutex_unlock(&lock);
97 sigqueue(getpid(),
98 aiocb->aio_sigevent.sigev_signo,
99 aiocb->aio_sigevent.sigev_value);
102 idle_threads--;
103 cur_threads--;
104 pthread_mutex_unlock(&lock);
106 return NULL;
109 static int spawn_thread(void)
111 pthread_attr_t attr;
112 int ret;
114 cur_threads++;
115 idle_threads++;
117 pthread_attr_init(&attr);
118 pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_DETACHED);
119 ret = pthread_create(&thread_id, &attr, aio_thread, NULL);
120 pthread_attr_destroy(&attr);
122 return ret;
125 int qemu_paio_init(struct qemu_paioinit *aioinit)
127 TAILQ_INIT(&request_list);
129 return 0;
132 static int qemu_paio_submit(struct qemu_paiocb *aiocb, int is_write)
134 aiocb->is_write = is_write;
135 aiocb->ret = -EINPROGRESS;
136 aiocb->active = 0;
137 pthread_mutex_lock(&lock);
138 if (idle_threads == 0 && cur_threads < max_threads)
139 spawn_thread();
140 TAILQ_INSERT_TAIL(&request_list, aiocb, node);
141 pthread_mutex_unlock(&lock);
142 pthread_cond_broadcast(&cond);
144 return 0;
147 int qemu_paio_read(struct qemu_paiocb *aiocb)
149 return qemu_paio_submit(aiocb, 0);
152 int qemu_paio_write(struct qemu_paiocb *aiocb)
154 return qemu_paio_submit(aiocb, 1);
157 ssize_t qemu_paio_return(struct qemu_paiocb *aiocb)
159 ssize_t ret;
161 pthread_mutex_lock(&lock);
162 ret = aiocb->ret;
163 pthread_mutex_unlock(&lock);
165 return ret;
168 int qemu_paio_error(struct qemu_paiocb *aiocb)
170 ssize_t ret = qemu_paio_return(aiocb);
172 if (ret < 0)
173 ret = -ret;
174 else
175 ret = 0;
177 return ret;
180 int qemu_paio_cancel(int fd, struct qemu_paiocb *aiocb)
182 int ret;
184 pthread_mutex_lock(&lock);
185 if (!aiocb->active) {
186 TAILQ_REMOVE(&request_list, aiocb, node);
187 aiocb->ret = -ECANCELED;
188 ret = QEMU_PAIO_CANCELED;
189 } else if (aiocb->ret == -EINPROGRESS)
190 ret = QEMU_PAIO_NOTCANCELED;
191 else
192 ret = QEMU_PAIO_ALLDONE;
193 pthread_mutex_unlock(&lock);
195 return ret;