Rev 2594 | Rev 2619 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 2594 | Rev 2598 | ||
---|---|---|---|
Line 152... | Line 152... | ||
152 | futex_up(&devices_list_futex); |
152 | futex_up(&devices_list_futex); |
153 | 153 | ||
154 | return device; |
154 | return device; |
155 | } |
155 | } |
156 | 156 | ||
- | 157 | /** |
|
157 | /** Unregister device and free it. Its assumed that driver's device list |
158 | * Unregister device and free it. It's assumed that driver's device list is |
158 | * is already locked. |
159 | * already locked. |
159 | * |
- | |
160 | */ |
160 | */ |
161 | static int devmap_device_unregister_core(devmap_device_t *device) |
161 | static int devmap_device_unregister_core(devmap_device_t *device) |
162 | { |
162 | { |
163 | 163 | ||
164 | list_remove(&(device->devices)); |
164 | list_remove(&(device->devices)); |
Line 169... | Line 169... | ||
169 | 169 | ||
170 | 170 | ||
171 | return EOK; |
171 | return EOK; |
172 | } |
172 | } |
173 | 173 | ||
- | 174 | /** |
|
174 | /** Read info about new driver and add it into linked list of registered drivers. |
175 | * Read info about new driver and add it into linked list of registered |
- | 176 | * drivers. |
|
175 | */ |
177 | */ |
176 | static void devmap_driver_register(devmap_driver_t **odriver) |
178 | static void devmap_driver_register(devmap_driver_t **odriver) |
177 | { |
179 | { |
178 | size_t name_size; |
180 | size_t name_size; |
179 | ipc_callid_t callid; |
181 | ipc_callid_t callid; |
Line 189... | Line 191... | ||
189 | if (IPC_GET_METHOD(icall) != DEVMAP_DRIVER_REGISTER) { |
191 | if (IPC_GET_METHOD(icall) != DEVMAP_DRIVER_REGISTER) { |
190 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
192 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
191 | return; |
193 | return; |
192 | } |
194 | } |
193 | 195 | ||
- | 196 | if (NULL == |
|
194 | if (NULL == (driver = (devmap_driver_t *)malloc(sizeof(devmap_driver_t)))) { |
197 | (driver = (devmap_driver_t *)malloc(sizeof(devmap_driver_t)))) { |
195 | ipc_answer_fast(iid, ENOMEM, 0, 0); |
198 | ipc_answer_fast(iid, ENOMEM, 0, 0); |
196 | return; |
199 | return; |
197 | } |
200 | } |
198 | 201 | ||
199 | /* |
202 | /* |
Line 206... | Line 209... | ||
206 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
209 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
207 | return; |
210 | return; |
208 | } |
211 | } |
209 | 212 | ||
210 | if (name_size > DEVMAP_NAME_MAXLEN) { |
213 | if (name_size > DEVMAP_NAME_MAXLEN) { |
211 | printf("Too logn name: %u: maximum is %u.\n", name_size, DEVMAP_NAME_MAXLEN); |
214 | printf("Too logn name: %u: maximum is %u.\n", name_size, |
- | 215 | DEVMAP_NAME_MAXLEN); |
|
212 | free(driver); |
216 | free(driver); |
213 | ipc_answer_fast(callid, EINVAL, 0, 0); |
217 | ipc_answer_fast(callid, EINVAL, 0, 0); |
214 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
218 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
215 | return; |
219 | return; |
216 | } |
220 | } |
Line 240... | Line 244... | ||
240 | driver->name[name_size] = 0; |
244 | driver->name[name_size] = 0; |
241 | 245 | ||
242 | printf("Read driver name: '%s'.\n", driver->name); |
246 | printf("Read driver name: '%s'.\n", driver->name); |
243 | 247 | ||
244 | /* Initialize futex for list of devices owned by this driver */ |
248 | /* Initialize futex for list of devices owned by this driver */ |
245 | futex_initialize(&(driver->devices_futex) ,1); |
249 | futex_initialize(&(driver->devices_futex), 1); |
246 | 250 | ||
247 | /* |
251 | /* |
248 | * Initialize list of asociated devices |
252 | * Initialize list of asociated devices |
249 | */ |
253 | */ |
250 | list_initialize(&(driver->devices)); |
254 | list_initialize(&(driver->devices)); |
Line 253... | Line 257... | ||
253 | * Create connection to the driver |
257 | * Create connection to the driver |
254 | */ |
258 | */ |
255 | callid = async_get_call(&call); |
259 | callid = async_get_call(&call); |
256 | 260 | ||
257 | if (IPC_M_CONNECT_TO_ME != IPC_GET_METHOD(call)) { |
261 | if (IPC_M_CONNECT_TO_ME != IPC_GET_METHOD(call)) { |
258 | printf("DevMap: Unexpected method: %u.\n", \ |
262 | printf("DevMap: Unexpected method: %u.\n", |
259 | IPC_GET_METHOD(call)); |
263 | IPC_GET_METHOD(call)); |
260 | ipc_answer_fast(callid, ENOTSUP, 0, 0); |
264 | ipc_answer_fast(callid, ENOTSUP, 0, 0); |
261 | 265 | ||
262 | free(driver->name); |
266 | free(driver->name); |
263 | free(driver); |
267 | free(driver); |
264 | ipc_answer_fast(iid, ENOTSUP, 0, 0); |
268 | ipc_answer_fast(iid, ENOTSUP, 0, 0); |
Line 271... | Line 275... | ||
271 | 275 | ||
272 | list_initialize(&(driver->drivers)); |
276 | list_initialize(&(driver->drivers)); |
273 | 277 | ||
274 | futex_down(&drivers_list_futex); |
278 | futex_down(&drivers_list_futex); |
275 | 279 | ||
- | 280 | /* TODO: |
|
276 | /* TODO: check that no driver with name equals to driver->name is registered */ |
281 | * check that no driver with name equal to driver->name is registered |
- | 282 | */ |
|
277 | 283 | ||
278 | /* |
284 | /* |
279 | * Insert new driver into list of registered drivers |
285 | * Insert new driver into list of registered drivers |
280 | */ |
286 | */ |
281 | list_append(&(driver->drivers), &drivers_list); |
287 | list_append(&(driver->drivers), &drivers_list); |
Line 312... | Line 318... | ||
312 | 318 | ||
313 | futex_down(&devices_list_futex); |
319 | futex_down(&devices_list_futex); |
314 | futex_down(&(driver->devices_futex)); |
320 | futex_down(&(driver->devices_futex)); |
315 | 321 | ||
316 | while (!list_empty(&(driver->devices))) { |
322 | while (!list_empty(&(driver->devices))) { |
317 | device = list_get_instance(driver->devices.next, devmap_device_t, driver_devices); |
323 | device = list_get_instance(driver->devices.next, |
- | 324 | devmap_device_t, driver_devices); |
|
318 | printf("Unregister device '%s'.\n", device->name); |
325 | printf("Unregister device '%s'.\n", device->name); |
319 | devmap_device_unregister_core(device); |
326 | devmap_device_unregister_core(device); |
320 | } |
327 | } |
321 | 328 | ||
322 | futex_up(&(driver->devices_futex)); |
329 | futex_up(&(driver->devices_futex)); |
Line 352... | Line 359... | ||
352 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
359 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
353 | return; |
360 | return; |
354 | } |
361 | } |
355 | 362 | ||
356 | /* Create new device entry */ |
363 | /* Create new device entry */ |
- | 364 | if (NULL == |
|
357 | if (NULL == (device = (devmap_device_t *)malloc(sizeof(devmap_device_t)))) { |
365 | (device = (devmap_device_t *)malloc(sizeof(devmap_device_t)))) { |
358 | printf("Cannot allocate new device.\n"); |
366 | printf("Cannot allocate new device.\n"); |
359 | ipc_answer_fast(iid, ENOMEM, 0, 0); |
367 | ipc_answer_fast(iid, ENOMEM, 0, 0); |
360 | return; |
368 | return; |
361 | } |
369 | } |
362 | 370 | ||
Line 454... | Line 462... | ||
454 | */ |
462 | */ |
455 | handle = IPC_GET_ARG1(*call); |
463 | handle = IPC_GET_ARG1(*call); |
456 | dev = devmap_device_find_handle(handle); |
464 | dev = devmap_device_find_handle(handle); |
457 | 465 | ||
458 | if (NULL == dev) { |
466 | if (NULL == dev) { |
459 | printf("DevMap: No registered device with handle %d.\n", handle); |
467 | printf("DevMap: No registered device with handle %d.\n", |
- | 468 | handle); |
|
460 | ipc_answer_fast(callid, ENOENT, 0, 0); |
469 | ipc_answer_fast(callid, ENOENT, 0, 0); |
461 | return; |
470 | return; |
462 | } |
471 | } |
463 | 472 | ||
464 | /* FIXME: is this correct method how to pass argument on forwarding ?*/ |
473 | /* FIXME: is this correct method how to pass argument on forwarding ?*/ |
465 | ipc_forward_fast(callid, dev->driver->phone, (ipcarg_t)(dev->handle), 0); |
474 | ipc_forward_fast(callid, dev->driver->phone, (ipcarg_t)(dev->handle), |
- | 475 | 0); |
|
466 | return; |
476 | return; |
467 | } |
477 | } |
468 | 478 | ||
469 | /** Find handle for device instance identified by name. |
479 | /** Find handle for device instance identified by name. |
470 | * In answer will be send EOK and device handle in arg1 or a error |
480 | * In answer will be send EOK and device handle in arg1 or a error |
Line 506... | Line 516... | ||
506 | } |
516 | } |
507 | 517 | ||
508 | /* |
518 | /* |
509 | * Send confirmation to sender and get data into buffer. |
519 | * Send confirmation to sender and get data into buffer. |
510 | */ |
520 | */ |
511 | if (EOK != (retval = ipc_data_deliver(callid, &call, name, name_size))) { |
521 | if (EOK != (retval = ipc_data_deliver(callid, &call, name, |
- | 522 | name_size))) { |
|
512 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
523 | ipc_answer_fast(iid, EREFUSED, 0, 0); |
513 | return; |
524 | return; |
514 | } |
525 | } |
515 | 526 | ||
516 | /* |
527 | /* |
Line 661... | Line 672... | ||
661 | cont = false; |
672 | cont = false; |
662 | continue; /* Exit thread */ |
673 | continue; /* Exit thread */ |
663 | 674 | ||
664 | case DEVMAP_DEVICE_CONNECT_ME_TO: |
675 | case DEVMAP_DEVICE_CONNECT_ME_TO: |
665 | /* Connect client to selected device */ |
676 | /* Connect client to selected device */ |
666 | printf("DevMap: connect to device %d.\n", IPC_GET_ARG1(call)); |
677 | printf("DevMap: connect to device %d.\n", |
- | 678 | IPC_GET_ARG1(call)); |
|
667 | devmap_forward(callid, &call); |
679 | devmap_forward(callid, &call); |
668 | break; |
680 | break; |
669 | 681 | ||
670 | case DEVMAP_DEVICE_GET_HANDLE: |
682 | case DEVMAP_DEVICE_GET_HANDLE: |
671 | devmap_get_handle(callid, &call); |
683 | devmap_get_handle(callid, &call); |
Line 692... | Line 704... | ||
692 | 704 | ||
693 | printf("DevMap: new connection.\n"); |
705 | printf("DevMap: new connection.\n"); |
694 | 706 | ||
695 | /* Select interface */ |
707 | /* Select interface */ |
696 | switch ((ipcarg_t)(IPC_GET_ARG1(*icall))) { |
708 | switch ((ipcarg_t)(IPC_GET_ARG1(*icall))) { |
697 | case DEVMAP_DRIVER: |
709 | case DEVMAP_DRIVER: |
698 | devmap_connection_driver(iid, icall); |
710 | devmap_connection_driver(iid, icall); |
699 | break; |
711 | break; |
700 | case DEVMAP_CLIENT: |
712 | case DEVMAP_CLIENT: |
701 | devmap_connection_client(iid, icall); |
713 | devmap_connection_client(iid, icall); |
702 | break; |
714 | break; |
703 | default: |
715 | default: |
704 | ipc_answer_fast(iid, ENOENT, 0, 0); /* No such interface */ |
716 | ipc_answer_fast(iid, ENOENT, 0, 0); /* No such interface */ |
705 | printf("DevMap: Unknown interface %u.\n", \ |
717 | printf("DevMap: Unknown interface %u.\n", |
706 | (ipcarg_t)(IPC_GET_ARG1(*icall))); |
718 | (ipcarg_t)(IPC_GET_ARG1(*icall))); |
707 | } |
719 | } |
708 | 720 | ||
709 | /* Cleanup */ |
721 | /* Cleanup */ |
710 | 722 | ||
711 | printf("DevMap: connection closed.\n"); |
723 | printf("DevMap: connection closed.\n"); |
Line 727... | Line 739... | ||
727 | } |
739 | } |
728 | 740 | ||
729 | /* Set a handler of incomming connections */ |
741 | /* Set a handler of incomming connections */ |
730 | async_set_client_connection(devmap_connection); |
742 | async_set_client_connection(devmap_connection); |
731 | 743 | ||
732 | /* Register device mapper at naming service */ |
744 | /* Register device mapper at naming service */ |
733 | if (ipc_connect_to_me(PHONE_NS, SERVICE_DEVMAP, 0, &phonead) != 0) |
745 | if (ipc_connect_to_me(PHONE_NS, SERVICE_DEVMAP, 0, &phonead) != 0) |
734 | return -1; |
746 | return -1; |
735 | 747 | ||
736 | async_manager(); |
748 | async_manager(); |
737 | /* Never reached */ |
749 | /* Never reached */ |