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

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

Always answer the IPC_M_PHONE_HUNGUP message

  • 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 */
[984a9ba]341 async_answer_0(icall, EOK);
[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
[984a9ba]421 async_answer_0(icall, ret);
[b454a22]422 if (ret != EOK) {
423 fun_del_ref(fun);
[a6e54c5d]424 return;
[b454a22]425 }
[a35b458]426
[79ae36dd]427 while (true) {
[a1769ee]428 ipc_call_t call;
[984a9ba]429 async_get_call(&call);
430
[228e490]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 */
485 sysarg_t iface_method_idx = IPC_GET_ARG1(call);
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
528 return dev;
529}
530
[8b1e15ac]531/** Create new function structure.
532 *
533 * @return The device structure.
534 */
[83a2f43]535static ddf_fun_t *create_function(void)
[8b1e15ac]536{
[83a2f43]537 ddf_fun_t *fun;
[8b1e15ac]538
[83a2f43]539 fun = calloc(1, sizeof(ddf_fun_t));
[8b1e15ac]540 if (fun == NULL)
541 return NULL;
542
543 init_match_ids(&fun->match_ids);
544 link_initialize(&fun->link);
545
546 return fun;
547}
548
[5fdd7c3]549/** Delete device structure.
550 *
551 * @param dev The device structure.
552 */
[83a2f43]553static void delete_device(ddf_dev_t *dev)
[5fdd7c3]554{
[56fd7cf]555 if (dev->parent_sess)
556 async_hangup(dev->parent_sess);
[5f6e25e]557 if (dev->driver_data != NULL)
558 free(dev->driver_data);
[669e9b5]559 if (dev->name)
560 free(dev->name);
[5fdd7c3]561 free(dev);
562}
563
[0f0f8bc]564/** Delete function structure.
[8b1e15ac]565 *
566 * @param dev The device structure.
567 */
[83a2f43]568static void delete_function(ddf_fun_t *fun)
[8b1e15ac]569{
570 clean_match_ids(&fun->match_ids);
[5f6e25e]571 if (fun->driver_data != NULL)
572 free(fun->driver_data);
[8b1e15ac]573 if (fun->name != NULL)
574 free(fun->name);
575 free(fun);
576}
577
[0f0f8bc]578/** Increase device reference count. */
579static void dev_add_ref(ddf_dev_t *dev)
580{
[498ced1]581 refcount_up(&dev->refcnt);
[0f0f8bc]582}
583
584/** Decrease device reference count.
585 *
586 * Free the device structure if the reference count drops to zero.
587 */
588static void dev_del_ref(ddf_dev_t *dev)
589{
[498ced1]590 if (refcount_down(&dev->refcnt))
[0f0f8bc]591 delete_device(dev);
592}
593
[bfe7867]594/** Increase function reference count.
595 *
596 * This also increases reference count on the device. The device structure
597 * will thus not be deallocated while there are some associated function
598 * structures.
599 */
[0f0f8bc]600static void fun_add_ref(ddf_fun_t *fun)
601{
[bfe7867]602 dev_add_ref(fun->dev);
[498ced1]603 refcount_up(&fun->refcnt);
[0f0f8bc]604}
605
606/** Decrease function reference count.
607 *
608 * Free the function structure if the reference count drops to zero.
609 */
610static void fun_del_ref(ddf_fun_t *fun)
611{
[bfe7867]612 ddf_dev_t *dev = fun->dev;
613
[498ced1]614 if (refcount_down(&fun->refcnt))
[0f0f8bc]615 delete_function(fun);
[bfe7867]616
617 dev_del_ref(dev);
[0f0f8bc]618}
619
[c5be39b]620/** Allocate driver-specific device data. */
[bf31e3f]621void *ddf_dev_data_alloc(ddf_dev_t *dev, size_t size)
[c5be39b]622{
623 assert(dev->driver_data == NULL);
[a35b458]624
[77ad86c]625 void *data = calloc(1, size);
[c5be39b]626 if (data == NULL)
627 return NULL;
[a35b458]628
[c5be39b]629 dev->driver_data = data;
630 return data;
631}
632
[56fd7cf]633/** Return driver-specific device data. */
634void *ddf_dev_data_get(ddf_dev_t *dev)
635{
636 return dev->driver_data;
637}
638
639/** Get device handle. */
640devman_handle_t ddf_dev_get_handle(ddf_dev_t *dev)
641{
642 return dev->handle;
643}
644
645/** Return device name.
646 *
647 * @param dev Device
648 * @return Device name. Valid as long as @a dev is valid.
649 */
650const char *ddf_dev_get_name(ddf_dev_t *dev)
651{
652 return dev->name;
653}
654
655/** Return existing session with the parent function.
656 *
657 * @param dev Device
[2fd26bb]658 * @return Session with parent function or NULL upon failure
[56fd7cf]659 */
660async_sess_t *ddf_dev_parent_sess_get(ddf_dev_t *dev)
661{
[2fd26bb]662 if (dev->parent_sess == NULL) {
663 dev->parent_sess = devman_parent_device_connect(dev->handle,
664 IPC_FLAG_BLOCKING);
665 }
666
[56fd7cf]667 return dev->parent_sess;
668}
669
670/** Set function name (if it was not specified when node was created.)
671 *
672 * @param dev Device whose name has not been set yet
673 * @param name Name, will be copied
674 * @return EOK on success, ENOMEM if out of memory
675 */
[5a6cc679]676errno_t ddf_fun_set_name(ddf_fun_t *dev, const char *name)
[56fd7cf]677{
678 assert(dev->name == NULL);
679
680 dev->name = str_dup(name);
681 if (dev->name == NULL)
682 return ENOENT;
683
684 return EOK;
685}
686
687/** Get device to which function belongs. */
688ddf_dev_t *ddf_fun_get_dev(ddf_fun_t *fun)
689{
690 return fun->dev;
691}
692
693/** Get function handle.
694 *
695 * XXX USB uses this, but its use should be eliminated.
696 */
697devman_handle_t ddf_fun_get_handle(ddf_fun_t *fun)
698{
699 return fun->handle;
700}
701
[97a62fe]702/** Create a DDF function node.
703 *
704 * Create a DDF function (in memory). Both child devices and external clients
705 * communicate with a device via its functions.
706 *
707 * The created function node is fully formed, but only exists in the memory
708 * of the client task. In order to be visible to the system, the function
709 * must be bound using ddf_fun_bind().
710 *
711 * This function should only fail if there is not enough free memory.
712 * Specifically, this function succeeds even if @a dev already has
[56fd7cf]713 * a (bound) function with the same name. @a name can be NULL in which
714 * case the caller will set the name later using ddf_fun_set_name().
715 * He must do this before binding the function.
[97a62fe]716 *
717 * Type: A function of type fun_inner indicates that DDF should attempt
718 * to attach child devices to the function. fun_exposed means that
719 * the function should be exported to external clients (applications).
720 *
721 * @param dev Device to which we are adding function
722 * @param ftype Type of function (fun_inner or fun_exposed)
[56fd7cf]723 * @param name Name of function or NULL
[97a62fe]724 *
725 * @return New function or @c NULL if memory is not available
726 */
[83a2f43]727ddf_fun_t *ddf_fun_create(ddf_dev_t *dev, fun_type_t ftype, const char *name)
[97a62fe]728{
[77ad86c]729 ddf_fun_t *fun = create_function();
[97a62fe]730 if (fun == NULL)
731 return NULL;
[a35b458]732
[0f0f8bc]733 /* Add one reference that will be dropped by ddf_fun_destroy() */
[bfe7867]734 fun->dev = dev;
[0f0f8bc]735 fun_add_ref(fun);
[a35b458]736
[97a62fe]737 fun->bound = false;
738 fun->ftype = ftype;
[a35b458]739
[56fd7cf]740 if (name != NULL) {
741 fun->name = str_dup(name);
742 if (fun->name == NULL) {
743 delete_function(fun);
744 return NULL;
745 }
[97a62fe]746 }
[a35b458]747
[97a62fe]748 return fun;
749}
750
[c5be39b]751/** Allocate driver-specific function data. */
[bf31e3f]752void *ddf_fun_data_alloc(ddf_fun_t *fun, size_t size)
[c5be39b]753{
754 assert(fun->bound == false);
755 assert(fun->driver_data == NULL);
[a35b458]756
[77ad86c]757 void *data = calloc(1, size);
[c5be39b]758 if (data == NULL)
759 return NULL;
[a35b458]760
[c5be39b]761 fun->driver_data = data;
762 return data;
763}
764
[56fd7cf]765/** Return driver-specific function data. */
766void *ddf_fun_data_get(ddf_fun_t *fun)
767{
768 return fun->driver_data;
769}
770
771/** Return function name.
772 *
773 * @param fun Function
774 * @return Function name. Valid as long as @a fun is valid.
775 */
776const char *ddf_fun_get_name(ddf_fun_t *fun)
777{
778 return fun->name;
779}
780
[97a62fe]781/** Destroy DDF function node.
782 *
783 * Destroy a function previously created with ddf_fun_create(). The function
784 * must not be bound.
785 *
[77ad86c]786 * @param fun Function to destroy
787 *
[97a62fe]788 */
[83a2f43]789void ddf_fun_destroy(ddf_fun_t *fun)
[97a62fe]790{
791 assert(fun->bound == false);
[a35b458]792
[0f0f8bc]793 /*
794 * Drop the reference added by ddf_fun_create(). This will deallocate
795 * the function as soon as all other references are dropped (i.e.
796 * as soon control leaves all driver entry points called in context
797 * of this function.
798 */
799 fun_del_ref(fun);
[97a62fe]800}
801
[af6b5157]802static void *function_get_ops(ddf_fun_t *fun, dev_inferface_idx_t idx)
[5fdd7c3]803{
804 assert(is_valid_iface_idx(idx));
[8b1e15ac]805 if (fun->ops == NULL)
[5fdd7c3]806 return NULL;
[a35b458]807
[8b1e15ac]808 return fun->ops->interfaces[idx];
[5fdd7c3]809}
810
[97a62fe]811/** Bind a function node.
812 *
813 * Bind the specified function to the system. This effectively makes
814 * the function visible to the system (uploads it to the server).
815 *
816 * This function can fail for several reasons. Specifically,
817 * it will fail if the device already has a bound function of
818 * the same name.
819 *
[77ad86c]820 * @param fun Function to bind
821 *
[cde999a]822 * @return EOK on success or an error code
[77ad86c]823 *
[97a62fe]824 */
[5a6cc679]825errno_t ddf_fun_bind(ddf_fun_t *fun)
[7707954]826{
[d0dd7b5]827 assert(fun->bound == false);
[8b1e15ac]828 assert(fun->name != NULL);
[9e79a2f]829 assert(fun->dev != NULL);
[a35b458]830
[8b1e15ac]831 add_to_functions_list(fun);
[5a6cc679]832 errno_t res = devman_add_function(fun->name, fun->ftype, &fun->match_ids,
[97a62fe]833 fun->dev->handle, &fun->handle);
[36f2b3e]834 if (res != EOK) {
[8b1e15ac]835 remove_from_functions_list(fun);
[df747b9c]836 return res;
[36f2b3e]837 }
[a35b458]838
[97a62fe]839 fun->bound = true;
[df747b9c]840 return res;
[7707954]841}
842
[d0dd7b5]843/** Unbind a function node.
844 *
845 * Unbind the specified function from the system. This effectively makes
846 * the function invisible to the system.
847 *
[77ad86c]848 * @param fun Function to unbind
849 *
[cde999a]850 * @return EOK on success or an error code
[77ad86c]851 *
[d0dd7b5]852 */
[5a6cc679]853errno_t ddf_fun_unbind(ddf_fun_t *fun)
[d0dd7b5]854{
855 assert(fun->bound == true);
[a35b458]856
[5a6cc679]857 errno_t res = devman_remove_function(fun->handle);
[d0dd7b5]858 if (res != EOK)
859 return res;
[a35b458]860
[d0dd7b5]861 remove_from_functions_list(fun);
[a35b458]862
[d0dd7b5]863 fun->bound = false;
864 return EOK;
865}
866
[1a5b252]867/** Online function.
868 *
[77ad86c]869 * @param fun Function to online
870 *
[cde999a]871 * @return EOK on success or an error code
[77ad86c]872 *
[1a5b252]873 */
[5a6cc679]874errno_t ddf_fun_online(ddf_fun_t *fun)
[1a5b252]875{
876 assert(fun->bound == true);
[a35b458]877
[5a6cc679]878 errno_t res = devman_drv_fun_online(fun->handle);
[1a5b252]879 if (res != EOK)
880 return res;
[a35b458]881
[1a5b252]882 return EOK;
883}
884
885/** Offline function.
886 *
[77ad86c]887 * @param fun Function to offline
888 *
[cde999a]889 * @return EOK on success or an error code
[77ad86c]890 *
[1a5b252]891 */
[5a6cc679]892errno_t ddf_fun_offline(ddf_fun_t *fun)
[1a5b252]893{
894 assert(fun->bound == true);
[a35b458]895
[5a6cc679]896 errno_t res = devman_drv_fun_offline(fun->handle);
[1a5b252]897 if (res != EOK)
898 return res;
[a35b458]899
[1a5b252]900 return EOK;
901}
902
[34588a80]903/** Add single match ID to inner function.
[cd0684d]904 *
905 * Construct and add a single match ID to the specified function.
[34588a80]906 * Cannot be called when the function node is bound.
[cd0684d]907 *
[77ad86c]908 * @param fun Function
909 * @param match_id_str Match string
910 * @param match_score Match score
911 *
912 * @return EOK on success.
913 * @return ENOMEM if out of memory.
914 *
[cd0684d]915 */
[5a6cc679]916errno_t ddf_fun_add_match_id(ddf_fun_t *fun, const char *match_id_str,
[cd0684d]917 int match_score)
918{
[34588a80]919 assert(fun->bound == false);
920 assert(fun->ftype == fun_inner);
[a35b458]921
[77ad86c]922 match_id_t *match_id = create_match_id();
[cd0684d]923 if (match_id == NULL)
924 return ENOMEM;
[a35b458]925
[ef9460b]926 match_id->id = str_dup(match_id_str);
[8a363ab3]927 match_id->score = match_score;
[a35b458]928
[cd0684d]929 add_match_id(&fun->match_ids, match_id);
930 return EOK;
931}
932
[56fd7cf]933/** Set function ops. */
[facc34d]934void ddf_fun_set_ops(ddf_fun_t *fun, const ddf_dev_ops_t *dev_ops)
[56fd7cf]935{
936 assert(fun->conn_handler == NULL);
937 fun->ops = dev_ops;
938}
939
940/** Set user-defined connection handler.
941 *
942 * This allows handling connections the non-devman way.
943 */
[b688fd8]944void ddf_fun_set_conn_handler(ddf_fun_t *fun, async_port_handler_t conn)
[56fd7cf]945{
946 assert(fun->ops == NULL);
947 fun->conn_handler = conn;
948}
949
[5fdd7c3]950/** Get default handler for client requests */
[af6b5157]951static remote_handler_t *function_get_default_handler(ddf_fun_t *fun)
[5fdd7c3]952{
[8b1e15ac]953 if (fun->ops == NULL)
[5fdd7c3]954 return NULL;
[8b1e15ac]955 return fun->ops->default_handler;
[5fdd7c3]956}
957
[1dc4a5e]958/** Add exposed function to category.
[34588a80]959 *
960 * Must only be called when the function is bound.
[77ad86c]961 *
[34588a80]962 */
[5a6cc679]963errno_t ddf_fun_add_to_category(ddf_fun_t *fun, const char *cat_name)
[5fdd7c3]964{
[34588a80]965 assert(fun->bound == true);
966 assert(fun->ftype == fun_exposed);
[a35b458]967
[1dc4a5e]968 return devman_add_device_to_category(fun->handle, cat_name);
[5fdd7c3]969}
970
[45457265]971errno_t ddf_driver_main(const driver_t *drv)
[c16cf62]972{
[7a252ec8]973 /*
974 * Remember the driver structure - driver_ops will be called by generic
975 * handler for incoming connections.
976 */
[c16cf62]977 driver = drv;
[a35b458]978
[7a252ec8]979 /*
[033cbf82]980 * Register driver with device manager using generic handler for
981 * incoming connections.
[7a252ec8]982 */
[f9b2cb4c]983 port_id_t port;
[5a6cc679]984 errno_t rc = async_create_port(INTERFACE_DDF_DRIVER, driver_connection_driver,
[f9b2cb4c]985 NULL, &port);
[7b616e2]986 if (rc != EOK) {
987 printf("Error: Failed to create driver port.\n");
[f9b2cb4c]988 return rc;
[7b616e2]989 }
[a35b458]990
[f9b2cb4c]991 rc = async_create_port(INTERFACE_DDF_DEVMAN, driver_connection_devman,
992 NULL, &port);
[7b616e2]993 if (rc != EOK) {
994 printf("Error: Failed to create devman port.\n");
[f9b2cb4c]995 return rc;
[7b616e2]996 }
[a35b458]997
[f9b2cb4c]998 async_set_fallback_port_handler(driver_connection_client, NULL);
[a35b458]999
[f9b2cb4c]1000 rc = devman_driver_register(driver->name);
[033cbf82]1001 if (rc != EOK) {
[3ad7b1c]1002 printf("Error: Failed to register driver with device manager "
[8a637a4]1003 "(%s).\n", (rc == EEXIST) ? "driver already started" :
[3ad7b1c]1004 str_error(rc));
[a35b458]1005
[77ad86c]1006 return rc;
[033cbf82]1007 }
[a35b458]1008
[26fa82bc]1009 /* Return success from the task since server has started. */
1010 rc = task_retval(0);
[7b616e2]1011 if (rc != EOK) {
1012 printf("Error: Failed returning task value.\n");
[77ad86c]1013 return rc;
[7b616e2]1014 }
[a35b458]1015
[c16cf62]1016 async_manager();
[a35b458]1017
[7a252ec8]1018 /* Never reached. */
[77ad86c]1019 return EOK;
[c16cf62]1020}
1021
1022/**
1023 * @}
[52b7b1bb]1024 */
Note: See TracBrowser for help on using the repository browser.