Rev 3531 | Rev 3597 | Go to most recent revision | Only display areas with differences | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 3531 | Rev 3536 | ||
---|---|---|---|
1 | /* |
1 | /* |
2 | * Copyright (c) 2008 Jakub Jermar |
2 | * Copyright (c) 2008 Jakub Jermar |
3 | * Copyright (c) 2008 Martin Decky |
3 | * Copyright (c) 2008 Martin Decky |
4 | * All rights reserved. |
4 | * All rights reserved. |
5 | * |
5 | * |
6 | * Redistribution and use in source and binary forms, with or without |
6 | * Redistribution and use in source and binary forms, with or without |
7 | * modification, are permitted provided that the following conditions |
7 | * modification, are permitted provided that the following conditions |
8 | * are met: |
8 | * are met: |
9 | * |
9 | * |
10 | * - Redistributions of source code must retain the above copyright |
10 | * - Redistributions of source code must retain the above copyright |
11 | * notice, this list of conditions and the following disclaimer. |
11 | * notice, this list of conditions and the following disclaimer. |
12 | * - Redistributions in binary form must reproduce the above copyright |
12 | * - Redistributions in binary form must reproduce the above copyright |
13 | * notice, this list of conditions and the following disclaimer in the |
13 | * notice, this list of conditions and the following disclaimer in the |
14 | * documentation and/or other materials provided with the distribution. |
14 | * documentation and/or other materials provided with the distribution. |
15 | * - The name of the author may not be used to endorse or promote products |
15 | * - The name of the author may not be used to endorse or promote products |
16 | * derived from this software without specific prior written permission. |
16 | * derived from this software without specific prior written permission. |
17 | * |
17 | * |
18 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
18 | * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
19 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
19 | * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
20 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
20 | * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
21 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
21 | * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
22 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
22 | * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
23 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
23 | * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
24 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
24 | * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
25 | * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
26 | * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
27 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
27 | * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
28 | */ |
28 | */ |
29 | 29 | ||
30 | /** @addtogroup libblock |
30 | /** @addtogroup libblock |
31 | * @{ |
31 | * @{ |
32 | */ |
32 | */ |
33 | /** |
33 | /** |
34 | * @file |
34 | * @file |
35 | * @brief |
35 | * @brief |
36 | */ |
36 | */ |
37 | 37 | ||
38 | #include "libblock.h" |
38 | #include "libblock.h" |
39 | #include "../../srv/vfs/vfs.h" |
39 | #include "../../srv/vfs/vfs.h" |
40 | #include "../../srv/rd/rd.h" |
40 | #include "../../srv/rd/rd.h" |
41 | #include <ipc/devmap.h> |
41 | #include <ipc/devmap.h> |
42 | #include <ipc/services.h> |
42 | #include <ipc/services.h> |
43 | #include <errno.h> |
43 | #include <errno.h> |
44 | #include <sys/mman.h> |
44 | #include <sys/mman.h> |
45 | #include <async.h> |
45 | #include <async.h> |
46 | #include <ipc/ipc.h> |
46 | #include <ipc/ipc.h> |
47 | #include <as.h> |
47 | #include <as.h> |
48 | #include <assert.h> |
48 | #include <assert.h> |
49 | #include <futex.h> |
49 | #include <futex.h> |
50 | #include <libadt/list.h> |
50 | #include <libadt/list.h> |
51 | 51 | ||
52 | /** Lock protecting the device connection list */ |
52 | /** Lock protecting the device connection list */ |
53 | static futex_t dcl_lock = FUTEX_INITIALIZER; |
53 | static futex_t dcl_lock = FUTEX_INITIALIZER; |
54 | /** Device connection list head. */ |
54 | /** Device connection list head. */ |
55 | static LIST_INITIALIZE(dcl_head); |
55 | static LIST_INITIALIZE(dcl_head); |
56 | 56 | ||
57 | typedef struct { |
57 | typedef struct { |
58 | link_t link; |
58 | link_t link; |
59 | int dev_handle; |
59 | int dev_handle; |
60 | int dev_phone; |
60 | int dev_phone; |
61 | void *com_area; |
61 | void *com_area; |
62 | size_t com_size; |
62 | size_t com_size; |
63 | void *bb_buf; |
63 | void *bb_buf; |
64 | off_t bb_off; |
64 | off_t bb_off; |
65 | size_t bb_size; |
65 | size_t bb_size; |
66 | } devcon_t; |
66 | } devcon_t; |
67 | 67 | ||
68 | static devcon_t *devcon_search(dev_handle_t dev_handle) |
68 | static devcon_t *devcon_search(dev_handle_t dev_handle) |
69 | { |
69 | { |
70 | link_t *cur; |
70 | link_t *cur; |
71 | 71 | ||
72 | futex_down(&dcl_lock); |
72 | futex_down(&dcl_lock); |
73 | for (cur = dcl_head.next; cur != &dcl_head; cur = cur->next) { |
73 | for (cur = dcl_head.next; cur != &dcl_head; cur = cur->next) { |
74 | devcon_t *devcon = list_get_instance(cur, devcon_t, link); |
74 | devcon_t *devcon = list_get_instance(cur, devcon_t, link); |
75 | if (devcon->dev_handle == dev_handle) { |
75 | if (devcon->dev_handle == dev_handle) { |
76 | futex_up(&dcl_lock); |
76 | futex_up(&dcl_lock); |
77 | return devcon; |
77 | return devcon; |
78 | } |
78 | } |
79 | } |
79 | } |
80 | futex_up(&dcl_lock); |
80 | futex_up(&dcl_lock); |
81 | return NULL; |
81 | return NULL; |
82 | } |
82 | } |
83 | 83 | ||
84 | static int devcon_add(dev_handle_t dev_handle, int dev_phone, void *com_area, |
84 | static int devcon_add(dev_handle_t dev_handle, int dev_phone, void *com_area, |
85 | size_t com_size, void *bb_buf, off_t bb_off, size_t bb_size) |
85 | size_t com_size, void *bb_buf, off_t bb_off, size_t bb_size) |
86 | { |
86 | { |
87 | link_t *cur; |
87 | link_t *cur; |
88 | devcon_t *devcon; |
88 | devcon_t *devcon; |
89 | 89 | ||
90 | devcon = malloc(sizeof(devcon_t)); |
90 | devcon = malloc(sizeof(devcon_t)); |
91 | if (!devcon) |
91 | if (!devcon) |
92 | return ENOMEM; |
92 | return ENOMEM; |
93 | 93 | ||
94 | link_initialize(&devcon->link); |
94 | link_initialize(&devcon->link); |
95 | devcon->dev_handle = dev_handle; |
95 | devcon->dev_handle = dev_handle; |
96 | devcon->dev_phone = dev_phone; |
96 | devcon->dev_phone = dev_phone; |
97 | devcon->com_area = com_area; |
97 | devcon->com_area = com_area; |
98 | devcon->com_size = com_size; |
98 | devcon->com_size = com_size; |
99 | devcon->bb_buf = bb_buf; |
99 | devcon->bb_buf = bb_buf; |
100 | devcon->bb_off = bb_off; |
100 | devcon->bb_off = bb_off; |
101 | devcon->bb_size = bb_size; |
101 | devcon->bb_size = bb_size; |
102 | 102 | ||
103 | futex_down(&dcl_lock); |
103 | futex_down(&dcl_lock); |
104 | for (cur = dcl_head.next; cur != &dcl_head; cur = cur->next) { |
104 | for (cur = dcl_head.next; cur != &dcl_head; cur = cur->next) { |
105 | devcon_t *d = list_get_instance(cur, devcon_t, link); |
105 | devcon_t *d = list_get_instance(cur, devcon_t, link); |
106 | if (d->dev_handle == dev_handle) { |
106 | if (d->dev_handle == dev_handle) { |
107 | futex_up(&dcl_lock); |
107 | futex_up(&dcl_lock); |
108 | free(devcon); |
108 | free(devcon); |
109 | return EEXIST; |
109 | return EEXIST; |
110 | } |
110 | } |
111 | } |
111 | } |
112 | list_append(&devcon->link, &dcl_head); |
112 | list_append(&devcon->link, &dcl_head); |
113 | futex_up(&dcl_lock); |
113 | futex_up(&dcl_lock); |
114 | return EOK; |
114 | return EOK; |
115 | } |
115 | } |
116 | 116 | ||
117 | static void devcon_remove(devcon_t *devcon) |
117 | static void devcon_remove(devcon_t *devcon) |
118 | { |
118 | { |
119 | futex_down(&dcl_lock); |
119 | futex_down(&dcl_lock); |
120 | list_remove(&devcon->link); |
120 | list_remove(&devcon->link); |
121 | futex_up(&dcl_lock); |
121 | futex_up(&dcl_lock); |
122 | } |
122 | } |
123 | 123 | ||
124 | int |
124 | int |
125 | block_init(dev_handle_t dev_handle, size_t com_size, off_t bb_off, |
125 | block_init(dev_handle_t dev_handle, size_t com_size, off_t bb_off, |
126 | size_t bb_size) |
126 | size_t bb_size) |
127 | { |
127 | { |
128 | int rc; |
128 | int rc; |
129 | int dev_phone; |
129 | int dev_phone; |
130 | void *com_area; |
130 | void *com_area; |
131 | void *bb_buf; |
131 | void *bb_buf; |
132 | 132 | ||
133 | bb_buf = malloc(bb_size); |
133 | bb_buf = malloc(bb_size); |
134 | if (!bb_buf) |
134 | if (!bb_buf) |
135 | return ENOMEM; |
135 | return ENOMEM; |
136 | 136 | ||
137 | com_area = mmap(NULL, com_size, PROTO_READ | PROTO_WRITE, |
137 | com_area = mmap(NULL, com_size, PROTO_READ | PROTO_WRITE, |
138 | MAP_ANONYMOUS | MAP_PRIVATE, 0, 0); |
138 | MAP_ANONYMOUS | MAP_PRIVATE, 0, 0); |
139 | if (!com_area) { |
139 | if (!com_area) { |
140 | free(bb_buf); |
140 | free(bb_buf); |
141 | return ENOMEM; |
141 | return ENOMEM; |
142 | } |
142 | } |
143 | dev_phone = ipc_connect_me_to(PHONE_NS, SERVICE_DEVMAP, |
143 | dev_phone = ipc_connect_me_to(PHONE_NS, SERVICE_DEVMAP, |
144 | DEVMAP_CONNECT_TO_DEVICE, dev_handle); |
144 | DEVMAP_CONNECT_TO_DEVICE, dev_handle); |
145 | 145 | ||
146 | if (dev_phone < 0) { |
146 | if (dev_phone < 0) { |
147 | free(bb_buf); |
147 | free(bb_buf); |
148 | munmap(com_area, com_size); |
148 | munmap(com_area, com_size); |
149 | return dev_phone; |
149 | return dev_phone; |
150 | } |
150 | } |
151 | 151 | ||
152 | rc = ipc_share_out_start(dev_phone, com_area, |
152 | rc = ipc_share_out_start(dev_phone, com_area, |
153 | AS_AREA_READ | AS_AREA_WRITE); |
153 | AS_AREA_READ | AS_AREA_WRITE); |
154 | if (rc != EOK) { |
154 | if (rc != EOK) { |
155 | free(bb_buf); |
155 | free(bb_buf); |
156 | munmap(com_area, com_size); |
156 | munmap(com_area, com_size); |
157 | ipc_hangup(dev_phone); |
157 | ipc_hangup(dev_phone); |
158 | return rc; |
158 | return rc; |
159 | } |
159 | } |
160 | 160 | ||
161 | rc = devcon_add(dev_handle, dev_phone, com_area, com_size, bb_buf, |
161 | rc = devcon_add(dev_handle, dev_phone, com_area, com_size, bb_buf, |
162 | bb_off, bb_size); |
162 | bb_off, bb_size); |
163 | if (rc != EOK) { |
163 | if (rc != EOK) { |
164 | free(bb_buf); |
164 | free(bb_buf); |
165 | munmap(com_area, com_size); |
165 | munmap(com_area, com_size); |
166 | ipc_hangup(dev_phone); |
166 | ipc_hangup(dev_phone); |
167 | return rc; |
167 | return rc; |
168 | } |
168 | } |
169 | 169 | ||
170 | off_t bufpos = 0; |
170 | off_t bufpos = 0; |
171 | size_t buflen = 0; |
171 | size_t buflen = 0; |
172 | if (!block_read(dev_handle, &bufpos, &buflen, &bb_off, |
172 | if (!block_read(dev_handle, &bufpos, &buflen, &bb_off, |
173 | bb_buf, bb_size, bb_size)) { |
173 | bb_buf, bb_size, bb_size)) { |
174 | block_fini(dev_handle); |
174 | block_fini(dev_handle); |
175 | return EIO; /* XXX real error code */ |
175 | return EIO; /* XXX real error code */ |
176 | } |
176 | } |
177 | 177 | ||
178 | return EOK; |
178 | return EOK; |
179 | } |
179 | } |
180 | 180 | ||
181 | void block_fini(dev_handle_t dev_handle) |
181 | void block_fini(dev_handle_t dev_handle) |
182 | { |
182 | { |
183 | devcon_t *devcon = devcon_search(dev_handle); |
183 | devcon_t *devcon = devcon_search(dev_handle); |
184 | assert(devcon); |
184 | assert(devcon); |
185 | 185 | ||
186 | devcon_remove(devcon); |
186 | devcon_remove(devcon); |
187 | 187 | ||
188 | free(devcon->bb_buf); |
188 | free(devcon->bb_buf); |
189 | munmap(devcon->com_area, devcon->com_size); |
189 | munmap(devcon->com_area, devcon->com_size); |
190 | ipc_hangup(devcon->dev_phone); |
190 | ipc_hangup(devcon->dev_phone); |
191 | 191 | ||
192 | free(devcon); |
192 | free(devcon); |
193 | } |
193 | } |
194 | 194 | ||
195 | void *block_bb_get(dev_handle_t dev_handle) |
195 | void *block_bb_get(dev_handle_t dev_handle) |
196 | { |
196 | { |
197 | devcon_t *devcon = devcon_search(dev_handle); |
197 | devcon_t *devcon = devcon_search(dev_handle); |
198 | assert(devcon); |
198 | assert(devcon); |
199 | return devcon->bb_buf; |
199 | return devcon->bb_buf; |
200 | } |
200 | } |
201 | 201 | ||
202 | /** Read data from a block device. |
202 | /** Read data from a block device. |
203 | * |
203 | * |
204 | * @param dev_handle Device handle of the block device. |
204 | * @param dev_handle Device handle of the block device. |
205 | * @param bufpos Pointer to the first unread valid offset within the |
205 | * @param bufpos Pointer to the first unread valid offset within the |
206 | * communication buffer. |
206 | * communication buffer. |
207 | * @param buflen Pointer to the number of unread bytes that are ready in |
207 | * @param buflen Pointer to the number of unread bytes that are ready in |
208 | * the communication buffer. |
208 | * the communication buffer. |
209 | * @param pos Device position to be read. |
209 | * @param pos Device position to be read. |
210 | * @param dst Destination buffer. |
210 | * @param dst Destination buffer. |
211 | * @param size Size of the destination buffer. |
211 | * @param size Size of the destination buffer. |
212 | * @param block_size Block size to be used for the transfer. |
212 | * @param block_size Block size to be used for the transfer. |
213 | * |
213 | * |
214 | * @return True on success, false on failure. |
214 | * @return True on success, false on failure. |
215 | */ |
215 | */ |
216 | bool |
216 | bool |
217 | block_read(int dev_handle, off_t *bufpos, size_t *buflen, off_t *pos, void *dst, |
217 | block_read(int dev_handle, off_t *bufpos, size_t *buflen, off_t *pos, void *dst, |
218 | size_t size, size_t block_size) |
218 | size_t size, size_t block_size) |
219 | { |
219 | { |
220 | off_t offset = 0; |
220 | off_t offset = 0; |
221 | size_t left = size; |
221 | size_t left = size; |
222 | devcon_t *devcon = devcon_search(dev_handle); |
222 | devcon_t *devcon = devcon_search(dev_handle); |
223 | assert(devcon); |
223 | assert(devcon); |
224 | 224 | ||
225 | while (left > 0) { |
225 | while (left > 0) { |
226 | size_t rd; |
226 | size_t rd; |
227 | 227 | ||
228 | if (*bufpos + left < *buflen) |
228 | if (*bufpos + left < *buflen) |
229 | rd = left; |
229 | rd = left; |
230 | else |
230 | else |
231 | rd = *buflen - *bufpos; |
231 | rd = *buflen - *bufpos; |
232 | 232 | ||
233 | if (rd > 0) { |
233 | if (rd > 0) { |
234 | /* |
234 | /* |
235 | * Copy the contents of the communication buffer to the |
235 | * Copy the contents of the communication buffer to the |
236 | * destination buffer. |
236 | * destination buffer. |
237 | */ |
237 | */ |
238 | memcpy(dst + offset, devcon->com_area + *bufpos, rd); |
238 | memcpy(dst + offset, devcon->com_area + *bufpos, rd); |
239 | offset += rd; |
239 | offset += rd; |
240 | *bufpos += rd; |
240 | *bufpos += rd; |
241 | *pos += rd; |
241 | *pos += rd; |
242 | left -= rd; |
242 | left -= rd; |
243 | } |
243 | } |
244 | 244 | ||
245 | if (*bufpos == *buflen) { |
245 | if (*bufpos == *buflen) { |
246 | /* Refill the communication buffer with a new block. */ |
246 | /* Refill the communication buffer with a new block. */ |
247 | ipcarg_t retval; |
247 | ipcarg_t retval; |
248 | int rc = async_req_2_1(devcon->dev_phone, RD_READ_BLOCK, |
248 | int rc = async_req_2_1(devcon->dev_phone, RD_READ_BLOCK, |
249 | *pos / block_size, block_size, &retval); |
249 | *pos / block_size, block_size, &retval); |
250 | if ((rc != EOK) || (retval != EOK)) |
250 | if ((rc != EOK) || (retval != EOK)) |
251 | return false; |
251 | return false; |
252 | 252 | ||
253 | *bufpos = 0; |
253 | *bufpos = 0; |
254 | *buflen = block_size; |
254 | *buflen = block_size; |
255 | } |
255 | } |
256 | } |
256 | } |
257 | 257 | ||
258 | return true; |
258 | return true; |
259 | } |
259 | } |
260 | 260 | ||
261 | block_t *block_get(dev_handle_t dev_handle, off_t offset, size_t bs) |
261 | block_t *block_get(dev_handle_t dev_handle, off_t offset, size_t bs) |
262 | { |
262 | { |
263 | /* FIXME */ |
263 | /* FIXME */ |
264 | block_t *b; |
264 | block_t *b; |
265 | off_t bufpos = 0; |
265 | off_t bufpos = 0; |
266 | size_t buflen = 0; |
266 | size_t buflen = 0; |
267 | off_t pos = offset * bs; |
267 | off_t pos = offset * bs; |
268 | 268 | ||
269 | b = malloc(sizeof(block_t)); |
269 | b = malloc(sizeof(block_t)); |
270 | if (!b) |
270 | if (!b) |
271 | return NULL; |
271 | return NULL; |
272 | 272 | ||
273 | b->data = malloc(bs); |
273 | b->data = malloc(bs); |
274 | if (!b->data) { |
274 | if (!b->data) { |
275 | free(b); |
275 | free(b); |
276 | return NULL; |
276 | return NULL; |
277 | } |
277 | } |
278 | b->size = bs; |
278 | b->size = bs; |
279 | 279 | ||
280 | if (!block_read(dev_handle, &bufpos, &buflen, &pos, b->data, |
280 | if (!block_read(dev_handle, &bufpos, &buflen, &pos, b->data, |
281 | bs, bs)) { |
281 | bs, bs)) { |
282 | free(b->data); |
282 | free(b->data); |
283 | free(b); |
283 | free(b); |
284 | return NULL; |
284 | return NULL; |
285 | } |
285 | } |
286 | 286 | ||
287 | return b; |
287 | return b; |
288 | } |
288 | } |
289 | 289 | ||
290 | void block_put(block_t *block) |
290 | void block_put(block_t *block) |
291 | { |
291 | { |
292 | /* FIXME */ |
292 | /* FIXME */ |
293 | free(block->data); |
293 | free(block->data); |
294 | free(block); |
294 | free(block); |
295 | } |
295 | } |
296 | 296 | ||
297 | /** @} |
297 | /** @} |
298 | */ |
298 | */ |
299 | 299 |