source: mainline/uspace/lib/drv/generic/driver.c@ fafb8e5

lfn serial ticket/834-toolchain-update topic/msim-upgrade topic/simplify-dev-export
Last change on this file since fafb8e5 was fafb8e5, checked in by Jiří Zárevúcky <zarevucky.jiri@…>, 6 years ago

Mechanically lowercase IPC_SET_*/IPC_GET_*

  • Property mode set to 100644
File size: 22.8 KB
RevLine 
[c16cf62]1/*
2 * Copyright (c) 2010 Lenka Trochtova
[83a2f43]3 * Copyright (c) 2011 Jiri Svoboda
[c16cf62]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/**
[4122410]31 * @addtogroup libdrv
[c16cf62]32 * @{
33 */
34
35/** @file
36 */
[52b7b1bb]37
[c16cf62]38#include <assert.h>
39#include <ipc/services.h>
40#include <ipc/ns.h>
41#include <async.h>
42#include <stdio.h>
43#include <errno.h>
[3e6a98c5]44#include <stdbool.h>
[c16cf62]45#include <fibril_synch.h>
46#include <stdlib.h>
[c47e1a8]47#include <str.h>
[3ad7b1c]48#include <str_error.h>
[c16cf62]49#include <ctype.h>
[7e752b2]50#include <inttypes.h>
[af6b5157]51#include <devman.h>
[c16cf62]52
[5fdd7c3]53#include "dev_iface.h"
[af6b5157]54#include "ddf/driver.h"
55#include "ddf/interrupt.h"
[56fd7cf]56#include "private/driver.h"
[c16cf62]57
[36f2b3e]58/** Driver structure */
[0c322fa]59static const driver_t *driver;
[7f8b581]60
[36f2b3e]61/** Devices */
[1a5b252]62LIST_INITIALIZE(devices);
63FIBRIL_MUTEX_INITIALIZE(devices_mutex);
64
65/** Functions */
[8b1e15ac]66LIST_INITIALIZE(functions);
67FIBRIL_MUTEX_INITIALIZE(functions_mutex);
[084ff99]68
[81685dd9]69FIBRIL_RWLOCK_INITIALIZE(stopping_lock);
70static bool stopping = false;
71
[83a2f43]72static ddf_dev_t *create_device(void);
73static void delete_device(ddf_dev_t *);
[0f0f8bc]74static void dev_add_ref(ddf_dev_t *);
75static void dev_del_ref(ddf_dev_t *);
76static void fun_add_ref(ddf_fun_t *);
77static void fun_del_ref(ddf_fun_t *);
[af6b5157]78static remote_handler_t *function_get_default_handler(ddf_fun_t *);
79static void *function_get_ops(ddf_fun_t *, dev_inferface_idx_t);
[7f8b581]80
[83a2f43]81static void add_to_functions_list(ddf_fun_t *fun)
[9a66bc2e]82{
[8b1e15ac]83 fibril_mutex_lock(&functions_mutex);
84 list_append(&fun->link, &functions);
85 fibril_mutex_unlock(&functions_mutex);
[9a66bc2e]86}
87
[83a2f43]88static void remove_from_functions_list(ddf_fun_t *fun)
[9a66bc2e]89{
[8b1e15ac]90 fibril_mutex_lock(&functions_mutex);
91 list_remove(&fun->link);
92 fibril_mutex_unlock(&functions_mutex);
[9a66bc2e]93}
94
[1a5b252]95static ddf_dev_t *driver_get_device(devman_handle_t handle)
96{
97 assert(fibril_mutex_is_locked(&devices_mutex));
[a35b458]98
[feeac0d]99 list_foreach(devices, link, ddf_dev_t, dev) {
[1a5b252]100 if (dev->handle == handle)
101 return dev;
102 }
[a35b458]103
[1a5b252]104 return NULL;
105}
106
107static ddf_fun_t *driver_get_function(devman_handle_t handle)
[52b7b1bb]108{
[1a5b252]109 assert(fibril_mutex_is_locked(&functions_mutex));
[a35b458]110
[feeac0d]111 list_foreach(functions, link, ddf_fun_t, fun) {
[1a5b252]112 if (fun->handle == handle)
[8b1e15ac]113 return fun;
[a1769ee]114 }
[a35b458]115
[a1769ee]116 return NULL;
117}
118
[984a9ba]119static void driver_dev_add(ipc_call_t *icall)
[084ff99]120{
[fafb8e5]121 devman_handle_t dev_handle = ipc_get_arg1(icall);
122 devman_handle_t parent_fun_handle = ipc_get_arg2(icall);
[a35b458]123
[77ad86c]124 char *dev_name = NULL;
[5a6cc679]125 errno_t rc = async_data_write_accept((void **) &dev_name, true, 0, 0, 0, 0);
[f9b2cb4c]126 if (rc != EOK) {
[984a9ba]127 async_answer_0(icall, rc);
[f9b2cb4c]128 return;
129 }
[a35b458]130
[81685dd9]131 fibril_rwlock_read_lock(&stopping_lock);
132
133 if (stopping) {
134 fibril_rwlock_read_unlock(&stopping_lock);
[984a9ba]135 async_answer_0(icall, EIO);
[81685dd9]136 return;
137 }
[a35b458]138
[562a48b]139 ddf_dev_t *dev = create_device();
[479cc46]140 if (!dev) {
[81685dd9]141 fibril_rwlock_read_unlock(&stopping_lock);
[479cc46]142 free(dev_name);
[984a9ba]143 async_answer_0(icall, ENOMEM);
[479cc46]144 return;
145 }
[a35b458]146
[562a48b]147 dev->handle = dev_handle;
[df747b9c]148 dev->name = dev_name;
[a35b458]149
[8b1e15ac]150 /*
151 * Currently not used, parent fun handle is stored in context
152 * of the connection to the parent device driver.
153 */
154 (void) parent_fun_handle;
[a35b458]155
[5a6cc679]156 errno_t res = driver->driver_ops->dev_add(dev);
[a35b458]157
[0f0f8bc]158 if (res != EOK) {
[81685dd9]159 fibril_rwlock_read_unlock(&stopping_lock);
[0f0f8bc]160 dev_del_ref(dev);
[984a9ba]161 async_answer_0(icall, res);
[0f0f8bc]162 return;
163 }
[a35b458]164
[1a5b252]165 fibril_mutex_lock(&devices_mutex);
166 list_append(&dev->link, &devices);
167 fibril_mutex_unlock(&devices_mutex);
[81685dd9]168 fibril_rwlock_read_unlock(&stopping_lock);
[a35b458]169
[984a9ba]170 async_answer_0(icall, res);
[084ff99]171}
[c16cf62]172
[984a9ba]173static void driver_dev_remove(ipc_call_t *icall)
[1a5b252]174{
[fafb8e5]175 devman_handle_t devh = ipc_get_arg1(icall);
[a35b458]176
[1a5b252]177 fibril_mutex_lock(&devices_mutex);
[77ad86c]178 ddf_dev_t *dev = driver_get_device(devh);
[f278930]179 if (dev != NULL)
180 dev_add_ref(dev);
[1a5b252]181 fibril_mutex_unlock(&devices_mutex);
[a35b458]182
[1a5b252]183 if (dev == NULL) {
[984a9ba]184 async_answer_0(icall, ENOENT);
[1a5b252]185 return;
186 }
[a35b458]187
[5a6cc679]188 errno_t rc;
[a35b458]189
[1a5b252]190 if (driver->driver_ops->dev_remove != NULL)
191 rc = driver->driver_ops->dev_remove(dev);
192 else
193 rc = ENOTSUP;
[a35b458]194
[702729e]195 if (rc == EOK) {
196 fibril_mutex_lock(&devices_mutex);
197 list_remove(&dev->link);
198 fibril_mutex_unlock(&devices_mutex);
[0f0f8bc]199 dev_del_ref(dev);
[702729e]200 }
[a35b458]201
[203b80c]202 dev_del_ref(dev);
[984a9ba]203 async_answer_0(icall, rc);
[1a5b252]204}
205
[984a9ba]206static void driver_dev_gone(ipc_call_t *icall)
[80a96d2]207{
[fafb8e5]208 devman_handle_t devh = ipc_get_arg1(icall);
[a35b458]209
[80a96d2]210 fibril_mutex_lock(&devices_mutex);
[77ad86c]211 ddf_dev_t *dev = driver_get_device(devh);
[80a96d2]212 if (dev != NULL)
213 dev_add_ref(dev);
214 fibril_mutex_unlock(&devices_mutex);
[a35b458]215
[80a96d2]216 if (dev == NULL) {
[984a9ba]217 async_answer_0(icall, ENOENT);
[80a96d2]218 return;
219 }
[a35b458]220
[5a6cc679]221 errno_t rc;
[a35b458]222
[80a96d2]223 if (driver->driver_ops->dev_gone != NULL)
224 rc = driver->driver_ops->dev_gone(dev);
225 else
226 rc = ENOTSUP;
[a35b458]227
[702729e]228 if (rc == EOK) {
229 fibril_mutex_lock(&devices_mutex);
230 list_remove(&dev->link);
231 fibril_mutex_unlock(&devices_mutex);
[80a96d2]232 dev_del_ref(dev);
[702729e]233 }
[a35b458]234
[203b80c]235 dev_del_ref(dev);
[984a9ba]236 async_answer_0(icall, rc);
[80a96d2]237}
238
[984a9ba]239static void driver_fun_online(ipc_call_t *icall)
[1a5b252]240{
[fafb8e5]241 devman_handle_t funh = ipc_get_arg1(icall);
[a35b458]242
[0f0f8bc]243 /*
[4d94002d]244 * Look the function up. Bump reference count so that
[0f0f8bc]245 * the function continues to exist until we return
246 * from the driver.
247 */
[1a5b252]248 fibril_mutex_lock(&functions_mutex);
[a35b458]249
[77ad86c]250 ddf_fun_t *fun = driver_get_function(funh);
[0f0f8bc]251 if (fun != NULL)
252 fun_add_ref(fun);
[a35b458]253
[1a5b252]254 fibril_mutex_unlock(&functions_mutex);
[a35b458]255
[1a5b252]256 if (fun == NULL) {
[984a9ba]257 async_answer_0(icall, ENOENT);
[1a5b252]258 return;
259 }
[a35b458]260
[0f0f8bc]261 /* Call driver entry point */
[5a6cc679]262 errno_t rc;
[a35b458]263
[1a5b252]264 if (driver->driver_ops->fun_online != NULL)
265 rc = driver->driver_ops->fun_online(fun);
266 else
267 rc = ENOTSUP;
[a35b458]268
[0f0f8bc]269 fun_del_ref(fun);
[a35b458]270
[984a9ba]271 async_answer_0(icall, rc);
[1a5b252]272}
273
[984a9ba]274static void driver_fun_offline(ipc_call_t *icall)
[1a5b252]275{
[fafb8e5]276 devman_handle_t funh = ipc_get_arg1(icall);
[a35b458]277
[0f0f8bc]278 /*
[4d94002d]279 * Look the function up. Bump reference count so that
[0f0f8bc]280 * the function continues to exist until we return
281 * from the driver.
282 */
[1a5b252]283 fibril_mutex_lock(&functions_mutex);
[a35b458]284
[77ad86c]285 ddf_fun_t *fun = driver_get_function(funh);
[0f0f8bc]286 if (fun != NULL)
287 fun_add_ref(fun);
[a35b458]288
[1a5b252]289 fibril_mutex_unlock(&functions_mutex);
[a35b458]290
[1a5b252]291 if (fun == NULL) {
[984a9ba]292 async_answer_0(icall, ENOENT);
[1a5b252]293 return;
294 }
[a35b458]295
[0f0f8bc]296 /* Call driver entry point */
[5a6cc679]297 errno_t rc;
[a35b458]298
[1a5b252]299 if (driver->driver_ops->fun_offline != NULL)
300 rc = driver->driver_ops->fun_offline(fun);
301 else
302 rc = ENOTSUP;
[a35b458]303
[984a9ba]304 async_answer_0(icall, rc);
[1a5b252]305}
306
[984a9ba]307static void driver_stop(ipc_call_t *icall)
[81685dd9]308{
309 /* Prevent new devices from being added */
310 fibril_rwlock_write_lock(&stopping_lock);
311 stopping = true;
312
313 /* Check if there are any devices */
314 fibril_mutex_lock(&devices_mutex);
315 if (list_first(&devices) != NULL) {
316 /* Devices exist, roll back */
317 fibril_mutex_unlock(&devices_mutex);
318 stopping = false;
319 fibril_rwlock_write_unlock(&stopping_lock);
[984a9ba]320 async_answer_0(icall, EBUSY);
[81685dd9]321 return;
322 }
323
324 fibril_rwlock_write_unlock(&stopping_lock);
325
326 /* There should be no functions at this point */
327 fibril_mutex_lock(&functions_mutex);
328 assert(list_first(&functions) == NULL);
329 fibril_mutex_unlock(&functions_mutex);
330
331 /* Reply with success and terminate */
[984a9ba]332 async_answer_0(icall, EOK);
[81685dd9]333 exit(0);
334}
335
[984a9ba]336static void driver_connection_devman(ipc_call_t *icall, void *arg)
[c16cf62]337{
338 /* Accept connection */
[beb83c1]339 async_accept_0(icall);
[a35b458]340
[79ae36dd]341 while (true) {
[c16cf62]342 ipc_call_t call;
[984a9ba]343 async_get_call(&call);
[a35b458]344
[fafb8e5]345 if (!ipc_get_imethod(&call)) {
[889cdb1]346 async_answer_0(&call, EOK);
[79ae36dd]347 break;
[889cdb1]348 }
[a35b458]349
[fafb8e5]350 switch (ipc_get_imethod(&call)) {
[1a5b252]351 case DRIVER_DEV_ADD:
[984a9ba]352 driver_dev_add(&call);
[c16cf62]353 break;
[1a5b252]354 case DRIVER_DEV_REMOVE:
[984a9ba]355 driver_dev_remove(&call);
[1a5b252]356 break;
[80a96d2]357 case DRIVER_DEV_GONE:
[984a9ba]358 driver_dev_gone(&call);
[80a96d2]359 break;
[1a5b252]360 case DRIVER_FUN_ONLINE:
[984a9ba]361 driver_fun_online(&call);
[1a5b252]362 break;
363 case DRIVER_FUN_OFFLINE:
[984a9ba]364 driver_fun_offline(&call);
[1a5b252]365 break;
[81685dd9]366 case DRIVER_STOP:
[984a9ba]367 driver_stop(&call);
[81685dd9]368 break;
[c16cf62]369 default:
[984a9ba]370 async_answer_0(&call, ENOTSUP);
[c16cf62]371 }
[52b7b1bb]372 }
[c16cf62]373}
374
[79ae36dd]375/** Generic client connection handler both for applications and drivers.
376 *
377 * @param drv True for driver client, false for other clients
378 * (applications, services, etc.).
[52b7b1bb]379 *
[a1769ee]380 */
[984a9ba]381static void driver_connection_gen(ipc_call_t *icall, bool drv)
[52b7b1bb]382{
[7a252ec8]383 /*
384 * Answer the first IPC_M_CONNECT_ME_TO call and remember the handle of
385 * the device to which the client connected.
386 */
[fafb8e5]387 devman_handle_t handle = ipc_get_arg2(icall);
[1a5b252]388
389 fibril_mutex_lock(&functions_mutex);
390 ddf_fun_t *fun = driver_get_function(handle);
[b454a22]391 if (fun != NULL)
392 fun_add_ref(fun);
[1a5b252]393 fibril_mutex_unlock(&functions_mutex);
[a35b458]394
[8b1e15ac]395 if (fun == NULL) {
396 printf("%s: driver_connection_gen error - no function with handle"
[7e752b2]397 " %" PRIun " was found.\n", driver->name, handle);
[984a9ba]398 async_answer_0(icall, ENOENT);
[a1769ee]399 return;
400 }
[a35b458]401
[ff65e91]402 if (fun->conn_handler != NULL) {
403 /* Driver has a custom connection handler. */
[984a9ba]404 (*fun->conn_handler)(icall, (void *)fun);
[b454a22]405 fun_del_ref(fun);
[ff65e91]406 return;
407 }
[a35b458]408
[7a252ec8]409 /*
410 * TODO - if the client is not a driver, check whether it is allowed to
411 * use the device.
412 */
[a35b458]413
[5a6cc679]414 errno_t ret = EOK;
[8b1e15ac]415 /* Open device function */
416 if (fun->ops != NULL && fun->ops->open != NULL)
417 ret = (*fun->ops->open)(fun);
[a35b458]418
[b454a22]419 if (ret != EOK) {
[beb83c1]420 async_answer_0(icall, ret);
[b454a22]421 fun_del_ref(fun);
[a6e54c5d]422 return;
[b454a22]423 }
[a35b458]424
[beb83c1]425 async_accept_0(icall);
426
[79ae36dd]427 while (true) {
[a1769ee]428 ipc_call_t call;
[984a9ba]429 async_get_call(&call);
430
[fafb8e5]431 sysarg_t method = ipc_get_imethod(&call);
[a35b458]432
[79ae36dd]433 if (!method) {
[8b1e15ac]434 /* Close device function */
435 if (fun->ops != NULL && fun->ops->close != NULL)
436 (*fun->ops->close)(fun);
[984a9ba]437 async_answer_0(&call, EOK);
[b454a22]438 fun_del_ref(fun);
[a1769ee]439 return;
[79ae36dd]440 }
[a35b458]441
[79ae36dd]442 /* Convert ipc interface id to interface index */
[a35b458]443
[79ae36dd]444 int iface_idx = DEV_IFACE_IDX(method);
[a35b458]445
[79ae36dd]446 if (!is_valid_iface_idx(iface_idx)) {
447 remote_handler_t *default_handler =
448 function_get_default_handler(fun);
449 if (default_handler != NULL) {
[984a9ba]450 (*default_handler)(fun, &call);
[79a141a]451 continue;
[52b7b1bb]452 }
[a35b458]453
[7a252ec8]454 /*
[79ae36dd]455 * Function has no such interface and
456 * default handler is not provided.
[7a252ec8]457 */
[79ae36dd]458 printf("%s: driver_connection_gen error - "
459 "invalid interface id %d.",
460 driver->name, iface_idx);
[984a9ba]461 async_answer_0(&call, ENOTSUP);
[79a141a]462 continue;
[79ae36dd]463 }
[a35b458]464
[79ae36dd]465 /* Calling one of the function's interfaces */
[a35b458]466
[79ae36dd]467 /* Get the interface ops structure. */
468 void *ops = function_get_ops(fun, iface_idx);
469 if (ops == NULL) {
470 printf("%s: driver_connection_gen error - ", driver->name);
471 printf("Function with handle %" PRIun " has no interface "
472 "with id %d.\n", handle, iface_idx);
[984a9ba]473 async_answer_0(&call, ENOTSUP);
[79a141a]474 continue;
[79ae36dd]475 }
[a35b458]476
[79ae36dd]477 /*
478 * Get the corresponding interface for remote request
479 * handling ("remote interface").
480 */
[d0ca4c5]481 const remote_iface_t *rem_iface = get_remote_iface(iface_idx);
[79ae36dd]482 assert(rem_iface != NULL);
[a35b458]483
[79ae36dd]484 /* get the method of the remote interface */
[fafb8e5]485 sysarg_t iface_method_idx = ipc_get_arg1(&call);
[79ae36dd]486 remote_iface_func_ptr_t iface_method_ptr =
487 get_remote_method(rem_iface, iface_method_idx);
488 if (iface_method_ptr == NULL) {
489 /* The interface has not such method */
490 printf("%s: driver_connection_gen error - "
491 "invalid interface method.", driver->name);
[984a9ba]492 async_answer_0(&call, ENOTSUP);
[79a141a]493 continue;
[a1769ee]494 }
[a35b458]495
[79ae36dd]496 /*
497 * Call the remote interface's method, which will
498 * receive parameters from the remote client and it will
499 * pass it to the corresponding local interface method
500 * associated with the function by its driver.
501 */
[984a9ba]502 (*iface_method_ptr)(fun, ops, &call);
[a1769ee]503 }
504}
505
[984a9ba]506static void driver_connection_driver(ipc_call_t *icall, void *arg)
[c16cf62]507{
[984a9ba]508 driver_connection_gen(icall, true);
[c16cf62]509}
510
[984a9ba]511static void driver_connection_client(ipc_call_t *icall, void *arg)
[c16cf62]512{
[984a9ba]513 driver_connection_gen(icall, false);
[c16cf62]514}
515
[5fdd7c3]516/** Create new device structure.
517 *
518 * @return The device structure.
519 */
[83a2f43]520static ddf_dev_t *create_device(void)
[5fdd7c3]521{
[83a2f43]522 ddf_dev_t *dev;
[5fdd7c3]523
[0f0f8bc]524 dev = calloc(1, sizeof(ddf_dev_t));
[8b1e15ac]525 if (dev == NULL)
526 return NULL;
[5fdd7c3]527
[d836630]528 refcount_init(&dev->refcnt);
529
[5fdd7c3]530 return dev;
531}
532
[8b1e15ac]533/** Create new function structure.
534 *
535 * @return The device structure.
536 */
[83a2f43]537static ddf_fun_t *create_function(void)
[8b1e15ac]538{
[83a2f43]539 ddf_fun_t *fun;
[8b1e15ac]540
[83a2f43]541 fun = calloc(1, sizeof(ddf_fun_t));
[8b1e15ac]542 if (fun == NULL)
543 return NULL;
544
[d836630]545 refcount_init(&fun->refcnt);
[8b1e15ac]546 init_match_ids(&fun->match_ids);
547 link_initialize(&fun->link);
548
549 return fun;
550}
551
[5fdd7c3]552/** Delete device structure.
553 *
554 * @param dev The device structure.
555 */
[83a2f43]556static void delete_device(ddf_dev_t *dev)
[5fdd7c3]557{
[56fd7cf]558 if (dev->parent_sess)
559 async_hangup(dev->parent_sess);
[5f6e25e]560 if (dev->driver_data != NULL)
561 free(dev->driver_data);
[669e9b5]562 if (dev->name)
563 free(dev->name);
[5fdd7c3]564 free(dev);
565}
566
[0f0f8bc]567/** Delete function structure.
[8b1e15ac]568 *
569 * @param dev The device structure.
570 */
[83a2f43]571static void delete_function(ddf_fun_t *fun)
[8b1e15ac]572{
573 clean_match_ids(&fun->match_ids);
[5f6e25e]574 if (fun->driver_data != NULL)
575 free(fun->driver_data);
[8b1e15ac]576 if (fun->name != NULL)
577 free(fun->name);
578 free(fun);
579}
580
[0f0f8bc]581/** Increase device reference count. */
582static void dev_add_ref(ddf_dev_t *dev)
583{
[498ced1]584 refcount_up(&dev->refcnt);
[0f0f8bc]585}
586
587/** Decrease device reference count.
588 *
589 * Free the device structure if the reference count drops to zero.
590 */
591static void dev_del_ref(ddf_dev_t *dev)
592{
[498ced1]593 if (refcount_down(&dev->refcnt))
[0f0f8bc]594 delete_device(dev);
595}
596
[bfe7867]597/** Increase function reference count.
598 *
599 * This also increases reference count on the device. The device structure
600 * will thus not be deallocated while there are some associated function
601 * structures.
602 */
[0f0f8bc]603static void fun_add_ref(ddf_fun_t *fun)
604{
[bfe7867]605 dev_add_ref(fun->dev);
[498ced1]606 refcount_up(&fun->refcnt);
[0f0f8bc]607}
608
609/** Decrease function reference count.
610 *
611 * Free the function structure if the reference count drops to zero.
612 */
613static void fun_del_ref(ddf_fun_t *fun)
614{
[bfe7867]615 ddf_dev_t *dev = fun->dev;
616
[498ced1]617 if (refcount_down(&fun->refcnt))
[0f0f8bc]618 delete_function(fun);
[bfe7867]619
620 dev_del_ref(dev);
[0f0f8bc]621}
622
[c5be39b]623/** Allocate driver-specific device data. */
[bf31e3f]624void *ddf_dev_data_alloc(ddf_dev_t *dev, size_t size)
[c5be39b]625{
626 assert(dev->driver_data == NULL);
[a35b458]627
[77ad86c]628 void *data = calloc(1, size);
[c5be39b]629 if (data == NULL)
630 return NULL;
[a35b458]631
[c5be39b]632 dev->driver_data = data;
633 return data;
634}
635
[56fd7cf]636/** Return driver-specific device data. */
637void *ddf_dev_data_get(ddf_dev_t *dev)
638{
639 return dev->driver_data;
640}
641
642/** Get device handle. */
643devman_handle_t ddf_dev_get_handle(ddf_dev_t *dev)
644{
645 return dev->handle;
646}
647
648/** Return device name.
649 *
650 * @param dev Device
651 * @return Device name. Valid as long as @a dev is valid.
652 */
653const char *ddf_dev_get_name(ddf_dev_t *dev)
654{
655 return dev->name;
656}
657
658/** Return existing session with the parent function.
659 *
660 * @param dev Device
[2fd26bb]661 * @return Session with parent function or NULL upon failure
[56fd7cf]662 */
663async_sess_t *ddf_dev_parent_sess_get(ddf_dev_t *dev)
664{
[2fd26bb]665 if (dev->parent_sess == NULL) {
666 dev->parent_sess = devman_parent_device_connect(dev->handle,
667 IPC_FLAG_BLOCKING);
668 }
669
[56fd7cf]670 return dev->parent_sess;
671}
672
673/** Set function name (if it was not specified when node was created.)
674 *
675 * @param dev Device whose name has not been set yet
676 * @param name Name, will be copied
677 * @return EOK on success, ENOMEM if out of memory
678 */
[5a6cc679]679errno_t ddf_fun_set_name(ddf_fun_t *dev, const char *name)
[56fd7cf]680{
681 assert(dev->name == NULL);
682
683 dev->name = str_dup(name);
684 if (dev->name == NULL)
685 return ENOENT;
686
687 return EOK;
688}
689
690/** Get device to which function belongs. */
691ddf_dev_t *ddf_fun_get_dev(ddf_fun_t *fun)
692{
693 return fun->dev;
694}
695
696/** Get function handle.
697 *
698 * XXX USB uses this, but its use should be eliminated.
699 */
700devman_handle_t ddf_fun_get_handle(ddf_fun_t *fun)
701{
702 return fun->handle;
703}
704
[97a62fe]705/** Create a DDF function node.
706 *
707 * Create a DDF function (in memory). Both child devices and external clients
708 * communicate with a device via its functions.
709 *
710 * The created function node is fully formed, but only exists in the memory
711 * of the client task. In order to be visible to the system, the function
712 * must be bound using ddf_fun_bind().
713 *
714 * This function should only fail if there is not enough free memory.
715 * Specifically, this function succeeds even if @a dev already has
[56fd7cf]716 * a (bound) function with the same name. @a name can be NULL in which
717 * case the caller will set the name later using ddf_fun_set_name().
718 * He must do this before binding the function.
[97a62fe]719 *
720 * Type: A function of type fun_inner indicates that DDF should attempt
721 * to attach child devices to the function. fun_exposed means that
722 * the function should be exported to external clients (applications).
723 *
724 * @param dev Device to which we are adding function
725 * @param ftype Type of function (fun_inner or fun_exposed)
[56fd7cf]726 * @param name Name of function or NULL
[97a62fe]727 *
728 * @return New function or @c NULL if memory is not available
729 */
[83a2f43]730ddf_fun_t *ddf_fun_create(ddf_dev_t *dev, fun_type_t ftype, const char *name)
[97a62fe]731{
[77ad86c]732 ddf_fun_t *fun = create_function();
[97a62fe]733 if (fun == NULL)
734 return NULL;
[a35b458]735
[bfe7867]736 fun->dev = dev;
[9df0f64]737 dev_add_ref(fun->dev);
[a35b458]738
[97a62fe]739 fun->bound = false;
740 fun->ftype = ftype;
[a35b458]741
[56fd7cf]742 if (name != NULL) {
743 fun->name = str_dup(name);
744 if (fun->name == NULL) {
[9df0f64]745 fun_del_ref(fun); /* fun is destroyed */
[56fd7cf]746 return NULL;
747 }
[97a62fe]748 }
[a35b458]749
[97a62fe]750 return fun;
751}
752
[c5be39b]753/** Allocate driver-specific function data. */
[bf31e3f]754void *ddf_fun_data_alloc(ddf_fun_t *fun, size_t size)
[c5be39b]755{
756 assert(fun->bound == false);
757 assert(fun->driver_data == NULL);
[a35b458]758
[77ad86c]759 void *data = calloc(1, size);
[c5be39b]760 if (data == NULL)
761 return NULL;
[a35b458]762
[c5be39b]763 fun->driver_data = data;
764 return data;
765}
766
[56fd7cf]767/** Return driver-specific function data. */
768void *ddf_fun_data_get(ddf_fun_t *fun)
769{
770 return fun->driver_data;
771}
772
773/** Return function name.
774 *
775 * @param fun Function
776 * @return Function name. Valid as long as @a fun is valid.
777 */
778const char *ddf_fun_get_name(ddf_fun_t *fun)
779{
780 return fun->name;
781}
782
[97a62fe]783/** Destroy DDF function node.
784 *
785 * Destroy a function previously created with ddf_fun_create(). The function
786 * must not be bound.
787 *
[77ad86c]788 * @param fun Function to destroy
789 *
[97a62fe]790 */
[83a2f43]791void ddf_fun_destroy(ddf_fun_t *fun)
[97a62fe]792{
793 assert(fun->bound == false);
[a35b458]794
[0f0f8bc]795 /*
796 * Drop the reference added by ddf_fun_create(). This will deallocate
797 * the function as soon as all other references are dropped (i.e.
798 * as soon control leaves all driver entry points called in context
799 * of this function.
800 */
801 fun_del_ref(fun);
[97a62fe]802}
803
[af6b5157]804static void *function_get_ops(ddf_fun_t *fun, dev_inferface_idx_t idx)
[5fdd7c3]805{
806 assert(is_valid_iface_idx(idx));
[8b1e15ac]807 if (fun->ops == NULL)
[5fdd7c3]808 return NULL;
[a35b458]809
[8b1e15ac]810 return fun->ops->interfaces[idx];
[5fdd7c3]811}
812
[97a62fe]813/** Bind a function node.
814 *
815 * Bind the specified function to the system. This effectively makes
816 * the function visible to the system (uploads it to the server).
817 *
818 * This function can fail for several reasons. Specifically,
819 * it will fail if the device already has a bound function of
820 * the same name.
821 *
[77ad86c]822 * @param fun Function to bind
823 *
[cde999a]824 * @return EOK on success or an error code
[77ad86c]825 *
[97a62fe]826 */
[5a6cc679]827errno_t ddf_fun_bind(ddf_fun_t *fun)
[7707954]828{
[d0dd7b5]829 assert(fun->bound == false);
[8b1e15ac]830 assert(fun->name != NULL);
[9e79a2f]831 assert(fun->dev != NULL);
[a35b458]832
[8b1e15ac]833 add_to_functions_list(fun);
[5a6cc679]834 errno_t res = devman_add_function(fun->name, fun->ftype, &fun->match_ids,
[97a62fe]835 fun->dev->handle, &fun->handle);
[36f2b3e]836 if (res != EOK) {
[8b1e15ac]837 remove_from_functions_list(fun);
[df747b9c]838 return res;
[36f2b3e]839 }
[a35b458]840
[97a62fe]841 fun->bound = true;
[df747b9c]842 return res;
[7707954]843}
844
[d0dd7b5]845/** Unbind a function node.
846 *
847 * Unbind the specified function from the system. This effectively makes
848 * the function invisible to the system.
849 *
[77ad86c]850 * @param fun Function to unbind
851 *
[cde999a]852 * @return EOK on success or an error code
[77ad86c]853 *
[d0dd7b5]854 */
[5a6cc679]855errno_t ddf_fun_unbind(ddf_fun_t *fun)
[d0dd7b5]856{
857 assert(fun->bound == true);
[a35b458]858
[5a6cc679]859 errno_t res = devman_remove_function(fun->handle);
[d0dd7b5]860 if (res != EOK)
861 return res;
[a35b458]862
[d0dd7b5]863 remove_from_functions_list(fun);
[a35b458]864
[d0dd7b5]865 fun->bound = false;
866 return EOK;
867}
868
[1a5b252]869/** Online function.
870 *
[77ad86c]871 * @param fun Function to online
872 *
[cde999a]873 * @return EOK on success or an error code
[77ad86c]874 *
[1a5b252]875 */
[5a6cc679]876errno_t ddf_fun_online(ddf_fun_t *fun)
[1a5b252]877{
878 assert(fun->bound == true);
[a35b458]879
[5a6cc679]880 errno_t res = devman_drv_fun_online(fun->handle);
[1a5b252]881 if (res != EOK)
882 return res;
[a35b458]883
[1a5b252]884 return EOK;
885}
886
887/** Offline function.
888 *
[77ad86c]889 * @param fun Function to offline
890 *
[cde999a]891 * @return EOK on success or an error code
[77ad86c]892 *
[1a5b252]893 */
[5a6cc679]894errno_t ddf_fun_offline(ddf_fun_t *fun)
[1a5b252]895{
896 assert(fun->bound == true);
[a35b458]897
[5a6cc679]898 errno_t res = devman_drv_fun_offline(fun->handle);
[1a5b252]899 if (res != EOK)
900 return res;
[a35b458]901
[1a5b252]902 return EOK;
903}
904
[34588a80]905/** Add single match ID to inner function.
[cd0684d]906 *
907 * Construct and add a single match ID to the specified function.
[34588a80]908 * Cannot be called when the function node is bound.
[cd0684d]909 *
[77ad86c]910 * @param fun Function
911 * @param match_id_str Match string
912 * @param match_score Match score
913 *
914 * @return EOK on success.
915 * @return ENOMEM if out of memory.
916 *
[cd0684d]917 */
[5a6cc679]918errno_t ddf_fun_add_match_id(ddf_fun_t *fun, const char *match_id_str,
[cd0684d]919 int match_score)
920{
[34588a80]921 assert(fun->bound == false);
922 assert(fun->ftype == fun_inner);
[a35b458]923
[77ad86c]924 match_id_t *match_id = create_match_id();
[cd0684d]925 if (match_id == NULL)
926 return ENOMEM;
[a35b458]927
[ef9460b]928 match_id->id = str_dup(match_id_str);
[8a363ab3]929 match_id->score = match_score;
[a35b458]930
[cd0684d]931 add_match_id(&fun->match_ids, match_id);
932 return EOK;
933}
934
[56fd7cf]935/** Set function ops. */
[facc34d]936void ddf_fun_set_ops(ddf_fun_t *fun, const ddf_dev_ops_t *dev_ops)
[56fd7cf]937{
938 assert(fun->conn_handler == NULL);
939 fun->ops = dev_ops;
940}
941
942/** Set user-defined connection handler.
943 *
944 * This allows handling connections the non-devman way.
945 */
[b688fd8]946void ddf_fun_set_conn_handler(ddf_fun_t *fun, async_port_handler_t conn)
[56fd7cf]947{
948 assert(fun->ops == NULL);
949 fun->conn_handler = conn;
950}
951
[5fdd7c3]952/** Get default handler for client requests */
[af6b5157]953static remote_handler_t *function_get_default_handler(ddf_fun_t *fun)
[5fdd7c3]954{
[8b1e15ac]955 if (fun->ops == NULL)
[5fdd7c3]956 return NULL;
[8b1e15ac]957 return fun->ops->default_handler;
[5fdd7c3]958}
959
[1dc4a5e]960/** Add exposed function to category.
[34588a80]961 *
962 * Must only be called when the function is bound.
[77ad86c]963 *
[34588a80]964 */
[5a6cc679]965errno_t ddf_fun_add_to_category(ddf_fun_t *fun, const char *cat_name)
[5fdd7c3]966{
[34588a80]967 assert(fun->bound == true);
968 assert(fun->ftype == fun_exposed);
[a35b458]969
[1dc4a5e]970 return devman_add_device_to_category(fun->handle, cat_name);
[5fdd7c3]971}
972
[45457265]973errno_t ddf_driver_main(const driver_t *drv)
[c16cf62]974{
[7a252ec8]975 /*
976 * Remember the driver structure - driver_ops will be called by generic
977 * handler for incoming connections.
978 */
[c16cf62]979 driver = drv;
[a35b458]980
[7a252ec8]981 /*
[033cbf82]982 * Register driver with device manager using generic handler for
983 * incoming connections.
[7a252ec8]984 */
[f9b2cb4c]985 port_id_t port;
[5a6cc679]986 errno_t rc = async_create_port(INTERFACE_DDF_DRIVER, driver_connection_driver,
[f9b2cb4c]987 NULL, &port);
[7b616e2]988 if (rc != EOK) {
989 printf("Error: Failed to create driver port.\n");
[f9b2cb4c]990 return rc;
[7b616e2]991 }
[a35b458]992
[f9b2cb4c]993 rc = async_create_port(INTERFACE_DDF_DEVMAN, driver_connection_devman,
994 NULL, &port);
[7b616e2]995 if (rc != EOK) {
996 printf("Error: Failed to create devman port.\n");
[f9b2cb4c]997 return rc;
[7b616e2]998 }
[a35b458]999
[f9b2cb4c]1000 async_set_fallback_port_handler(driver_connection_client, NULL);
[a35b458]1001
[f9b2cb4c]1002 rc = devman_driver_register(driver->name);
[033cbf82]1003 if (rc != EOK) {
[3ad7b1c]1004 printf("Error: Failed to register driver with device manager "
[8a637a4]1005 "(%s).\n", (rc == EEXIST) ? "driver already started" :
[3ad7b1c]1006 str_error(rc));
[a35b458]1007
[77ad86c]1008 return rc;
[033cbf82]1009 }
[a35b458]1010
[26fa82bc]1011 /* Return success from the task since server has started. */
1012 rc = task_retval(0);
[7b616e2]1013 if (rc != EOK) {
1014 printf("Error: Failed returning task value.\n");
[77ad86c]1015 return rc;
[7b616e2]1016 }
[a35b458]1017
[c16cf62]1018 async_manager();
[a35b458]1019
[7a252ec8]1020 /* Never reached. */
[77ad86c]1021 return EOK;
[c16cf62]1022}
1023
1024/**
1025 * @}
[52b7b1bb]1026 */
Note: See TracBrowser for help on using the repository browser.