source: mainline/uspace/srv/devman/driver.c@ a01f732

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since a01f732 was 64f85f5, checked in by Jakub Jermar <jakub@…>, 7 years ago

Fix use of uninitialized variable

  • Property mode set to 100644
File size: 21.3 KB
Line 
1/*
2 * Copyright (c) 2018 Jiri Svoboda
3 * Copyright (c) 2010 Lenka Trochtova
4 * All rights reserved.
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * - Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 * - Redistributions in binary form must reproduce the above copyright
13 * notice, this list of conditions and the following disclaimer in the
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
16 * derived from this software without specific prior written permission.
17 *
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
20 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
21 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
22 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
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
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
27 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
28 */
29
30/** @addtogroup devman
31 * @{
32 */
33
34#include <dirent.h>
35#include <errno.h>
36#include <io/log.h>
37#include <vfs/vfs.h>
38#include <loc.h>
39#include <str_error.h>
40#include <stdio.h>
41#include <task.h>
42
43#include "dev.h"
44#include "devman.h"
45#include "driver.h"
46#include "fun.h"
47#include "match.h"
48#include "main.h"
49
50static errno_t driver_reassign_fibril(void *);
51
52/**
53 * Initialize the list of device driver's.
54 *
55 * @param drv_list the list of device driver's.
56 *
57 */
58void init_driver_list(driver_list_t *drv_list)
59{
60 assert(drv_list != NULL);
61
62 list_initialize(&drv_list->drivers);
63 fibril_mutex_initialize(&drv_list->drivers_mutex);
64 drv_list->next_handle = 1;
65}
66
67/** Allocate and initialize a new driver structure.
68 *
69 * @return Driver structure.
70 */
71driver_t *create_driver(void)
72{
73 driver_t *res = malloc(sizeof(driver_t));
74 if (res != NULL)
75 init_driver(res);
76 return res;
77}
78
79/** Add a driver to the list of drivers.
80 *
81 * @param drivers_list List of drivers.
82 * @param drv Driver structure.
83 */
84void add_driver(driver_list_t *drivers_list, driver_t *drv)
85{
86 fibril_mutex_lock(&drivers_list->drivers_mutex);
87 list_append(&drv->drivers, &drivers_list->drivers);
88 drv->handle = drivers_list->next_handle++;
89 fibril_mutex_unlock(&drivers_list->drivers_mutex);
90
91 log_msg(LOG_DEFAULT, LVL_DEBUG, "Driver `%s' was added to the list of available "
92 "drivers.", drv->name);
93}
94
95/**
96 * Get information about a driver.
97 *
98 * Each driver has its own directory in the base directory.
99 * The name of the driver's directory is the same as the name of the driver.
100 * The driver's directory contains driver's binary (named as the driver without
101 * extension) and the configuration file with match ids for device-to-driver
102 * matching (named as the driver with a special extension).
103 *
104 * This function searches for the driver's directory and containing
105 * configuration files. If all the files needed are found, they are parsed and
106 * the information about the driver is stored in the driver's structure.
107 *
108 * @param base_path The base directory, in which we look for driver's
109 * subdirectory.
110 * @param name The name of the driver.
111 * @param drv The driver structure to fill information in.
112 *
113 * @return True on success, false otherwise.
114 */
115bool get_driver_info(const char *base_path, const char *name, driver_t *drv)
116{
117 log_msg(LOG_DEFAULT, LVL_DEBUG, "get_driver_info(base_path=\"%s\", name=\"%s\")",
118 base_path, name);
119
120 assert(base_path != NULL && name != NULL && drv != NULL);
121
122 bool suc = false;
123 char *match_path = NULL;
124 size_t name_size = 0;
125
126 /* Read the list of match ids from the driver's configuration file. */
127 match_path = get_abs_path(base_path, name, MATCH_EXT);
128 if (match_path == NULL)
129 goto cleanup;
130
131 if (!read_match_ids(match_path, &drv->match_ids))
132 goto cleanup;
133
134 /* Allocate and fill driver's name. */
135 name_size = str_size(name) + 1;
136 drv->name = malloc(name_size);
137 if (drv->name == NULL)
138 goto cleanup;
139 str_cpy(drv->name, name_size, name);
140
141 /* Initialize path with driver's binary. */
142 drv->binary_path = get_abs_path(base_path, name, "");
143 if (drv->binary_path == NULL)
144 goto cleanup;
145
146 /* Check whether the driver's binary exists. */
147 vfs_stat_t s;
148 if (vfs_stat_path(drv->binary_path, &s) != EOK) {
149 log_msg(LOG_DEFAULT, LVL_ERROR, "Driver not found at path `%s'.",
150 drv->binary_path);
151 goto cleanup;
152 }
153
154 suc = true;
155
156cleanup:
157 if (!suc) {
158 free(drv->binary_path);
159 free(drv->name);
160 /* Set the driver structure to the default state. */
161 init_driver(drv);
162 }
163
164 free(match_path);
165
166 return suc;
167}
168
169/** Lookup drivers in the directory.
170 *
171 * @param drivers_list The list of available drivers.
172 * @param dir_path The path to the directory where we search for drivers.
173 * @return Number of drivers which were found.
174 */
175int lookup_available_drivers(driver_list_t *drivers_list, const char *dir_path)
176{
177 log_msg(LOG_DEFAULT, LVL_DEBUG, "lookup_available_drivers(dir=\"%s\")", dir_path);
178
179 int drv_cnt = 0;
180 DIR *dir = NULL;
181 struct dirent *diren;
182
183 dir = opendir(dir_path);
184
185 if (dir != NULL) {
186 driver_t *drv = create_driver();
187 while ((diren = readdir(dir))) {
188 if (get_driver_info(dir_path, diren->d_name, drv)) {
189 add_driver(drivers_list, drv);
190 drv_cnt++;
191 drv = create_driver();
192 }
193 }
194 delete_driver(drv);
195 closedir(dir);
196 }
197
198 return drv_cnt;
199}
200
201/** Lookup the next best matching driver for a device.
202 *
203 * A match between a device and a driver is found if one of the driver's match
204 * ids match one of the device's match ids. The score of the match is the
205 * product of the driver's and device's score associated with the matching id.
206 * The best matching driver for a device is the driver with the highest score
207 * of the match between the device and the driver.
208 *
209 * If a driver is already assigned to the device (node->drv != NULL),
210 * we look for the next best driver. That is either the next driver with the
211 * same score in the list of drivers, or a driver with the next best score
212 * (greater than zero).
213 *
214 * @param drivers_list The list of drivers, where we look for the driver
215 * suitable for handling the device.
216 * @param node The device node structure of the device.
217 * @return The best matching driver or NULL if no matching driver
218 * is found.
219 */
220driver_t *find_best_match_driver(driver_list_t *drivers_list, dev_node_t *node)
221{
222 driver_t *best_drv = NULL;
223 int best_score = 0, score = 0;
224 int cur_score;
225 link_t *link;
226
227 fibril_mutex_lock(&drivers_list->drivers_mutex);
228
229 if (node->drv != NULL) {
230 cur_score = get_match_score(node->drv, node);
231
232 link = list_next(&node->drv->drivers, &drivers_list->drivers);
233
234 /*
235 * Find next driver with score equal to the current.
236 */
237 while (link != NULL) {
238 driver_t *drv = list_get_instance(link, driver_t,
239 drivers);
240 score = get_match_score(drv, node);
241 if (score == cur_score) {
242 /* Found it */
243 fibril_mutex_unlock(&drivers_list->drivers_mutex);
244 return drv;
245 }
246
247 link = list_next(link, &drivers_list->drivers);
248 }
249
250 /* There is no driver with the same score */
251 } else {
252 cur_score = INT_MAX;
253 }
254
255 /*
256 * Find driver with the next best score
257 */
258 list_foreach(drivers_list->drivers, drivers, driver_t, drv) {
259 score = get_match_score(drv, node);
260 if (score > best_score && score < cur_score) {
261 best_score = score;
262 best_drv = drv;
263 }
264 }
265
266 fibril_mutex_unlock(&drivers_list->drivers_mutex);
267 return best_drv;
268}
269
270/** Assign a driver to a device.
271 *
272 * @param tree Device tree
273 * @param node The device's node in the device tree.
274 * @param drv The driver.
275 */
276void attach_driver(dev_tree_t *tree, dev_node_t *dev, driver_t *drv)
277{
278 log_msg(LOG_DEFAULT, LVL_DEBUG, "attach_driver(dev=\"%s\",drv=\"%s\")",
279 dev->pfun->pathname, drv->name);
280
281 fibril_mutex_lock(&drv->driver_mutex);
282 fibril_rwlock_write_lock(&tree->rwlock);
283
284 dev->drv = drv;
285 dev->passed_to_driver = false;
286 dev->state = DEVICE_NOT_INITIALIZED;
287 list_append(&dev->driver_devices, &drv->devices);
288
289 fibril_rwlock_write_unlock(&tree->rwlock);
290 fibril_mutex_unlock(&drv->driver_mutex);
291}
292
293/** Detach driver from device.
294 *
295 * @param tree Device tree
296 * @param node The device's node in the device tree.
297 * @param drv The driver.
298 */
299void detach_driver(dev_tree_t *tree, dev_node_t *dev)
300{
301 driver_t *drv = dev->drv;
302
303 assert(drv != NULL);
304
305 log_msg(LOG_DEFAULT, LVL_DEBUG, "detach_driver(dev=\"%s\",drv=\"%s\")",
306 dev->pfun->pathname, drv->name);
307
308 fibril_mutex_lock(&drv->driver_mutex);
309 fibril_rwlock_write_lock(&tree->rwlock);
310
311 dev->drv = NULL;
312 list_remove(&dev->driver_devices);
313
314 fibril_rwlock_write_unlock(&tree->rwlock);
315 fibril_mutex_unlock(&drv->driver_mutex);
316}
317
318/** Start a driver
319 *
320 * @param drv The driver's structure.
321 * @return True if the driver's task is successfully spawned, false
322 * otherwise.
323 */
324bool start_driver(driver_t *drv)
325{
326 errno_t rc;
327
328 assert(fibril_mutex_is_locked(&drv->driver_mutex));
329
330 log_msg(LOG_DEFAULT, LVL_DEBUG, "start_driver(drv=\"%s\")", drv->name);
331
332 rc = task_spawnl(NULL, NULL, drv->binary_path, drv->binary_path, NULL);
333 if (rc != EOK) {
334 log_msg(LOG_DEFAULT, LVL_ERROR, "Spawning driver `%s' (%s) failed: %s.",
335 drv->name, drv->binary_path, str_error(rc));
336 return false;
337 }
338
339 drv->state = DRIVER_STARTING;
340 return true;
341}
342
343/** Stop a driver
344 *
345 * @param drv The driver's structure.
346 * @return True if the driver's task is successfully spawned, false
347 * otherwise.
348 */
349errno_t stop_driver(driver_t *drv)
350{
351 async_exch_t *exch;
352 errno_t retval;
353
354 log_msg(LOG_DEFAULT, LVL_DEBUG, "stop_driver(drv=\"%s\")", drv->name);
355
356 exch = async_exchange_begin(drv->sess);
357 retval = async_req_0_0(exch, DRIVER_STOP);
358 loc_exchange_end(exch);
359
360 if (retval != EOK)
361 return retval;
362
363 drv->state = DRIVER_NOT_STARTED;
364 async_hangup(drv->sess);
365 drv->sess = NULL;
366 return EOK;
367}
368
369/** Find device driver by handle.
370 *
371 * @param drv_list The list of device drivers
372 * @param handle Driver handle
373 * @return The device driver, if it is in the list,
374 * NULL otherwise.
375 */
376driver_t *driver_find(driver_list_t *drv_list, devman_handle_t handle)
377{
378 driver_t *res = NULL;
379
380 fibril_mutex_lock(&drv_list->drivers_mutex);
381
382 list_foreach(drv_list->drivers, drivers, driver_t, drv) {
383 if (drv->handle == handle) {
384 res = drv;
385 break;
386 }
387 }
388
389 fibril_mutex_unlock(&drv_list->drivers_mutex);
390
391 return res;
392}
393
394/** Find device driver by name.
395 *
396 * @param drv_list The list of device drivers.
397 * @param drv_name The name of the device driver which is searched.
398 * @return The device driver of the specified name, if it is in the
399 * list, NULL otherwise.
400 */
401driver_t *driver_find_by_name(driver_list_t *drv_list, const char *drv_name)
402{
403 driver_t *res = NULL;
404
405 fibril_mutex_lock(&drv_list->drivers_mutex);
406
407 list_foreach(drv_list->drivers, drivers, driver_t, drv) {
408 if (str_cmp(drv->name, drv_name) == 0) {
409 res = drv;
410 break;
411 }
412 }
413
414 fibril_mutex_unlock(&drv_list->drivers_mutex);
415
416 return res;
417}
418
419/** Notify driver about the devices to which it was assigned.
420 *
421 * @param driver The driver to which the devices are passed.
422 */
423static void pass_devices_to_driver(driver_t *driver, dev_tree_t *tree)
424{
425 dev_node_t *dev;
426 link_t *link;
427
428 log_msg(LOG_DEFAULT, LVL_DEBUG, "pass_devices_to_driver(driver=\"%s\")",
429 driver->name);
430
431 fibril_mutex_lock(&driver->driver_mutex);
432
433 /*
434 * Go through devices list as long as there is some device
435 * that has not been passed to the driver.
436 */
437 link = driver->devices.head.next;
438 while (link != &driver->devices.head) {
439 dev = list_get_instance(link, dev_node_t, driver_devices);
440 fibril_rwlock_write_lock(&tree->rwlock);
441
442 if (dev->passed_to_driver) {
443 fibril_rwlock_write_unlock(&tree->rwlock);
444 link = link->next;
445 continue;
446 }
447
448 dev_add_ref(dev);
449
450 /*
451 * Unlock to avoid deadlock when adding device
452 * handled by itself.
453 */
454 fibril_mutex_unlock(&driver->driver_mutex);
455 fibril_rwlock_write_unlock(&tree->rwlock);
456
457 add_device(driver, dev, tree);
458
459 /* Device probe failed, need to try next best driver */
460 if (dev->state == DEVICE_NOT_PRESENT) {
461 fibril_mutex_lock(&driver->driver_mutex);
462 list_remove(&dev->driver_devices);
463 fibril_mutex_unlock(&driver->driver_mutex);
464 fid_t fid = fibril_create(driver_reassign_fibril, dev);
465 if (fid == 0) {
466 log_msg(LOG_DEFAULT, LVL_ERROR,
467 "Error creating fibril to assign driver.");
468 }
469 fibril_add_ready(fid);
470 }
471
472 dev_del_ref(dev);
473
474 /*
475 * Lock again as we will work with driver's
476 * structure.
477 */
478 fibril_mutex_lock(&driver->driver_mutex);
479
480 /*
481 * Restart the cycle to go through all devices again.
482 */
483 link = driver->devices.head.next;
484 }
485
486 /*
487 * Once we passed all devices to the driver, we need to mark the
488 * driver as running.
489 * It is vital to do it here and inside critical section.
490 *
491 * If we would change the state earlier, other devices added to
492 * the driver would be added to the device list and started
493 * immediately and possibly started here as well.
494 */
495 log_msg(LOG_DEFAULT, LVL_DEBUG, "Driver `%s' enters running state.", driver->name);
496 driver->state = DRIVER_RUNNING;
497
498 fibril_mutex_unlock(&driver->driver_mutex);
499}
500
501/** Finish the initialization of a driver after it has succesfully started
502 * and after it has registered itself by the device manager.
503 *
504 * Pass devices formerly matched to the driver to the driver and remember the
505 * driver is running and fully functional now.
506 *
507 * @param driver The driver which registered itself as running by the
508 * device manager.
509 */
510void initialize_running_driver(driver_t *driver, dev_tree_t *tree)
511{
512 log_msg(LOG_DEFAULT, LVL_DEBUG, "initialize_running_driver(driver=\"%s\")",
513 driver->name);
514
515 /*
516 * Pass devices which have been already assigned to the driver to the
517 * driver.
518 */
519 pass_devices_to_driver(driver, tree);
520}
521
522/** Initialize device driver structure.
523 *
524 * @param drv The device driver structure.
525 */
526void init_driver(driver_t *drv)
527{
528 assert(drv != NULL);
529
530 memset(drv, 0, sizeof(driver_t));
531 list_initialize(&drv->match_ids.ids);
532 list_initialize(&drv->devices);
533 fibril_mutex_initialize(&drv->driver_mutex);
534 drv->sess = NULL;
535}
536
537/** Device driver structure clean-up.
538 *
539 * @param drv The device driver structure.
540 */
541void clean_driver(driver_t *drv)
542{
543 assert(drv != NULL);
544
545 free(drv->name);
546 free(drv->binary_path);
547
548 clean_match_ids(&drv->match_ids);
549
550 init_driver(drv);
551}
552
553/** Delete device driver structure.
554 *
555 * @param drv The device driver structure.
556 */
557void delete_driver(driver_t *drv)
558{
559 assert(drv != NULL);
560
561 clean_driver(drv);
562 free(drv);
563}
564
565/** Find suitable driver for a device and assign the driver to it.
566 *
567 * @param node The device node of the device in the device tree.
568 * @param drivers_list The list of available drivers.
569 * @return True if the suitable driver is found and
570 * successfully assigned to the device, false otherwise.
571 */
572bool assign_driver(dev_node_t *dev, driver_list_t *drivers_list,
573 dev_tree_t *tree)
574{
575 driver_t *drv;
576
577 assert(dev != NULL);
578 assert(drivers_list != NULL);
579 assert(tree != NULL);
580
581 /*
582 * Find the next best driver for this device.
583 */
584again:
585 drv = find_best_match_driver(drivers_list, dev);
586 if (drv == NULL) {
587 log_msg(LOG_DEFAULT, LVL_ERROR, "No driver found for device `%s'.",
588 dev->pfun->pathname);
589 return false;
590 }
591
592 /* Attach the driver to the device. */
593 attach_driver(tree, dev, drv);
594
595 fibril_mutex_lock(&drv->driver_mutex);
596 if (drv->state == DRIVER_NOT_STARTED) {
597 /* Start the driver. */
598 start_driver(drv);
599 }
600 bool is_running = drv->state == DRIVER_RUNNING;
601 fibril_mutex_unlock(&drv->driver_mutex);
602
603 /* Notify the driver about the new device. */
604 if (is_running) {
605 add_device(drv, dev, tree);
606
607 /* If the device probe failed, need to try next available driver */
608 if (dev->state == DEVICE_NOT_PRESENT)
609 goto again;
610 }
611
612 fibril_mutex_lock(&drv->driver_mutex);
613 fibril_mutex_unlock(&drv->driver_mutex);
614
615 fibril_rwlock_write_lock(&tree->rwlock);
616 if (dev->pfun != NULL) {
617 dev->pfun->state = FUN_ON_LINE;
618 }
619 fibril_rwlock_write_unlock(&tree->rwlock);
620 return true;
621}
622
623/** Pass a device to running driver.
624 *
625 * @param drv The driver's structure.
626 * @param node The device's node in the device tree.
627 */
628void add_device(driver_t *drv, dev_node_t *dev, dev_tree_t *tree)
629{
630 /*
631 * We do not expect to have driver's mutex locked as we do not
632 * access any structures that would affect driver_t.
633 */
634 log_msg(LOG_DEFAULT, LVL_DEBUG, "add_device(drv=\"%s\", dev=\"%s\")",
635 drv->name, dev->pfun->name);
636
637 /* Send the device to the driver. */
638 devman_handle_t parent_handle;
639 if (dev->pfun) {
640 parent_handle = dev->pfun->handle;
641 } else {
642 parent_handle = 0;
643 }
644
645 async_exch_t *exch = async_exchange_begin(drv->sess);
646
647 ipc_call_t answer;
648 aid_t req = async_send_2(exch, DRIVER_DEV_ADD, dev->handle,
649 parent_handle, &answer);
650
651 /* Send the device name to the driver. */
652 errno_t rc = async_data_write_start(exch, dev->pfun->name,
653 str_size(dev->pfun->name) + 1);
654
655 async_exchange_end(exch);
656
657 if (rc != EOK) {
658 async_forget(req);
659 } else {
660 /* Wait for answer from the driver. */
661 async_wait_for(req, &rc);
662 }
663
664 switch (rc) {
665 case EOK:
666 dev->state = DEVICE_USABLE;
667 break;
668 case ENOENT:
669 dev->state = DEVICE_NOT_PRESENT;
670 break;
671 default:
672 dev->state = DEVICE_INVALID;
673 break;
674 }
675
676 dev->passed_to_driver = true;
677}
678
679errno_t driver_dev_remove(dev_tree_t *tree, dev_node_t *dev)
680{
681 async_exch_t *exch;
682 errno_t retval;
683 driver_t *drv;
684 devman_handle_t handle;
685
686 assert(dev != NULL);
687
688 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_dev_remove(%p)", dev);
689
690 fibril_rwlock_read_lock(&tree->rwlock);
691 drv = dev->drv;
692 handle = dev->handle;
693 fibril_rwlock_read_unlock(&tree->rwlock);
694
695 exch = async_exchange_begin(drv->sess);
696 retval = async_req_1_0(exch, DRIVER_DEV_REMOVE, handle);
697 async_exchange_end(exch);
698
699 return retval;
700}
701
702errno_t driver_dev_gone(dev_tree_t *tree, dev_node_t *dev)
703{
704 async_exch_t *exch;
705 errno_t retval;
706 driver_t *drv;
707 devman_handle_t handle;
708
709 assert(dev != NULL);
710
711 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_dev_gone(%p)", dev);
712
713 fibril_rwlock_read_lock(&tree->rwlock);
714 drv = dev->drv;
715 handle = dev->handle;
716 fibril_rwlock_read_unlock(&tree->rwlock);
717
718 exch = async_exchange_begin(drv->sess);
719 retval = async_req_1_0(exch, DRIVER_DEV_GONE, handle);
720 async_exchange_end(exch);
721
722 return retval;
723}
724
725errno_t driver_fun_online(dev_tree_t *tree, fun_node_t *fun)
726{
727 async_exch_t *exch;
728 errno_t retval;
729 driver_t *drv;
730 devman_handle_t handle;
731
732 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_fun_online(%p)", fun);
733
734 fibril_rwlock_read_lock(&tree->rwlock);
735
736 if (fun->dev == NULL) {
737 /* XXX root function? */
738 fibril_rwlock_read_unlock(&tree->rwlock);
739 return EINVAL;
740 }
741
742 drv = fun->dev->drv;
743 handle = fun->handle;
744 fibril_rwlock_read_unlock(&tree->rwlock);
745
746 exch = async_exchange_begin(drv->sess);
747 retval = async_req_1_0(exch, DRIVER_FUN_ONLINE, handle);
748 loc_exchange_end(exch);
749
750 return retval;
751}
752
753errno_t driver_fun_offline(dev_tree_t *tree, fun_node_t *fun)
754{
755 async_exch_t *exch;
756 errno_t retval;
757 driver_t *drv;
758 devman_handle_t handle;
759
760 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_fun_offline(%p)", fun);
761
762 fibril_rwlock_read_lock(&tree->rwlock);
763 if (fun->dev == NULL) {
764 /* XXX root function? */
765 fibril_rwlock_read_unlock(&tree->rwlock);
766 return EINVAL;
767 }
768
769 drv = fun->dev->drv;
770 handle = fun->handle;
771 fibril_rwlock_read_unlock(&tree->rwlock);
772
773 exch = async_exchange_begin(drv->sess);
774 retval = async_req_1_0(exch, DRIVER_FUN_OFFLINE, handle);
775 loc_exchange_end(exch);
776
777 return retval;
778
779}
780
781/** Get list of registered drivers. */
782errno_t driver_get_list(driver_list_t *driver_list, devman_handle_t *hdl_buf,
783 size_t buf_size, size_t *act_size)
784{
785 size_t act_cnt;
786 size_t buf_cnt;
787
788 fibril_mutex_lock(&driver_list->drivers_mutex);
789
790 buf_cnt = buf_size / sizeof(devman_handle_t);
791
792 act_cnt = list_count(&driver_list->drivers);
793 *act_size = act_cnt * sizeof(devman_handle_t);
794
795 if (buf_size % sizeof(devman_handle_t) != 0) {
796 fibril_mutex_unlock(&driver_list->drivers_mutex);
797 return EINVAL;
798 }
799
800 size_t pos = 0;
801 list_foreach(driver_list->drivers, drivers, driver_t, drv) {
802 if (pos < buf_cnt) {
803 hdl_buf[pos] = drv->handle;
804 }
805
806 pos++;
807 }
808
809 fibril_mutex_unlock(&driver_list->drivers_mutex);
810 return EOK;
811}
812
813/** Get list of device functions. */
814errno_t driver_get_devices(driver_t *driver, devman_handle_t *hdl_buf,
815 size_t buf_size, size_t *act_size)
816{
817 size_t act_cnt;
818 size_t buf_cnt;
819
820 fibril_mutex_lock(&driver->driver_mutex);
821
822 buf_cnt = buf_size / sizeof(devman_handle_t);
823
824 act_cnt = list_count(&driver->devices);
825 *act_size = act_cnt * sizeof(devman_handle_t);
826
827 if (buf_size % sizeof(devman_handle_t) != 0) {
828 fibril_mutex_unlock(&driver->driver_mutex);
829 return EINVAL;
830 }
831
832 size_t pos = 0;
833 list_foreach(driver->devices, driver_devices, dev_node_t, dev) {
834 if (pos < buf_cnt) {
835 hdl_buf[pos] = dev->handle;
836 }
837
838 pos++;
839 }
840
841 fibril_mutex_unlock(&driver->driver_mutex);
842 return EOK;
843}
844
845/** Try to find next available driver in a separate fibril.
846 *
847 * @param arg Device node (dev_node_t)
848 */
849static errno_t driver_reassign_fibril(void *arg)
850{
851 dev_node_t *dev_node = (dev_node_t *) arg;
852 assign_driver(dev_node, &drivers_list, &device_tree);
853
854 /* Delete one reference we got from the caller. */
855 dev_del_ref(dev_node);
856 return EOK;
857}
858
859/** @}
860 */
Note: See TracBrowser for help on using the repository browser.