source: mainline/uspace/srv/devman/main.c@ 7a46bfe

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since 7a46bfe was f278930, checked in by Jiri Svoboda <jiri@…>, 14 years ago

ISA bridge remove support.
  • Property mode set to 100644
File size: 32.2 KB
Line 
1/*
2 * Copyright (c) 2010 Lenka Trochtova
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 *
9 * - Redistributions of source code must retain the above copyright
10 * notice, this list of conditions and the following disclaimer.
11 * - Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 * - The name of the author may not be used to endorse or promote products
15 * derived from this software without specific prior written permission.
16 *
17 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
27 */
28
29/**
30 * @defgroup devman Device manager.
31 * @brief HelenOS device manager.
32 * @{
33 */
34
35/** @file
36 */
37
38#include <inttypes.h>
39#include <assert.h>
40#include <ipc/services.h>
41#include <ns.h>
42#include <async.h>
43#include <stdio.h>
44#include <errno.h>
45#include <str_error.h>
46#include <bool.h>
47#include <fibril_synch.h>
48#include <stdlib.h>
49#include <str.h>
50#include <dirent.h>
51#include <fcntl.h>
52#include <sys/stat.h>
53#include <ctype.h>
54#include <io/log.h>
55#include <ipc/devman.h>
56#include <ipc/driver.h>
57#include <thread.h>
58#include <loc.h>
59
60#include "devman.h"
61
62#define DRIVER_DEFAULT_STORE "/drv"
63
64static driver_list_t drivers_list;
65static dev_tree_t device_tree;
66
67static int init_running_drv(void *drv);
68
69/** Register running driver. */
70static driver_t *devman_driver_register(ipc_callid_t callid, ipc_call_t *call)
71{
72 driver_t *driver = NULL;
73 char *drv_name = NULL;
74
75 log_msg(LVL_DEBUG, "devman_driver_register");
76
77 /* Get driver name. */
78 int rc = async_data_write_accept((void **) &drv_name, true, 0, 0, 0, 0);
79 if (rc != EOK) {
80 async_answer_0(callid, rc);
81 return NULL;
82 }
83
84 log_msg(LVL_DEBUG, "The `%s' driver is trying to register.",
85 drv_name);
86
87 /* Find driver structure. */
88 driver = find_driver(&drivers_list, drv_name);
89 if (driver == NULL) {
90 log_msg(LVL_ERROR, "No driver named `%s' was found.", drv_name);
91 free(drv_name);
92 drv_name = NULL;
93 async_answer_0(callid, ENOENT);
94 return NULL;
95 }
96
97 free(drv_name);
98 drv_name = NULL;
99
100 fibril_mutex_lock(&driver->driver_mutex);
101
102 if (driver->sess) {
103 /* We already have a connection to the driver. */
104 log_msg(LVL_ERROR, "Driver '%s' already started.\n",
105 driver->name);
106 fibril_mutex_unlock(&driver->driver_mutex);
107 async_answer_0(callid, EEXISTS);
108 return NULL;
109 }
110
111 switch (driver->state) {
112 case DRIVER_NOT_STARTED:
113 /* Somebody started the driver manually. */
114 log_msg(LVL_NOTE, "Driver '%s' started manually.\n",
115 driver->name);
116 driver->state = DRIVER_STARTING;
117 break;
118 case DRIVER_STARTING:
119 /* The expected case */
120 break;
121 case DRIVER_RUNNING:
122 /* Should not happen since we do not have a connected session */
123 assert(false);
124 }
125
126 /* Create connection to the driver. */
127 log_msg(LVL_DEBUG, "Creating connection to the `%s' driver.",
128 driver->name);
129 driver->sess = async_callback_receive(EXCHANGE_PARALLEL);
130 if (!driver->sess) {
131 fibril_mutex_unlock(&driver->driver_mutex);
132 async_answer_0(callid, ENOTSUP);
133 return NULL;
134 }
135 /* FIXME: Work around problem with callback sessions */
136 async_sess_args_set(driver->sess, DRIVER_DEVMAN, 0, 0);
137
138 log_msg(LVL_NOTE,
139 "The `%s' driver was successfully registered as running.",
140 driver->name);
141
142 /*
143 * Initialize the driver as running (e.g. pass assigned devices to it)
144 * in a separate fibril; the separate fibril is used to enable the
145 * driver to use devman service during the driver's initialization.
146 */
147 fid_t fid = fibril_create(init_running_drv, driver);
148 if (fid == 0) {
149 log_msg(LVL_ERROR, "Failed to create initialization fibril " \
150 "for driver `%s'.", driver->name);
151 fibril_mutex_unlock(&driver->driver_mutex);
152 async_answer_0(callid, ENOMEM);
153 return NULL;
154 }
155
156 fibril_add_ready(fid);
157 fibril_mutex_unlock(&driver->driver_mutex);
158
159 async_answer_0(callid, EOK);
160 return driver;
161}
162
163/** Receive device match ID from the device's parent driver and add it to the
164 * list of devices match ids.
165 *
166 * @param match_ids The list of the device's match ids.
167 * @return Zero on success, negative error code otherwise.
168 */
169static int devman_receive_match_id(match_id_list_t *match_ids)
170{
171 match_id_t *match_id = create_match_id();
172 ipc_callid_t callid;
173 ipc_call_t call;
174 int rc = 0;
175
176 callid = async_get_call(&call);
177 if (DEVMAN_ADD_MATCH_ID != IPC_GET_IMETHOD(call)) {
178 log_msg(LVL_ERROR,
179 "Invalid protocol when trying to receive match id.");
180 async_answer_0(callid, EINVAL);
181 delete_match_id(match_id);
182 return EINVAL;
183 }
184
185 if (match_id == NULL) {
186 log_msg(LVL_ERROR, "Failed to allocate match id.");
187 async_answer_0(callid, ENOMEM);
188 return ENOMEM;
189 }
190
191 async_answer_0(callid, EOK);
192
193 match_id->score = IPC_GET_ARG1(call);
194
195 char *match_id_str;
196 rc = async_data_write_accept((void **) &match_id_str, true, 0, 0, 0, 0);
197 match_id->id = match_id_str;
198 if (rc != EOK) {
199 delete_match_id(match_id);
200 log_msg(LVL_ERROR, "Failed to receive match id string: %s.",
201 str_error(rc));
202 return rc;
203 }
204
205 list_append(&match_id->link, &match_ids->ids);
206
207 log_msg(LVL_DEBUG, "Received match id `%s', score %d.",
208 match_id->id, match_id->score);
209 return rc;
210}
211
212/** Receive device match IDs from the device's parent driver and add them to the
213 * list of devices match ids.
214 *
215 * @param match_count The number of device's match ids to be received.
216 * @param match_ids The list of the device's match ids.
217 * @return Zero on success, negative error code otherwise.
218 */
219static int devman_receive_match_ids(sysarg_t match_count,
220 match_id_list_t *match_ids)
221{
222 int ret = EOK;
223 size_t i;
224
225 for (i = 0; i < match_count; i++) {
226 if (EOK != (ret = devman_receive_match_id(match_ids)))
227 return ret;
228 }
229 return ret;
230}
231
232static int assign_driver_fibril(void *arg)
233{
234 dev_node_t *dev_node = (dev_node_t *) arg;
235 assign_driver(dev_node, &drivers_list, &device_tree);
236
237 /* Delete one reference we got from the caller. */
238 dev_del_ref(dev_node);
239 return EOK;
240}
241
242static int online_function(fun_node_t *fun)
243{
244 dev_node_t *dev;
245
246 fibril_rwlock_write_lock(&device_tree.rwlock);
247
248 if (fun->state == FUN_ON_LINE) {
249 fibril_rwlock_write_unlock(&device_tree.rwlock);
250 log_msg(LVL_WARN, "Function %s is already on line.",
251 fun->pathname);
252 return EOK;
253 }
254
255 if (fun->ftype == fun_inner) {
256 dev = create_dev_node();
257 if (dev == NULL) {
258 fibril_rwlock_write_unlock(&device_tree.rwlock);
259 return ENOMEM;
260 }
261
262 insert_dev_node(&device_tree, dev, fun);
263 dev_add_ref(dev);
264 }
265
266 log_msg(LVL_DEBUG, "devman_add_function(fun=\"%s\")", fun->pathname);
267
268 if (fun->ftype == fun_inner) {
269 dev = fun->child;
270 assert(dev != NULL);
271
272 /* Give one reference over to assign_driver_fibril(). */
273 dev_add_ref(dev);
274 /*
275 * Try to find a suitable driver and assign it to the device. We do
276 * not want to block the current fibril that is used for processing
277 * incoming calls: we will launch a separate fibril to handle the
278 * driver assigning. That is because assign_driver can actually include
279 * task spawning which could take some time.
280 */
281 fid_t assign_fibril = fibril_create(assign_driver_fibril, dev);
282 if (assign_fibril == 0) {
283 log_msg(LVL_ERROR, "Failed to create fibril for "
284 "assigning driver.");
285 /* XXX Cleanup */
286 fibril_rwlock_write_unlock(&device_tree.rwlock);
287 return ENOMEM;
288 }
289 fibril_add_ready(assign_fibril);
290 } else {
291 loc_register_tree_function(fun, &device_tree);
292 }
293
294 fibril_rwlock_write_unlock(&device_tree.rwlock);
295
296 return EOK;
297}
298
299static int offline_function(fun_node_t *fun)
300{
301 int rc;
302
303 fibril_rwlock_write_lock(&device_tree.rwlock);
304
305 if (fun->state == FUN_OFF_LINE) {
306 fibril_rwlock_write_unlock(&device_tree.rwlock);
307 log_msg(LVL_WARN, "Function %s is already off line.",
308 fun->pathname);
309 return EOK;
310 }
311
312 if (fun->ftype == fun_inner) {
313 log_msg(LVL_DEBUG, "Offlining inner function %s.",
314 fun->pathname);
315
316 if (fun->child != NULL) {
317 dev_node_t *dev = fun->child;
318
319 dev_add_ref(dev);
320 fibril_rwlock_write_unlock(&device_tree.rwlock);
321
322 /* If device is owned by driver, ask driver to give it up. */
323 if (dev->state == DEVICE_USABLE) {
324 rc = driver_dev_remove(&device_tree, dev);
325 if (rc != EOK) {
326 dev_del_ref(dev);
327 return ENOTSUP;
328 }
329 }
330
331 /* Verify that driver removed all functions */
332 fibril_rwlock_read_lock(&device_tree.rwlock);
333 if (!list_empty(&dev->functions)) {
334 fibril_rwlock_read_unlock(&device_tree.rwlock);
335 return EIO;
336 }
337 driver_t *driver = dev->drv;
338 fibril_rwlock_read_unlock(&device_tree.rwlock);
339
340 if (driver)
341 detach_driver(&device_tree, dev);
342
343 fibril_rwlock_write_lock(&device_tree.rwlock);
344 remove_dev_node(&device_tree, dev);
345
346 /* Delete ref created when node was inserted */
347 dev_del_ref(dev);
348 /* Delete ref created by dev_add_ref(dev) above */
349 dev_del_ref(dev);
350 }
351 } else {
352 /* Unregister from location service */
353 rc = loc_service_unregister(fun->service_id);
354 if (rc != EOK) {
355 fibril_rwlock_write_unlock(&device_tree.rwlock);
356 log_msg(LVL_ERROR, "Failed unregistering tree service.");
357 return EIO;
358 }
359
360 fun->service_id = 0;
361 }
362
363 fun->state = FUN_OFF_LINE;
364 fibril_rwlock_write_unlock(&device_tree.rwlock);
365
366 return EOK;
367}
368
369/** Handle function registration.
370 *
371 * Child devices are registered by their parent's device driver.
372 */
373static void devman_add_function(ipc_callid_t callid, ipc_call_t *call)
374{
375 fun_type_t ftype = (fun_type_t) IPC_GET_ARG1(*call);
376 devman_handle_t dev_handle = IPC_GET_ARG2(*call);
377 sysarg_t match_count = IPC_GET_ARG3(*call);
378 dev_tree_t *tree = &device_tree;
379
380 dev_node_t *pdev = find_dev_node(&device_tree, dev_handle);
381 if (pdev == NULL) {
382 async_answer_0(callid, ENOENT);
383 return;
384 }
385
386 if (ftype != fun_inner && ftype != fun_exposed) {
387 /* Unknown function type */
388 log_msg(LVL_ERROR,
389 "Unknown function type %d provided by driver.",
390 (int) ftype);
391
392 dev_del_ref(pdev);
393 async_answer_0(callid, EINVAL);
394 return;
395 }
396
397 char *fun_name = NULL;
398 int rc = async_data_write_accept((void **)&fun_name, true, 0, 0, 0, 0);
399 if (rc != EOK) {
400 dev_del_ref(pdev);
401 async_answer_0(callid, rc);
402 return;
403 }
404
405 fibril_rwlock_write_lock(&tree->rwlock);
406
407 /* Check device state */
408 if (pdev->state == DEVICE_REMOVED) {
409 fibril_rwlock_write_unlock(&tree->rwlock);
410 dev_del_ref(pdev);
411 async_answer_0(callid, ENOENT);
412 return;
413 }
414
415 /* Check that function with same name is not there already. */
416 if (find_fun_node_in_device(tree, pdev, fun_name) != NULL) {
417 fibril_rwlock_write_unlock(&tree->rwlock);
418 dev_del_ref(pdev);
419 async_answer_0(callid, EEXISTS);
420 printf(NAME ": Warning, driver tried to register `%s' twice.\n",
421 fun_name);
422 free(fun_name);
423 return;
424 }
425
426 fun_node_t *fun = create_fun_node();
427 fun_add_ref(fun);
428 fun->ftype = ftype;
429
430 if (!insert_fun_node(&device_tree, fun, fun_name, pdev)) {
431 fibril_rwlock_write_unlock(&tree->rwlock);
432 dev_del_ref(pdev);
433 delete_fun_node(fun);
434 async_answer_0(callid, ENOMEM);
435 return;
436 }
437
438 fibril_rwlock_write_unlock(&tree->rwlock);
439 dev_del_ref(pdev);
440
441 devman_receive_match_ids(match_count, &fun->match_ids);
442
443 rc = online_function(fun);
444 if (rc != EOK) {
445 /* XXX clean up */
446 async_answer_0(callid, rc);
447 return;
448 }
449
450 /* Return device handle to parent's driver. */
451 async_answer_1(callid, EOK, fun->handle);
452}
453
454static void devman_add_function_to_cat(ipc_callid_t callid, ipc_call_t *call)
455{
456 devman_handle_t handle = IPC_GET_ARG1(*call);
457 category_id_t cat_id;
458 int rc;
459
460 /* Get category name. */
461 char *cat_name;
462 rc = async_data_write_accept((void **) &cat_name, true,
463 0, 0, 0, 0);
464 if (rc != EOK) {
465 async_answer_0(callid, rc);
466 return;
467 }
468
469 fun_node_t *fun = find_fun_node(&device_tree, handle);
470 if (fun == NULL) {
471 async_answer_0(callid, ENOENT);
472 return;
473 }
474
475 fibril_rwlock_read_lock(&device_tree.rwlock);
476
477 /* Check function state */
478 if (fun->state == FUN_REMOVED) {
479 fibril_rwlock_read_unlock(&device_tree.rwlock);
480 async_answer_0(callid, ENOENT);
481 return;
482 }
483
484 rc = loc_category_get_id(cat_name, &cat_id, IPC_FLAG_BLOCKING);
485 if (rc == EOK) {
486 loc_service_add_to_cat(fun->service_id, cat_id);
487 } else {
488 log_msg(LVL_ERROR, "Failed adding function `%s' to category "
489 "`%s'.", fun->pathname, cat_name);
490 }
491
492 log_msg(LVL_NOTE, "Function `%s' added to category `%s'.",
493 fun->pathname, cat_name);
494
495 fibril_rwlock_read_unlock(&device_tree.rwlock);
496 fun_del_ref(fun);
497
498 async_answer_0(callid, EOK);
499}
500
501/** Online function by driver request.
502 *
503 */
504static void devman_drv_fun_online(ipc_callid_t iid, ipc_call_t *icall,
505 driver_t *drv)
506{
507 fun_node_t *fun;
508 int rc;
509
510 printf("devman_drv_fun_online()\n");
511 fun = find_fun_node(&device_tree, IPC_GET_ARG1(*icall));
512 if (fun == NULL) {
513 async_answer_0(iid, ENOENT);
514 return;
515 }
516
517 fibril_rwlock_read_lock(&device_tree.rwlock);
518 if (fun->dev == NULL || fun->dev->drv != drv) {
519 fibril_rwlock_read_unlock(&device_tree.rwlock);
520 fun_del_ref(fun);
521 async_answer_0(iid, ENOENT);
522 return;
523 }
524 fibril_rwlock_read_unlock(&device_tree.rwlock);
525
526 rc = online_function(fun);
527 if (rc != EOK) {
528 printf("devman_drv_fun_online() online_fun->ERROR\n");
529 fun_del_ref(fun);
530 async_answer_0(iid, (sysarg_t) rc);
531 return;
532 }
533
534 fun_del_ref(fun);
535 printf("devman_drv_fun_online() online_fun->OK\n");
536
537 async_answer_0(iid, (sysarg_t) EOK);
538}
539
540
541/** Offline function by driver request.
542 *
543 */
544static void devman_drv_fun_offline(ipc_callid_t iid, ipc_call_t *icall,
545 driver_t *drv)
546{
547 fun_node_t *fun;
548 int rc;
549
550 fun = find_fun_node(&device_tree, IPC_GET_ARG1(*icall));
551 if (fun == NULL) {
552 async_answer_0(iid, ENOENT);
553 return;
554 }
555
556 fibril_rwlock_write_lock(&device_tree.rwlock);
557 if (fun->dev == NULL || fun->dev->drv != drv) {
558 fun_del_ref(fun);
559 async_answer_0(iid, ENOENT);
560 return;
561 }
562 fibril_rwlock_write_unlock(&device_tree.rwlock);
563
564 rc = offline_function(fun);
565 if (rc != EOK) {
566 fun_del_ref(fun);
567 async_answer_0(iid, (sysarg_t) rc);
568 return;
569 }
570
571 fun_del_ref(fun);
572 async_answer_0(iid, (sysarg_t) EOK);
573}
574
575/** Remove function. */
576static void devman_remove_function(ipc_callid_t callid, ipc_call_t *call)
577{
578 devman_handle_t fun_handle = IPC_GET_ARG1(*call);
579 dev_tree_t *tree = &device_tree;
580 int rc;
581
582
583 fun_node_t *fun = find_fun_node(&device_tree, fun_handle);
584 if (fun == NULL) {
585 async_answer_0(callid, ENOENT);
586 return;
587 }
588
589 fibril_rwlock_write_lock(&tree->rwlock);
590
591 log_msg(LVL_DEBUG, "devman_remove_function(fun='%s')", fun->pathname);
592
593 /* Check function state */
594 if (fun->state == FUN_REMOVED) {
595 fibril_rwlock_write_unlock(&tree->rwlock);
596 async_answer_0(callid, ENOENT);
597 return;
598 }
599
600 if (fun->ftype == fun_inner) {
601 /* Handle possible descendants */
602 /* TODO - This is a surprise removal */
603 if (fun->child != NULL) {
604 log_msg(LVL_WARN, "devman_remove_function(): not handling "
605 "descendants\n");
606 }
607 } else {
608 if (fun->service_id != 0) {
609 /* Unregister from location service */
610 rc = loc_service_unregister(fun->service_id);
611 if (rc != EOK) {
612 log_msg(LVL_ERROR, "Failed unregistering tree "
613 "service.");
614 fibril_rwlock_write_unlock(&tree->rwlock);
615 fun_del_ref(fun);
616 async_answer_0(callid, EIO);
617 return;
618 }
619 }
620 }
621
622 remove_fun_node(&device_tree, fun);
623 fibril_rwlock_write_unlock(&tree->rwlock);
624
625 /* Delete ref added when inserting function into tree */
626 fun_del_ref(fun);
627 /* Delete ref added above when looking up function */
628 fun_del_ref(fun);
629
630 log_msg(LVL_DEBUG, "devman_remove_function() succeeded.");
631 async_answer_0(callid, EOK);
632}
633
634/** Initialize driver which has registered itself as running and ready.
635 *
636 * The initialization is done in a separate fibril to avoid deadlocks (if the
637 * driver needed to be served by devman during the driver's initialization).
638 */
639static int init_running_drv(void *drv)
640{
641 driver_t *driver = (driver_t *) drv;
642
643 initialize_running_driver(driver, &device_tree);
644 log_msg(LVL_DEBUG, "The `%s` driver was successfully initialized.",
645 driver->name);
646 return 0;
647}
648
649/** Function for handling connections from a driver to the device manager. */
650static void devman_connection_driver(ipc_callid_t iid, ipc_call_t *icall)
651{
652 client_t *client;
653 driver_t *driver;
654
655 /* Accept the connection. */
656 async_answer_0(iid, EOK);
657
658 client = async_get_client_data();
659 if (client == NULL) {
660 log_msg(LVL_ERROR, "Failed to allocate client data.");
661 return;
662 }
663
664 while (true) {
665 ipc_call_t call;
666 ipc_callid_t callid = async_get_call(&call);
667
668 if (!IPC_GET_IMETHOD(call))
669 break;
670
671 if (IPC_GET_IMETHOD(call) != DEVMAN_DRIVER_REGISTER) {
672 fibril_mutex_lock(&client->mutex);
673 driver = client->driver;
674 fibril_mutex_unlock(&client->mutex);
675 if (driver == NULL) {
676 /* First call must be to DEVMAN_DRIVER_REGISTER */
677 async_answer_0(callid, ENOTSUP);
678 continue;
679 }
680 }
681
682 switch (IPC_GET_IMETHOD(call)) {
683 case DEVMAN_DRIVER_REGISTER:
684 fibril_mutex_lock(&client->mutex);
685 if (client->driver != NULL) {
686 fibril_mutex_unlock(&client->mutex);
687 async_answer_0(callid, EINVAL);
688 continue;
689 }
690 client->driver = devman_driver_register(callid, &call);
691 fibril_mutex_unlock(&client->mutex);
692 break;
693 case DEVMAN_ADD_FUNCTION:
694 devman_add_function(callid, &call);
695 break;
696 case DEVMAN_ADD_DEVICE_TO_CATEGORY:
697 devman_add_function_to_cat(callid, &call);
698 break;
699 case DEVMAN_DRV_FUN_ONLINE:
700 devman_drv_fun_online(callid, &call, driver);
701 break;
702 case DEVMAN_DRV_FUN_OFFLINE:
703 devman_drv_fun_offline(callid, &call, driver);
704 break;
705 case DEVMAN_REMOVE_FUNCTION:
706 devman_remove_function(callid, &call);
707 break;
708 default:
709 async_answer_0(callid, EINVAL);
710 break;
711 }
712 }
713}
714
715/** Find handle for the device instance identified by the device's path in the
716 * device tree. */
717static void devman_function_get_handle(ipc_callid_t iid, ipc_call_t *icall)
718{
719 char *pathname;
720 devman_handle_t handle;
721
722 int rc = async_data_write_accept((void **) &pathname, true, 0, 0, 0, 0);
723 if (rc != EOK) {
724 async_answer_0(iid, rc);
725 return;
726 }
727
728 fun_node_t *fun = find_fun_node_by_path(&device_tree, pathname);
729
730 free(pathname);
731
732 if (fun == NULL) {
733 async_answer_0(iid, ENOENT);
734 return;
735 }
736
737 fibril_rwlock_read_lock(&device_tree.rwlock);
738
739 /* Check function state */
740 if (fun->state == FUN_REMOVED) {
741 fibril_rwlock_read_unlock(&device_tree.rwlock);
742 async_answer_0(iid, ENOENT);
743 return;
744 }
745 handle = fun->handle;
746
747 fibril_rwlock_read_unlock(&device_tree.rwlock);
748
749 /* Delete reference created above by find_fun_node_by_path() */
750 fun_del_ref(fun);
751
752 async_answer_1(iid, EOK, handle);
753}
754
755/** Get device name. */
756static void devman_fun_get_name(ipc_callid_t iid, ipc_call_t *icall)
757{
758 devman_handle_t handle = IPC_GET_ARG1(*icall);
759
760 fun_node_t *fun = find_fun_node(&device_tree, handle);
761 if (fun == NULL) {
762 async_answer_0(iid, ENOMEM);
763 return;
764 }
765
766 ipc_callid_t data_callid;
767 size_t data_len;
768 if (!async_data_read_receive(&data_callid, &data_len)) {
769 async_answer_0(iid, EINVAL);
770 fun_del_ref(fun);
771 return;
772 }
773
774 void *buffer = malloc(data_len);
775 if (buffer == NULL) {
776 async_answer_0(data_callid, ENOMEM);
777 async_answer_0(iid, ENOMEM);
778 fun_del_ref(fun);
779 return;
780 }
781
782 fibril_rwlock_read_lock(&device_tree.rwlock);
783
784 /* Check function state */
785 if (fun->state == FUN_REMOVED) {
786 fibril_rwlock_read_unlock(&device_tree.rwlock);
787 free(buffer);
788
789 async_answer_0(data_callid, ENOENT);
790 async_answer_0(iid, ENOENT);
791 fun_del_ref(fun);
792 return;
793 }
794
795 size_t sent_length = str_size(fun->name);
796 if (sent_length > data_len) {
797 sent_length = data_len;
798 }
799
800 async_data_read_finalize(data_callid, fun->name, sent_length);
801 async_answer_0(iid, EOK);
802
803 fibril_rwlock_read_unlock(&device_tree.rwlock);
804 fun_del_ref(fun);
805 free(buffer);
806}
807
808
809/** Get device path. */
810static void devman_fun_get_path(ipc_callid_t iid, ipc_call_t *icall)
811{
812 devman_handle_t handle = IPC_GET_ARG1(*icall);
813
814 fun_node_t *fun = find_fun_node(&device_tree, handle);
815 if (fun == NULL) {
816 async_answer_0(iid, ENOMEM);
817 return;
818 }
819
820 ipc_callid_t data_callid;
821 size_t data_len;
822 if (!async_data_read_receive(&data_callid, &data_len)) {
823 async_answer_0(iid, EINVAL);
824 fun_del_ref(fun);
825 return;
826 }
827
828 void *buffer = malloc(data_len);
829 if (buffer == NULL) {
830 async_answer_0(data_callid, ENOMEM);
831 async_answer_0(iid, ENOMEM);
832 fun_del_ref(fun);
833 return;
834 }
835
836 fibril_rwlock_read_lock(&device_tree.rwlock);
837
838 /* Check function state */
839 if (fun->state == FUN_REMOVED) {
840 fibril_rwlock_read_unlock(&device_tree.rwlock);
841 free(buffer);
842
843 async_answer_0(data_callid, ENOENT);
844 async_answer_0(iid, ENOENT);
845 fun_del_ref(fun);
846 return;
847 }
848
849 size_t sent_length = str_size(fun->pathname);
850 if (sent_length > data_len) {
851 sent_length = data_len;
852 }
853
854 async_data_read_finalize(data_callid, fun->pathname, sent_length);
855 async_answer_0(iid, EOK);
856
857 fibril_rwlock_read_unlock(&device_tree.rwlock);
858 fun_del_ref(fun);
859 free(buffer);
860}
861
862static void devman_dev_get_functions(ipc_callid_t iid, ipc_call_t *icall)
863{
864 ipc_callid_t callid;
865 size_t size;
866 size_t act_size;
867 int rc;
868
869 if (!async_data_read_receive(&callid, &size)) {
870 async_answer_0(callid, EREFUSED);
871 async_answer_0(iid, EREFUSED);
872 return;
873 }
874
875 fibril_rwlock_read_lock(&device_tree.rwlock);
876
877 dev_node_t *dev = find_dev_node_no_lock(&device_tree,
878 IPC_GET_ARG1(*icall));
879 if (dev == NULL || dev->state == DEVICE_REMOVED) {
880 fibril_rwlock_read_unlock(&device_tree.rwlock);
881 async_answer_0(callid, ENOENT);
882 async_answer_0(iid, ENOENT);
883 return;
884 }
885
886 devman_handle_t *hdl_buf = (devman_handle_t *) malloc(size);
887 if (hdl_buf == NULL) {
888 fibril_rwlock_read_unlock(&device_tree.rwlock);
889 async_answer_0(callid, ENOMEM);
890 async_answer_0(iid, ENOMEM);
891 return;
892 }
893
894 rc = dev_get_functions(&device_tree, dev, hdl_buf, size, &act_size);
895 if (rc != EOK) {
896 fibril_rwlock_read_unlock(&device_tree.rwlock);
897 async_answer_0(callid, rc);
898 async_answer_0(iid, rc);
899 return;
900 }
901
902 fibril_rwlock_read_unlock(&device_tree.rwlock);
903
904 sysarg_t retval = async_data_read_finalize(callid, hdl_buf, size);
905 free(hdl_buf);
906
907 async_answer_1(iid, retval, act_size);
908}
909
910
911/** Get handle for child device of a function. */
912static void devman_fun_get_child(ipc_callid_t iid, ipc_call_t *icall)
913{
914 fun_node_t *fun;
915
916 fibril_rwlock_read_lock(&device_tree.rwlock);
917
918 fun = find_fun_node_no_lock(&device_tree, IPC_GET_ARG1(*icall));
919 if (fun == NULL || fun->state == FUN_REMOVED) {
920 fibril_rwlock_read_unlock(&device_tree.rwlock);
921 async_answer_0(iid, ENOENT);
922 return;
923 }
924
925 if (fun->child == NULL) {
926 fibril_rwlock_read_unlock(&device_tree.rwlock);
927 async_answer_0(iid, ENOENT);
928 return;
929 }
930
931 async_answer_1(iid, EOK, fun->child->handle);
932
933 fibril_rwlock_read_unlock(&device_tree.rwlock);
934}
935
936/** Online function.
937 *
938 * Send a request to online a function to the responsible driver.
939 * The driver may offline other functions if necessary (i.e. if the state
940 * of this function is linked to state of another function somehow).
941 */
942static void devman_fun_online(ipc_callid_t iid, ipc_call_t *icall)
943{
944 fun_node_t *fun;
945 int rc;
946
947 fun = find_fun_node(&device_tree, IPC_GET_ARG1(*icall));
948 if (fun == NULL) {
949 async_answer_0(iid, ENOENT);
950 return;
951 }
952
953 rc = driver_fun_online(&device_tree, fun);
954 fun_del_ref(fun);
955
956 async_answer_0(iid, (sysarg_t) rc);
957}
958
959/** Offline function.
960 *
961 * Send a request to offline a function to the responsible driver. As
962 * a result the subtree rooted at that function should be cleanly
963 * detatched. The driver may offline other functions if necessary
964 * (i.e. if the state of this function is linked to state of another
965 * function somehow).
966 */
967static void devman_fun_offline(ipc_callid_t iid, ipc_call_t *icall)
968{
969 fun_node_t *fun;
970 int rc;
971
972 fun = find_fun_node(&device_tree, IPC_GET_ARG1(*icall));
973 if (fun == NULL) {
974 async_answer_0(iid, ENOENT);
975 return;
976 }
977
978 rc = driver_fun_offline(&device_tree, fun);
979 fun_del_ref(fun);
980
981 async_answer_0(iid, (sysarg_t) rc);
982}
983
984/** Find handle for the function instance identified by its service ID. */
985static void devman_fun_sid_to_handle(ipc_callid_t iid, ipc_call_t *icall)
986{
987 fun_node_t *fun;
988
989 fun = find_loc_tree_function(&device_tree, IPC_GET_ARG1(*icall));
990
991 if (fun == NULL) {
992 async_answer_0(iid, ENOENT);
993 return;
994 }
995
996 fibril_rwlock_read_lock(&device_tree.rwlock);
997
998 /* Check function state */
999 if (fun->state == FUN_REMOVED) {
1000 fibril_rwlock_read_unlock(&device_tree.rwlock);
1001 async_answer_0(iid, ENOENT);
1002 return;
1003 }
1004
1005 async_answer_1(iid, EOK, fun->handle);
1006 fibril_rwlock_read_unlock(&device_tree.rwlock);
1007 fun_del_ref(fun);
1008}
1009
1010/** Function for handling connections from a client to the device manager. */
1011static void devman_connection_client(ipc_callid_t iid, ipc_call_t *icall)
1012{
1013 /* Accept connection. */
1014 async_answer_0(iid, EOK);
1015
1016 while (true) {
1017 ipc_call_t call;
1018 ipc_callid_t callid = async_get_call(&call);
1019
1020 if (!IPC_GET_IMETHOD(call))
1021 break;
1022
1023 switch (IPC_GET_IMETHOD(call)) {
1024 case DEVMAN_DEVICE_GET_HANDLE:
1025 devman_function_get_handle(callid, &call);
1026 break;
1027 case DEVMAN_DEV_GET_FUNCTIONS:
1028 devman_dev_get_functions(callid, &call);
1029 break;
1030 case DEVMAN_FUN_GET_CHILD:
1031 devman_fun_get_child(callid, &call);
1032 break;
1033 case DEVMAN_FUN_GET_NAME:
1034 devman_fun_get_name(callid, &call);
1035 break;
1036 case DEVMAN_FUN_GET_PATH:
1037 devman_fun_get_path(callid, &call);
1038 break;
1039 case DEVMAN_FUN_ONLINE:
1040 devman_fun_online(callid, &call);
1041 break;
1042 case DEVMAN_FUN_OFFLINE:
1043 devman_fun_offline(callid, &call);
1044 break;
1045 case DEVMAN_FUN_SID_TO_HANDLE:
1046 devman_fun_sid_to_handle(callid, &call);
1047 break;
1048 default:
1049 async_answer_0(callid, ENOENT);
1050 }
1051 }
1052}
1053
1054static void devman_forward(ipc_callid_t iid, ipc_call_t *icall,
1055 bool drv_to_parent)
1056{
1057 devman_handle_t handle = IPC_GET_ARG2(*icall);
1058 devman_handle_t fwd_h;
1059 fun_node_t *fun = NULL;
1060 dev_node_t *dev = NULL;
1061
1062 fun = find_fun_node(&device_tree, handle);
1063 if (fun == NULL)
1064 dev = find_dev_node(&device_tree, handle);
1065 else {
1066 fibril_rwlock_read_lock(&device_tree.rwlock);
1067 dev = fun->dev;
1068 if (dev != NULL)
1069 dev_add_ref(dev);
1070 fibril_rwlock_read_unlock(&device_tree.rwlock);
1071 }
1072
1073 /*
1074 * For a valid function to connect to we need a device. The root
1075 * function, for example, has no device and cannot be connected to.
1076 * This means @c dev needs to be valid regardless whether we are
1077 * connecting to a device or to a function.
1078 */
1079 if (dev == NULL) {
1080 log_msg(LVL_ERROR, "IPC forwarding failed - no device or "
1081 "function with handle %" PRIun " was found.", handle);
1082 async_answer_0(iid, ENOENT);
1083 goto cleanup;
1084 }
1085
1086 if (fun == NULL && !drv_to_parent) {
1087 log_msg(LVL_ERROR, NAME ": devman_forward error - cannot "
1088 "connect to handle %" PRIun ", refers to a device.",
1089 handle);
1090 async_answer_0(iid, ENOENT);
1091 goto cleanup;
1092 }
1093
1094 driver_t *driver = NULL;
1095
1096 fibril_rwlock_read_lock(&device_tree.rwlock);
1097
1098 if (drv_to_parent) {
1099 /* Connect to parent function of a device (or device function). */
1100 if (dev->pfun->dev != NULL)
1101 driver = dev->pfun->dev->drv;
1102 fwd_h = dev->pfun->handle;
1103 } else if (dev->state == DEVICE_USABLE) {
1104 /* Connect to the specified function */
1105 driver = dev->drv;
1106 assert(driver != NULL);
1107
1108 fwd_h = handle;
1109 }
1110
1111 fibril_rwlock_read_unlock(&device_tree.rwlock);
1112
1113 if (driver == NULL) {
1114 log_msg(LVL_ERROR, "IPC forwarding refused - " \
1115 "the device %" PRIun " is not in usable state.", handle);
1116 async_answer_0(iid, ENOENT);
1117 goto cleanup;
1118 }
1119
1120 int method;
1121 if (drv_to_parent)
1122 method = DRIVER_DRIVER;
1123 else
1124 method = DRIVER_CLIENT;
1125
1126 if (!driver->sess) {
1127 log_msg(LVL_ERROR,
1128 "Could not forward to driver `%s'.", driver->name);
1129 async_answer_0(iid, EINVAL);
1130 goto cleanup;
1131 }
1132
1133 if (fun != NULL) {
1134 log_msg(LVL_DEBUG,
1135 "Forwarding request for `%s' function to driver `%s'.",
1136 fun->pathname, driver->name);
1137 } else {
1138 log_msg(LVL_DEBUG,
1139 "Forwarding request for `%s' device to driver `%s'.",
1140 dev->pfun->pathname, driver->name);
1141 }
1142
1143 async_exch_t *exch = async_exchange_begin(driver->sess);
1144 async_forward_fast(iid, exch, method, fwd_h, 0, IPC_FF_NONE);
1145 async_exchange_end(exch);
1146
1147cleanup:
1148 if (dev != NULL)
1149 dev_del_ref(dev);
1150 if (fun != NULL)
1151 fun_del_ref(fun);
1152}
1153
1154/** Function for handling connections from a client forwarded by the location
1155 * service to the device manager. */
1156static void devman_connection_loc(ipc_callid_t iid, ipc_call_t *icall)
1157{
1158 service_id_t service_id = IPC_GET_ARG2(*icall);
1159 fun_node_t *fun;
1160 dev_node_t *dev;
1161 devman_handle_t handle;
1162 driver_t *driver;
1163
1164 fun = find_loc_tree_function(&device_tree, service_id);
1165
1166 fibril_rwlock_read_lock(&device_tree.rwlock);
1167
1168 if (fun == NULL || fun->dev == NULL || fun->dev->drv == NULL) {
1169 log_msg(LVL_WARN, "devman_connection_loc(): function "
1170 "not found.\n");
1171 fibril_rwlock_read_unlock(&device_tree.rwlock);
1172 async_answer_0(iid, ENOENT);
1173 return;
1174 }
1175
1176 dev = fun->dev;
1177 driver = dev->drv;
1178 handle = fun->handle;
1179
1180 fibril_rwlock_read_unlock(&device_tree.rwlock);
1181
1182 async_exch_t *exch = async_exchange_begin(driver->sess);
1183 async_forward_fast(iid, exch, DRIVER_CLIENT, handle, 0,
1184 IPC_FF_NONE);
1185 async_exchange_end(exch);
1186
1187 log_msg(LVL_DEBUG,
1188 "Forwarding loc service request for `%s' function to driver `%s'.",
1189 fun->pathname, driver->name);
1190
1191 fun_del_ref(fun);
1192}
1193
1194/** Function for handling connections to device manager. */
1195static void devman_connection(ipc_callid_t iid, ipc_call_t *icall, void *arg)
1196{
1197 /* Select port. */
1198 switch ((sysarg_t) (IPC_GET_ARG1(*icall))) {
1199 case DEVMAN_DRIVER:
1200 devman_connection_driver(iid, icall);
1201 break;
1202 case DEVMAN_CLIENT:
1203 devman_connection_client(iid, icall);
1204 break;
1205 case DEVMAN_CONNECT_TO_DEVICE:
1206 /* Connect client to selected device. */
1207 devman_forward(iid, icall, false);
1208 break;
1209 case DEVMAN_CONNECT_FROM_LOC:
1210 /* Someone connected through loc node. */
1211 devman_connection_loc(iid, icall);
1212 break;
1213 case DEVMAN_CONNECT_TO_PARENTS_DEVICE:
1214 /* Connect client to selected device. */
1215 devman_forward(iid, icall, true);
1216 break;
1217 default:
1218 /* No such interface */
1219 async_answer_0(iid, ENOENT);
1220 }
1221}
1222
1223static void *devman_client_data_create(void)
1224{
1225 client_t *client;
1226
1227 client = calloc(1, sizeof(client_t));
1228 if (client == NULL)
1229 return NULL;
1230
1231 fibril_mutex_initialize(&client->mutex);
1232 return client;
1233}
1234
1235static void devman_client_data_destroy(void *data)
1236{
1237 free(data);
1238}
1239
1240/** Initialize device manager internal structures. */
1241static bool devman_init(void)
1242{
1243 log_msg(LVL_DEBUG, "devman_init - looking for available drivers.");
1244
1245 /* Initialize list of available drivers. */
1246 init_driver_list(&drivers_list);
1247 if (lookup_available_drivers(&drivers_list,
1248 DRIVER_DEFAULT_STORE) == 0) {
1249 log_msg(LVL_FATAL, "No drivers found.");
1250 return false;
1251 }
1252
1253 log_msg(LVL_DEBUG, "devman_init - list of drivers has been initialized.");
1254
1255 /* Create root device node. */
1256 if (!init_device_tree(&device_tree, &drivers_list)) {
1257 log_msg(LVL_FATAL, "Failed to initialize device tree.");
1258 return false;
1259 }
1260
1261 /*
1262 * !!! devman_connection ... as the device manager is not a real loc
1263 * driver (it uses a completely different ipc protocol than an ordinary
1264 * loc driver) forwarding a connection from client to the devman by
1265 * location service would not work.
1266 */
1267 loc_server_register(NAME, devman_connection);
1268
1269 return true;
1270}
1271
1272int main(int argc, char *argv[])
1273{
1274 printf(NAME ": HelenOS Device Manager\n");
1275
1276 if (log_init(NAME, LVL_WARN) != EOK) {
1277 printf(NAME ": Error initializing logging subsystem.\n");
1278 return -1;
1279 }
1280
1281 if (!devman_init()) {
1282 log_msg(LVL_ERROR, "Error while initializing service.");
1283 return -1;
1284 }
1285
1286 /* Set handlers for incoming connections. */
1287 async_set_client_data_constructor(devman_client_data_create);
1288 async_set_client_data_destructor(devman_client_data_destroy);
1289 async_set_client_connection(devman_connection);
1290
1291 /* Register device manager at naming service. */
1292 if (service_register(SERVICE_DEVMAN) != EOK) {
1293 log_msg(LVL_ERROR, "Failed registering as a service.");
1294 return -1;
1295 }
1296
1297 printf(NAME ": Accepting connections.\n");
1298 task_retval(0);
1299 async_manager();
1300
1301 /* Never reached. */
1302 return 0;
1303}
1304
1305/** @}
1306 */
Note: See TracBrowser for help on using the repository browser.