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
RevLine 
[041b026]1/*
[b25970f]2 * Copyright (c) 2018 Jiri Svoboda
[041b026]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
[d1bafbf]34#include <dirent.h>
[041b026]35#include <errno.h>
36#include <io/log.h>
[23a0368]37#include <vfs/vfs.h>
[041b026]38#include <loc.h>
39#include <str_error.h>
40#include <stdio.h>
[1c635d6]41#include <task.h>
[041b026]42
[d1bafbf]43#include "dev.h"
[041b026]44#include "devman.h"
45#include "driver.h"
[b25970f]46#include "fun.h"
[a60e90b]47#include "match.h"
[b25970f]48#include "main.h"
49
50static errno_t driver_reassign_fibril(void *);
[041b026]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);
[a35b458]61
[041b026]62 list_initialize(&drv_list->drivers);
63 fibril_mutex_initialize(&drv_list->drivers_mutex);
[0511549]64 drv_list->next_handle = 1;
[041b026]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);
[e5556e4a]87 list_append(&drv->drivers, &drivers_list->drivers);
[0511549]88 drv->handle = drivers_list->next_handle++;
[041b026]89 fibril_mutex_unlock(&drivers_list->drivers_mutex);
90
[de3d15b4]91 log_msg(LOG_DEFAULT, LVL_DEBUG, "Driver `%s' was added to the list of available "
[041b026]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);
[a35b458]119
[041b026]120 assert(base_path != NULL && name != NULL && drv != NULL);
[a35b458]121
[041b026]122 bool suc = false;
123 char *match_path = NULL;
124 size_t name_size = 0;
[a35b458]125
[041b026]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;
[a35b458]130
[041b026]131 if (!read_match_ids(match_path, &drv->match_ids))
132 goto cleanup;
[a35b458]133
[041b026]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);
[a35b458]140
[041b026]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;
[a35b458]145
[041b026]146 /* Check whether the driver's binary exists. */
[39330200]147 vfs_stat_t s;
[23a0368]148 if (vfs_stat_path(drv->binary_path, &s) != EOK) {
[041b026]149 log_msg(LOG_DEFAULT, LVL_ERROR, "Driver not found at path `%s'.",
150 drv->binary_path);
151 goto cleanup;
152 }
[a35b458]153
[041b026]154 suc = true;
[a35b458]155
[041b026]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 }
[a35b458]163
[041b026]164 free(match_path);
[a35b458]165
[041b026]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);
[a35b458]178
[041b026]179 int drv_cnt = 0;
180 DIR *dir = NULL;
181 struct dirent *diren;
182
183 dir = opendir(dir_path);
[a35b458]184
[041b026]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 }
[a35b458]197
[041b026]198 return drv_cnt;
199}
200
[b25970f]201/** Lookup the next best matching driver for a device.
[041b026]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 *
[b25970f]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 *
[041b026]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{
[08bc23d]222 driver_t *best_drv = NULL;
[041b026]223 int best_score = 0, score = 0;
[b25970f]224 int cur_score;
225 link_t *link;
[a35b458]226
[041b026]227 fibril_mutex_lock(&drivers_list->drivers_mutex);
[a35b458]228
[b25970f]229 if (node->drv != NULL) {
230 cur_score = get_match_score(node->drv, node);
231
[64f85f5]232 link = list_next(&node->drv->drivers, &drivers_list->drivers);
[b25970f]233
234 /*
235 * Find next driver with score equal to the current.
236 */
237 while (link != NULL) {
[64f85f5]238 driver_t *drv = list_get_instance(link, driver_t,
239 drivers);
[b25970f]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 */
[08bc23d]258 list_foreach(drivers_list->drivers, drivers, driver_t, drv) {
[041b026]259 score = get_match_score(drv, node);
[b25970f]260 if (score > best_score && score < cur_score) {
[041b026]261 best_score = score;
262 best_drv = drv;
263 }
264 }
[a35b458]265
[041b026]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);
[a35b458]280
[041b026]281 fibril_mutex_lock(&drv->driver_mutex);
282 fibril_rwlock_write_lock(&tree->rwlock);
[a35b458]283
[041b026]284 dev->drv = drv;
[b25970f]285 dev->passed_to_driver = false;
286 dev->state = DEVICE_NOT_INITIALIZED;
[041b026]287 list_append(&dev->driver_devices, &drv->devices);
[a35b458]288
[041b026]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;
[a35b458]302
[041b026]303 assert(drv != NULL);
[a35b458]304
[041b026]305 log_msg(LOG_DEFAULT, LVL_DEBUG, "detach_driver(dev=\"%s\",drv=\"%s\")",
306 dev->pfun->pathname, drv->name);
[a35b458]307
[041b026]308 fibril_mutex_lock(&drv->driver_mutex);
309 fibril_rwlock_write_lock(&tree->rwlock);
[a35b458]310
[041b026]311 dev->drv = NULL;
312 list_remove(&dev->driver_devices);
[a35b458]313
[041b026]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{
[b7fd2a0]326 errno_t rc;
[041b026]327
328 assert(fibril_mutex_is_locked(&drv->driver_mutex));
[a35b458]329
[041b026]330 log_msg(LOG_DEFAULT, LVL_DEBUG, "start_driver(drv=\"%s\")", drv->name);
[a35b458]331
[1c635d6]332 rc = task_spawnl(NULL, NULL, drv->binary_path, drv->binary_path, NULL);
[041b026]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 }
[a35b458]338
[041b026]339 drv->state = DRIVER_STARTING;
340 return true;
341}
342
[81685dd9]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 */
[b7fd2a0]349errno_t stop_driver(driver_t *drv)
[81685dd9]350{
351 async_exch_t *exch;
[b7fd2a0]352 errno_t retval;
[a35b458]353
[81685dd9]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);
[a35b458]359
[81685dd9]360 if (retval != EOK)
361 return retval;
[a35b458]362
[81685dd9]363 drv->state = DRIVER_NOT_STARTED;
364 async_hangup(drv->sess);
365 drv->sess = NULL;
366 return EOK;
367}
368
[0511549]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;
[a35b458]379
[0511549]380 fibril_mutex_lock(&drv_list->drivers_mutex);
[a35b458]381
[0511549]382 list_foreach(drv_list->drivers, drivers, driver_t, drv) {
383 if (drv->handle == handle) {
384 res = drv;
385 break;
386 }
387 }
[a35b458]388
[0511549]389 fibril_mutex_unlock(&drv_list->drivers_mutex);
[a35b458]390
[0511549]391 return res;
392}
393
394/** Find device driver by name.
[041b026]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 */
[0511549]401driver_t *driver_find_by_name(driver_list_t *drv_list, const char *drv_name)
[041b026]402{
403 driver_t *res = NULL;
[a35b458]404
[041b026]405 fibril_mutex_lock(&drv_list->drivers_mutex);
[a35b458]406
[08bc23d]407 list_foreach(drv_list->drivers, drivers, driver_t, drv) {
[041b026]408 if (str_cmp(drv->name, drv_name) == 0) {
409 res = drv;
410 break;
411 }
412 }
[a35b458]413
[041b026]414 fibril_mutex_unlock(&drv_list->drivers_mutex);
[a35b458]415
[041b026]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);
[a35b458]441
[041b026]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
[b25970f]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
[041b026]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);
[a35b458]514
[041b026]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);
[a35b458]560
[041b026]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{
[b25970f]575 driver_t *drv;
576
[041b026]577 assert(dev != NULL);
578 assert(drivers_list != NULL);
579 assert(tree != NULL);
[a35b458]580
[041b026]581 /*
[b25970f]582 * Find the next best driver for this device.
[041b026]583 */
[b25970f]584again:
585 drv = find_best_match_driver(drivers_list, dev);
[041b026]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 }
[a35b458]591
[041b026]592 /* Attach the driver to the device. */
593 attach_driver(tree, dev, drv);
[a35b458]594
[041b026]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. */
[b25970f]604 if (is_running) {
[041b026]605 add_device(drv, dev, tree);
[a35b458]606
[b25970f]607 /* If the device probe failed, need to try next available driver */
608 if (dev->state == DEVICE_NOT_PRESENT)
609 goto again;
610 }
611
[041b026]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
[a60e90b]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);
[a35b458]636
[a60e90b]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 }
[a35b458]644
[a60e90b]645 async_exch_t *exch = async_exchange_begin(drv->sess);
[a35b458]646
[a60e90b]647 ipc_call_t answer;
648 aid_t req = async_send_2(exch, DRIVER_DEV_ADD, dev->handle,
649 parent_handle, &answer);
[a35b458]650
[a60e90b]651 /* Send the device name to the driver. */
[b7fd2a0]652 errno_t rc = async_data_write_start(exch, dev->pfun->name,
[a60e90b]653 str_size(dev->pfun->name) + 1);
[a35b458]654
[a60e90b]655 async_exchange_end(exch);
[a35b458]656
[a60e90b]657 if (rc != EOK) {
[f9b2cb4c]658 async_forget(req);
659 } else {
660 /* Wait for answer from the driver. */
661 async_wait_for(req, &rc);
[a60e90b]662 }
663
[f9b2cb4c]664 switch (rc) {
[a60e90b]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 }
[a35b458]675
[a60e90b]676 dev->passed_to_driver = true;
677}
678
[b7fd2a0]679errno_t driver_dev_remove(dev_tree_t *tree, dev_node_t *dev)
[041b026]680{
681 async_exch_t *exch;
[b7fd2a0]682 errno_t retval;
[041b026]683 driver_t *drv;
684 devman_handle_t handle;
[a35b458]685
[041b026]686 assert(dev != NULL);
[a35b458]687
[041b026]688 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_dev_remove(%p)", dev);
[a35b458]689
[041b026]690 fibril_rwlock_read_lock(&tree->rwlock);
691 drv = dev->drv;
692 handle = dev->handle;
693 fibril_rwlock_read_unlock(&tree->rwlock);
[a35b458]694
[041b026]695 exch = async_exchange_begin(drv->sess);
696 retval = async_req_1_0(exch, DRIVER_DEV_REMOVE, handle);
697 async_exchange_end(exch);
[a35b458]698
[041b026]699 return retval;
700}
701
[b7fd2a0]702errno_t driver_dev_gone(dev_tree_t *tree, dev_node_t *dev)
[041b026]703{
704 async_exch_t *exch;
[b7fd2a0]705 errno_t retval;
[041b026]706 driver_t *drv;
707 devman_handle_t handle;
[a35b458]708
[041b026]709 assert(dev != NULL);
[a35b458]710
[041b026]711 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_dev_gone(%p)", dev);
[a35b458]712
[041b026]713 fibril_rwlock_read_lock(&tree->rwlock);
714 drv = dev->drv;
715 handle = dev->handle;
716 fibril_rwlock_read_unlock(&tree->rwlock);
[a35b458]717
[041b026]718 exch = async_exchange_begin(drv->sess);
719 retval = async_req_1_0(exch, DRIVER_DEV_GONE, handle);
720 async_exchange_end(exch);
[a35b458]721
[041b026]722 return retval;
723}
724
[b7fd2a0]725errno_t driver_fun_online(dev_tree_t *tree, fun_node_t *fun)
[041b026]726{
727 async_exch_t *exch;
[b7fd2a0]728 errno_t retval;
[041b026]729 driver_t *drv;
730 devman_handle_t handle;
[a35b458]731
[041b026]732 log_msg(LOG_DEFAULT, LVL_DEBUG, "driver_fun_online(%p)", fun);
733
734 fibril_rwlock_read_lock(&tree->rwlock);
[a35b458]735
[041b026]736 if (fun->dev == NULL) {
737 /* XXX root function? */
738 fibril_rwlock_read_unlock(&tree->rwlock);
739 return EINVAL;
740 }
[a35b458]741
[041b026]742 drv = fun->dev->drv;
743 handle = fun->handle;
744 fibril_rwlock_read_unlock(&tree->rwlock);
[a35b458]745
[041b026]746 exch = async_exchange_begin(drv->sess);
747 retval = async_req_1_0(exch, DRIVER_FUN_ONLINE, handle);
748 loc_exchange_end(exch);
[a35b458]749
[041b026]750 return retval;
751}
752
[b7fd2a0]753errno_t driver_fun_offline(dev_tree_t *tree, fun_node_t *fun)
[041b026]754{
755 async_exch_t *exch;
[b7fd2a0]756 errno_t retval;
[041b026]757 driver_t *drv;
758 devman_handle_t handle;
[a35b458]759
[041b026]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 }
[a35b458]768
[041b026]769 drv = fun->dev->drv;
770 handle = fun->handle;
771 fibril_rwlock_read_unlock(&tree->rwlock);
[a35b458]772
[041b026]773 exch = async_exchange_begin(drv->sess);
774 retval = async_req_1_0(exch, DRIVER_FUN_OFFLINE, handle);
775 loc_exchange_end(exch);
[a35b458]776
[041b026]777 return retval;
778
779}
780
[0511549]781/** Get list of registered drivers. */
[b7fd2a0]782errno_t driver_get_list(driver_list_t *driver_list, devman_handle_t *hdl_buf,
[0511549]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
[1db5669]813/** Get list of device functions. */
[b7fd2a0]814errno_t driver_get_devices(driver_t *driver, devman_handle_t *hdl_buf,
[1db5669]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
[b25970f]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
[041b026]859/** @}
860 */
Note: See TracBrowser for help on using the repository browser.