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

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

Add async_accept_0() for accepting connections

  • Property mode set to 100644
File size: 22.9 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{
[d35ac1d]121 devman_handle_t dev_handle = IPC_GET_ARG1(*icall);
[818fffe]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 /* Add one reference that will be dropped by driver_dev_remove() */
148 dev_add_ref(dev);
149 dev->handle = dev_handle;
[df747b9c]150 dev->name = dev_name;
[a35b458]151
[8b1e15ac]152 /*
153 * Currently not used, parent fun handle is stored in context
154 * of the connection to the parent device driver.
155 */
156 (void) parent_fun_handle;
[a35b458]157
[5a6cc679]158 errno_t res = driver->driver_ops->dev_add(dev);
[a35b458]159
[0f0f8bc]160 if (res != EOK) {
[81685dd9]161 fibril_rwlock_read_unlock(&stopping_lock);
[0f0f8bc]162 dev_del_ref(dev);
[984a9ba]163 async_answer_0(icall, res);
[0f0f8bc]164 return;
165 }
[a35b458]166
[1a5b252]167 fibril_mutex_lock(&devices_mutex);
168 list_append(&dev->link, &devices);
169 fibril_mutex_unlock(&devices_mutex);
[81685dd9]170 fibril_rwlock_read_unlock(&stopping_lock);
[a35b458]171
[984a9ba]172 async_answer_0(icall, res);
[084ff99]173}
[c16cf62]174
[984a9ba]175static void driver_dev_remove(ipc_call_t *icall)
[1a5b252]176{
[77ad86c]177 devman_handle_t devh = IPC_GET_ARG1(*icall);
[a35b458]178
[1a5b252]179 fibril_mutex_lock(&devices_mutex);
[77ad86c]180 ddf_dev_t *dev = driver_get_device(devh);
[f278930]181 if (dev != NULL)
182 dev_add_ref(dev);
[1a5b252]183 fibril_mutex_unlock(&devices_mutex);
[a35b458]184
[1a5b252]185 if (dev == NULL) {
[984a9ba]186 async_answer_0(icall, ENOENT);
[1a5b252]187 return;
188 }
[a35b458]189
[5a6cc679]190 errno_t rc;
[a35b458]191
[1a5b252]192 if (driver->driver_ops->dev_remove != NULL)
193 rc = driver->driver_ops->dev_remove(dev);
194 else
195 rc = ENOTSUP;
[a35b458]196
[702729e]197 if (rc == EOK) {
198 fibril_mutex_lock(&devices_mutex);
199 list_remove(&dev->link);
200 fibril_mutex_unlock(&devices_mutex);
[0f0f8bc]201 dev_del_ref(dev);
[702729e]202 }
[a35b458]203
[203b80c]204 dev_del_ref(dev);
[984a9ba]205 async_answer_0(icall, rc);
[1a5b252]206}
207
[984a9ba]208static void driver_dev_gone(ipc_call_t *icall)
[80a96d2]209{
[77ad86c]210 devman_handle_t devh = IPC_GET_ARG1(*icall);
[a35b458]211
[80a96d2]212 fibril_mutex_lock(&devices_mutex);
[77ad86c]213 ddf_dev_t *dev = driver_get_device(devh);
[80a96d2]214 if (dev != NULL)
215 dev_add_ref(dev);
216 fibril_mutex_unlock(&devices_mutex);
[a35b458]217
[80a96d2]218 if (dev == NULL) {
[984a9ba]219 async_answer_0(icall, ENOENT);
[80a96d2]220 return;
221 }
[a35b458]222
[5a6cc679]223 errno_t rc;
[a35b458]224
[80a96d2]225 if (driver->driver_ops->dev_gone != NULL)
226 rc = driver->driver_ops->dev_gone(dev);
227 else
228 rc = ENOTSUP;
[a35b458]229
[702729e]230 if (rc == EOK) {
231 fibril_mutex_lock(&devices_mutex);
232 list_remove(&dev->link);
233 fibril_mutex_unlock(&devices_mutex);
[80a96d2]234 dev_del_ref(dev);
[702729e]235 }
[a35b458]236
[203b80c]237 dev_del_ref(dev);
[984a9ba]238 async_answer_0(icall, rc);
[80a96d2]239}
240
[984a9ba]241static void driver_fun_online(ipc_call_t *icall)
[1a5b252]242{
[77ad86c]243 devman_handle_t funh = IPC_GET_ARG1(*icall);
[a35b458]244
[0f0f8bc]245 /*
[4d94002d]246 * Look the function up. Bump reference count so that
[0f0f8bc]247 * the function continues to exist until we return
248 * from the driver.
249 */
[1a5b252]250 fibril_mutex_lock(&functions_mutex);
[a35b458]251
[77ad86c]252 ddf_fun_t *fun = driver_get_function(funh);
[0f0f8bc]253 if (fun != NULL)
254 fun_add_ref(fun);
[a35b458]255
[1a5b252]256 fibril_mutex_unlock(&functions_mutex);
[a35b458]257
[1a5b252]258 if (fun == NULL) {
[984a9ba]259 async_answer_0(icall, ENOENT);
[1a5b252]260 return;
261 }
[a35b458]262
[0f0f8bc]263 /* Call driver entry point */
[5a6cc679]264 errno_t rc;
[a35b458]265
[1a5b252]266 if (driver->driver_ops->fun_online != NULL)
267 rc = driver->driver_ops->fun_online(fun);
268 else
269 rc = ENOTSUP;
[a35b458]270
[0f0f8bc]271 fun_del_ref(fun);
[a35b458]272
[984a9ba]273 async_answer_0(icall, rc);
[1a5b252]274}
275
[984a9ba]276static void driver_fun_offline(ipc_call_t *icall)
[1a5b252]277{
[77ad86c]278 devman_handle_t funh = IPC_GET_ARG1(*icall);
[a35b458]279
[0f0f8bc]280 /*
[4d94002d]281 * Look the function up. Bump reference count so that
[0f0f8bc]282 * the function continues to exist until we return
283 * from the driver.
284 */
[1a5b252]285 fibril_mutex_lock(&functions_mutex);
[a35b458]286
[77ad86c]287 ddf_fun_t *fun = driver_get_function(funh);
[0f0f8bc]288 if (fun != NULL)
289 fun_add_ref(fun);
[a35b458]290
[1a5b252]291 fibril_mutex_unlock(&functions_mutex);
[a35b458]292
[1a5b252]293 if (fun == NULL) {
[984a9ba]294 async_answer_0(icall, ENOENT);
[1a5b252]295 return;
296 }
[a35b458]297
[0f0f8bc]298 /* Call driver entry point */
[5a6cc679]299 errno_t rc;
[a35b458]300
[1a5b252]301 if (driver->driver_ops->fun_offline != NULL)
302 rc = driver->driver_ops->fun_offline(fun);
303 else
304 rc = ENOTSUP;
[a35b458]305
[984a9ba]306 async_answer_0(icall, rc);
[1a5b252]307}
308
[984a9ba]309static void driver_stop(ipc_call_t *icall)
[81685dd9]310{
311 /* Prevent new devices from being added */
312 fibril_rwlock_write_lock(&stopping_lock);
313 stopping = true;
314
315 /* Check if there are any devices */
316 fibril_mutex_lock(&devices_mutex);
317 if (list_first(&devices) != NULL) {
318 /* Devices exist, roll back */
319 fibril_mutex_unlock(&devices_mutex);
320 stopping = false;
321 fibril_rwlock_write_unlock(&stopping_lock);
[984a9ba]322 async_answer_0(icall, EBUSY);
[81685dd9]323 return;
324 }
325
326 fibril_rwlock_write_unlock(&stopping_lock);
327
328 /* There should be no functions at this point */
329 fibril_mutex_lock(&functions_mutex);
330 assert(list_first(&functions) == NULL);
331 fibril_mutex_unlock(&functions_mutex);
332
333 /* Reply with success and terminate */
[984a9ba]334 async_answer_0(icall, EOK);
[81685dd9]335 exit(0);
336}
337
[984a9ba]338static void driver_connection_devman(ipc_call_t *icall, void *arg)
[c16cf62]339{
340 /* Accept connection */
[beb83c1]341 async_accept_0(icall);
[a35b458]342
[79ae36dd]343 while (true) {
[c16cf62]344 ipc_call_t call;
[984a9ba]345 async_get_call(&call);
[a35b458]346
[889cdb1]347 if (!IPC_GET_IMETHOD(call)) {
348 async_answer_0(&call, EOK);
[79ae36dd]349 break;
[889cdb1]350 }
[a35b458]351
[228e490]352 switch (IPC_GET_IMETHOD(call)) {
[1a5b252]353 case DRIVER_DEV_ADD:
[984a9ba]354 driver_dev_add(&call);
[c16cf62]355 break;
[1a5b252]356 case DRIVER_DEV_REMOVE:
[984a9ba]357 driver_dev_remove(&call);
[1a5b252]358 break;
[80a96d2]359 case DRIVER_DEV_GONE:
[984a9ba]360 driver_dev_gone(&call);
[80a96d2]361 break;
[1a5b252]362 case DRIVER_FUN_ONLINE:
[984a9ba]363 driver_fun_online(&call);
[1a5b252]364 break;
365 case DRIVER_FUN_OFFLINE:
[984a9ba]366 driver_fun_offline(&call);
[1a5b252]367 break;
[81685dd9]368 case DRIVER_STOP:
[984a9ba]369 driver_stop(&call);
[81685dd9]370 break;
[c16cf62]371 default:
[984a9ba]372 async_answer_0(&call, ENOTSUP);
[c16cf62]373 }
[52b7b1bb]374 }
[c16cf62]375}
376
[79ae36dd]377/** Generic client connection handler both for applications and drivers.
378 *
379 * @param drv True for driver client, false for other clients
380 * (applications, services, etc.).
[52b7b1bb]381 *
[a1769ee]382 */
[984a9ba]383static void driver_connection_gen(ipc_call_t *icall, bool drv)
[52b7b1bb]384{
[7a252ec8]385 /*
386 * Answer the first IPC_M_CONNECT_ME_TO call and remember the handle of
387 * the device to which the client connected.
388 */
[0b5a4131]389 devman_handle_t handle = IPC_GET_ARG2(*icall);
[1a5b252]390
391 fibril_mutex_lock(&functions_mutex);
392 ddf_fun_t *fun = driver_get_function(handle);
[b454a22]393 if (fun != NULL)
394 fun_add_ref(fun);
[1a5b252]395 fibril_mutex_unlock(&functions_mutex);
[a35b458]396
[8b1e15ac]397 if (fun == NULL) {
398 printf("%s: driver_connection_gen error - no function with handle"
[7e752b2]399 " %" PRIun " was found.\n", driver->name, handle);
[984a9ba]400 async_answer_0(icall, ENOENT);
[a1769ee]401 return;
402 }
[a35b458]403
[ff65e91]404 if (fun->conn_handler != NULL) {
405 /* Driver has a custom connection handler. */
[984a9ba]406 (*fun->conn_handler)(icall, (void *)fun);
[b454a22]407 fun_del_ref(fun);
[ff65e91]408 return;
409 }
[a35b458]410
[7a252ec8]411 /*
412 * TODO - if the client is not a driver, check whether it is allowed to
413 * use the device.
414 */
[a35b458]415
[5a6cc679]416 errno_t ret = EOK;
[8b1e15ac]417 /* Open device function */
418 if (fun->ops != NULL && fun->ops->open != NULL)
419 ret = (*fun->ops->open)(fun);
[a35b458]420
[b454a22]421 if (ret != EOK) {
[beb83c1]422 async_answer_0(icall, ret);
[b454a22]423 fun_del_ref(fun);
[a6e54c5d]424 return;
[b454a22]425 }
[a35b458]426
[beb83c1]427 async_accept_0(icall);
428
[79ae36dd]429 while (true) {
[a1769ee]430 ipc_call_t call;
[984a9ba]431 async_get_call(&call);
432
[228e490]433 sysarg_t method = IPC_GET_IMETHOD(call);
[a35b458]434
[79ae36dd]435 if (!method) {
[8b1e15ac]436 /* Close device function */
437 if (fun->ops != NULL && fun->ops->close != NULL)
438 (*fun->ops->close)(fun);
[984a9ba]439 async_answer_0(&call, EOK);
[b454a22]440 fun_del_ref(fun);
[a1769ee]441 return;
[79ae36dd]442 }
[a35b458]443
[79ae36dd]444 /* Convert ipc interface id to interface index */
[a35b458]445
[79ae36dd]446 int iface_idx = DEV_IFACE_IDX(method);
[a35b458]447
[79ae36dd]448 if (!is_valid_iface_idx(iface_idx)) {
449 remote_handler_t *default_handler =
450 function_get_default_handler(fun);
451 if (default_handler != NULL) {
[984a9ba]452 (*default_handler)(fun, &call);
[79a141a]453 continue;
[52b7b1bb]454 }
[a35b458]455
[7a252ec8]456 /*
[79ae36dd]457 * Function has no such interface and
458 * default handler is not provided.
[7a252ec8]459 */
[79ae36dd]460 printf("%s: driver_connection_gen error - "
461 "invalid interface id %d.",
462 driver->name, iface_idx);
[984a9ba]463 async_answer_0(&call, ENOTSUP);
[79a141a]464 continue;
[79ae36dd]465 }
[a35b458]466
[79ae36dd]467 /* Calling one of the function's interfaces */
[a35b458]468
[79ae36dd]469 /* Get the interface ops structure. */
470 void *ops = function_get_ops(fun, iface_idx);
471 if (ops == NULL) {
472 printf("%s: driver_connection_gen error - ", driver->name);
473 printf("Function with handle %" PRIun " has no interface "
474 "with id %d.\n", handle, iface_idx);
[984a9ba]475 async_answer_0(&call, ENOTSUP);
[79a141a]476 continue;
[79ae36dd]477 }
[a35b458]478
[79ae36dd]479 /*
480 * Get the corresponding interface for remote request
481 * handling ("remote interface").
482 */
[d0ca4c5]483 const remote_iface_t *rem_iface = get_remote_iface(iface_idx);
[79ae36dd]484 assert(rem_iface != NULL);
[a35b458]485
[79ae36dd]486 /* get the method of the remote interface */
487 sysarg_t iface_method_idx = IPC_GET_ARG1(call);
488 remote_iface_func_ptr_t iface_method_ptr =
489 get_remote_method(rem_iface, iface_method_idx);
490 if (iface_method_ptr == NULL) {
491 /* The interface has not such method */
492 printf("%s: driver_connection_gen error - "
493 "invalid interface method.", driver->name);
[984a9ba]494 async_answer_0(&call, ENOTSUP);
[79a141a]495 continue;
[a1769ee]496 }
[a35b458]497
[79ae36dd]498 /*
499 * Call the remote interface's method, which will
500 * receive parameters from the remote client and it will
501 * pass it to the corresponding local interface method
502 * associated with the function by its driver.
503 */
[984a9ba]504 (*iface_method_ptr)(fun, ops, &call);
[a1769ee]505 }
506}
507
[984a9ba]508static void driver_connection_driver(ipc_call_t *icall, void *arg)
[c16cf62]509{
[984a9ba]510 driver_connection_gen(icall, true);
[c16cf62]511}
512
[984a9ba]513static void driver_connection_client(ipc_call_t *icall, void *arg)
[c16cf62]514{
[984a9ba]515 driver_connection_gen(icall, false);
[c16cf62]516}
517
[5fdd7c3]518/** Create new device structure.
519 *
520 * @return The device structure.
521 */
[83a2f43]522static ddf_dev_t *create_device(void)
[5fdd7c3]523{
[83a2f43]524 ddf_dev_t *dev;
[5fdd7c3]525
[0f0f8bc]526 dev = calloc(1, sizeof(ddf_dev_t));
[8b1e15ac]527 if (dev == NULL)
528 return NULL;
[5fdd7c3]529
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
545 init_match_ids(&fun->match_ids);
546 link_initialize(&fun->link);
547
548 return fun;
549}
550
[5fdd7c3]551/** Delete device structure.
552 *
553 * @param dev The device structure.
554 */
[83a2f43]555static void delete_device(ddf_dev_t *dev)
[5fdd7c3]556{
[56fd7cf]557 if (dev->parent_sess)
558 async_hangup(dev->parent_sess);
[5f6e25e]559 if (dev->driver_data != NULL)
560 free(dev->driver_data);
[669e9b5]561 if (dev->name)
562 free(dev->name);
[5fdd7c3]563 free(dev);
564}
565
[0f0f8bc]566/** Delete function structure.
[8b1e15ac]567 *
568 * @param dev The device structure.
569 */
[83a2f43]570static void delete_function(ddf_fun_t *fun)
[8b1e15ac]571{
572 clean_match_ids(&fun->match_ids);
[5f6e25e]573 if (fun->driver_data != NULL)
574 free(fun->driver_data);
[8b1e15ac]575 if (fun->name != NULL)
576 free(fun->name);
577 free(fun);
578}
579
[0f0f8bc]580/** Increase device reference count. */
581static void dev_add_ref(ddf_dev_t *dev)
582{
[498ced1]583 refcount_up(&dev->refcnt);
[0f0f8bc]584}
585
586/** Decrease device reference count.
587 *
588 * Free the device structure if the reference count drops to zero.
589 */
590static void dev_del_ref(ddf_dev_t *dev)
591{
[498ced1]592 if (refcount_down(&dev->refcnt))
[0f0f8bc]593 delete_device(dev);
594}
595
[bfe7867]596/** Increase function reference count.
597 *
598 * This also increases reference count on the device. The device structure
599 * will thus not be deallocated while there are some associated function
600 * structures.
601 */
[0f0f8bc]602static void fun_add_ref(ddf_fun_t *fun)
603{
[bfe7867]604 dev_add_ref(fun->dev);
[498ced1]605 refcount_up(&fun->refcnt);
[0f0f8bc]606}
607
608/** Decrease function reference count.
609 *
610 * Free the function structure if the reference count drops to zero.
611 */
612static void fun_del_ref(ddf_fun_t *fun)
613{
[bfe7867]614 ddf_dev_t *dev = fun->dev;
615
[498ced1]616 if (refcount_down(&fun->refcnt))
[0f0f8bc]617 delete_function(fun);
[bfe7867]618
619 dev_del_ref(dev);
[0f0f8bc]620}
621
[c5be39b]622/** Allocate driver-specific device data. */
[bf31e3f]623void *ddf_dev_data_alloc(ddf_dev_t *dev, size_t size)
[c5be39b]624{
625 assert(dev->driver_data == NULL);
[a35b458]626
[77ad86c]627 void *data = calloc(1, size);
[c5be39b]628 if (data == NULL)
629 return NULL;
[a35b458]630
[c5be39b]631 dev->driver_data = data;
632 return data;
633}
634
[56fd7cf]635/** Return driver-specific device data. */
636void *ddf_dev_data_get(ddf_dev_t *dev)
637{
638 return dev->driver_data;
639}
640
641/** Get device handle. */
642devman_handle_t ddf_dev_get_handle(ddf_dev_t *dev)
643{
644 return dev->handle;
645}
646
647/** Return device name.
648 *
649 * @param dev Device
650 * @return Device name. Valid as long as @a dev is valid.
651 */
652const char *ddf_dev_get_name(ddf_dev_t *dev)
653{
654 return dev->name;
655}
656
657/** Return existing session with the parent function.
658 *
659 * @param dev Device
[2fd26bb]660 * @return Session with parent function or NULL upon failure
[56fd7cf]661 */
662async_sess_t *ddf_dev_parent_sess_get(ddf_dev_t *dev)
663{
[2fd26bb]664 if (dev->parent_sess == NULL) {
665 dev->parent_sess = devman_parent_device_connect(dev->handle,
666 IPC_FLAG_BLOCKING);
667 }
668
[56fd7cf]669 return dev->parent_sess;
670}
671
672/** Set function name (if it was not specified when node was created.)
673 *
674 * @param dev Device whose name has not been set yet
675 * @param name Name, will be copied
676 * @return EOK on success, ENOMEM if out of memory
677 */
[5a6cc679]678errno_t ddf_fun_set_name(ddf_fun_t *dev, const char *name)
[56fd7cf]679{
680 assert(dev->name == NULL);
681
682 dev->name = str_dup(name);
683 if (dev->name == NULL)
684 return ENOENT;
685
686 return EOK;
687}
688
689/** Get device to which function belongs. */
690ddf_dev_t *ddf_fun_get_dev(ddf_fun_t *fun)
691{
692 return fun->dev;
693}
694
695/** Get function handle.
696 *
697 * XXX USB uses this, but its use should be eliminated.
698 */
699devman_handle_t ddf_fun_get_handle(ddf_fun_t *fun)
700{
701 return fun->handle;
702}
703
[97a62fe]704/** Create a DDF function node.
705 *
706 * Create a DDF function (in memory). Both child devices and external clients
707 * communicate with a device via its functions.
708 *
709 * The created function node is fully formed, but only exists in the memory
710 * of the client task. In order to be visible to the system, the function
711 * must be bound using ddf_fun_bind().
712 *
713 * This function should only fail if there is not enough free memory.
714 * Specifically, this function succeeds even if @a dev already has
[56fd7cf]715 * a (bound) function with the same name. @a name can be NULL in which
716 * case the caller will set the name later using ddf_fun_set_name().
717 * He must do this before binding the function.
[97a62fe]718 *
719 * Type: A function of type fun_inner indicates that DDF should attempt
720 * to attach child devices to the function. fun_exposed means that
721 * the function should be exported to external clients (applications).
722 *
723 * @param dev Device to which we are adding function
724 * @param ftype Type of function (fun_inner or fun_exposed)
[56fd7cf]725 * @param name Name of function or NULL
[97a62fe]726 *
727 * @return New function or @c NULL if memory is not available
728 */
[83a2f43]729ddf_fun_t *ddf_fun_create(ddf_dev_t *dev, fun_type_t ftype, const char *name)
[97a62fe]730{
[77ad86c]731 ddf_fun_t *fun = create_function();
[97a62fe]732 if (fun == NULL)
733 return NULL;
[a35b458]734
[0f0f8bc]735 /* Add one reference that will be dropped by ddf_fun_destroy() */
[bfe7867]736 fun->dev = dev;
[0f0f8bc]737 fun_add_ref(fun);
[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) {
745 delete_function(fun);
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.