Index: uspace/lib/drv/Makefile =================================================================== --- uspace/lib/drv/Makefile (revision d81eaf943155460c68c8ab3d7f3ba26043bc8f01) +++ uspace/lib/drv/Makefile (revision dc9a3bad35af1e44ff24f701c2fc929aba3a5e55) @@ -35,4 +35,5 @@ generic/driver.c \ generic/dev_iface.c \ + generic/interrupt.c \ generic/log.c \ generic/logbuf.c \ Index: uspace/lib/drv/generic/driver.c =================================================================== --- uspace/lib/drv/generic/driver.c (revision d81eaf943155460c68c8ab3d7f3ba26043bc8f01) +++ uspace/lib/drv/generic/driver.c (revision dc9a3bad35af1e44ff24f701c2fc929aba3a5e55) @@ -70,18 +70,4 @@ FIBRIL_MUTEX_INITIALIZE(functions_mutex); -/** Interrupts */ -static interrupt_context_list_t interrupt_contexts; - -static irq_cmd_t default_cmds[] = { - { - .cmd = CMD_ACCEPT - } -}; - -static irq_code_t default_pseudocode = { - sizeof(default_cmds) / sizeof(irq_cmd_t), - default_cmds -}; - static ddf_dev_t *create_device(void); static void delete_device(ddf_dev_t *); @@ -92,132 +78,4 @@ static remote_handler_t *function_get_default_handler(ddf_fun_t *); static void *function_get_ops(ddf_fun_t *, dev_inferface_idx_t); - -static void driver_irq_handler(ipc_callid_t iid, ipc_call_t *icall) -{ - int id = (int)IPC_GET_IMETHOD(*icall); - interrupt_context_t *ctx; - - ctx = find_interrupt_context_by_id(&interrupt_contexts, id); - if (ctx != NULL && ctx->handler != NULL) - (*ctx->handler)(ctx->dev, iid, icall); -} - -interrupt_context_t *create_interrupt_context(void) -{ - interrupt_context_t *ctx; - - ctx = (interrupt_context_t *) malloc(sizeof(interrupt_context_t)); - if (ctx != NULL) - memset(ctx, 0, sizeof(interrupt_context_t)); - - return ctx; -} - -void delete_interrupt_context(interrupt_context_t *ctx) -{ - if (ctx != NULL) - free(ctx); -} - -void init_interrupt_context_list(interrupt_context_list_t *list) -{ - memset(list, 0, sizeof(interrupt_context_list_t)); - fibril_mutex_initialize(&list->mutex); - list_initialize(&list->contexts); -} - -void -add_interrupt_context(interrupt_context_list_t *list, interrupt_context_t *ctx) -{ - fibril_mutex_lock(&list->mutex); - ctx->id = list->curr_id++; - list_append(&ctx->link, &list->contexts); - fibril_mutex_unlock(&list->mutex); -} - -void remove_interrupt_context(interrupt_context_list_t *list, - interrupt_context_t *ctx) -{ - fibril_mutex_lock(&list->mutex); - list_remove(&ctx->link); - fibril_mutex_unlock(&list->mutex); -} - -interrupt_context_t * -find_interrupt_context_by_id(interrupt_context_list_t *list, int id) -{ - interrupt_context_t *ctx; - - fibril_mutex_lock(&list->mutex); - - list_foreach(list->contexts, link) { - ctx = list_get_instance(link, interrupt_context_t, link); - if (ctx->id == id) { - fibril_mutex_unlock(&list->mutex); - return ctx; - } - } - - fibril_mutex_unlock(&list->mutex); - return NULL; -} - -interrupt_context_t * -find_interrupt_context(interrupt_context_list_t *list, ddf_dev_t *dev, int irq) -{ - interrupt_context_t *ctx; - - fibril_mutex_lock(&list->mutex); - - list_foreach(list->contexts, link) { - ctx = list_get_instance(link, interrupt_context_t, link); - if (ctx->irq == irq && ctx->dev == dev) { - fibril_mutex_unlock(&list->mutex); - return ctx; - } - } - - fibril_mutex_unlock(&list->mutex); - return NULL; -} - - -int -register_interrupt_handler(ddf_dev_t *dev, int irq, interrupt_handler_t *handler, - irq_code_t *pseudocode) -{ - interrupt_context_t *ctx = create_interrupt_context(); - - ctx->dev = dev; - ctx->irq = irq; - ctx->handler = handler; - - add_interrupt_context(&interrupt_contexts, ctx); - - if (pseudocode == NULL) - pseudocode = &default_pseudocode; - - int res = irq_register(irq, dev->handle, ctx->id, pseudocode); - if (res != EOK) { - remove_interrupt_context(&interrupt_contexts, ctx); - delete_interrupt_context(ctx); - } - - return res; -} - -int unregister_interrupt_handler(ddf_dev_t *dev, int irq) -{ - interrupt_context_t *ctx = find_interrupt_context(&interrupt_contexts, - dev, irq); - int res = irq_unregister(irq, dev->handle); - - if (ctx != NULL) { - remove_interrupt_context(&interrupt_contexts, ctx); - delete_interrupt_context(ctx); - } - - return res; -} static void add_to_functions_list(ddf_fun_t *fun) @@ -992,9 +850,6 @@ driver = drv; - /* Initialize the list of interrupt contexts. */ - init_interrupt_context_list(&interrupt_contexts); - - /* Set generic interrupt handler. */ - async_set_interrupt_received(driver_irq_handler); + /* Initialize interrupt module */ + interrupt_init(); /* Index: uspace/lib/drv/generic/interrupt.c =================================================================== --- uspace/lib/drv/generic/interrupt.c (revision dc9a3bad35af1e44ff24f701c2fc929aba3a5e55) +++ uspace/lib/drv/generic/interrupt.c (revision dc9a3bad35af1e44ff24f701c2fc929aba3a5e55) @@ -0,0 +1,213 @@ +/* + * Copyright (c) 2010 Lenka Trochtova + * All rights reserved. + * + * Redistribution and use in source and binary forms, with or without + * modification, are permitted provided that the following conditions + * are met: + * + * - Redistributions of source code must retain the above copyright + * notice, this list of conditions and the following disclaimer. + * - Redistributions in binary form must reproduce the above copyright + * notice, this list of conditions and the following disclaimer in the + * documentation and/or other materials provided with the distribution. + * - The name of the author may not be used to endorse or promote products + * derived from this software without specific prior written permission. + * + * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR + * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES + * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. + * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, + * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT + * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, + * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY + * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT + * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF + * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. + */ + +/** + * @defgroup libdrv generic device driver support. + * @brief HelenOS generic device driver support. + * @{ + */ + +/** @file + */ + +#include +#include +#include + +#include "ddf/interrupt.h" + +static void driver_irq_handler(ipc_callid_t iid, ipc_call_t *icall); +static interrupt_context_t *create_interrupt_context(void); +static void delete_interrupt_context(interrupt_context_t *ctx); +static void init_interrupt_context_list(interrupt_context_list_t *list); +static void add_interrupt_context(interrupt_context_list_t *list, + interrupt_context_t *ctx); +static void remove_interrupt_context(interrupt_context_list_t *list, + interrupt_context_t *ctx); +static interrupt_context_t *find_interrupt_context_by_id( + interrupt_context_list_t *list, int id); +static interrupt_context_t *find_interrupt_context( + interrupt_context_list_t *list, ddf_dev_t *dev, int irq); +int register_interrupt_handler(ddf_dev_t *dev, int irq, + interrupt_handler_t *handler, irq_code_t *pseudocode); +int unregister_interrupt_handler(ddf_dev_t *dev, int irq); + +/** Interrupts */ +static interrupt_context_list_t interrupt_contexts; + +static irq_cmd_t default_cmds[] = { + { + .cmd = CMD_ACCEPT + } +}; + +static irq_code_t default_pseudocode = { + sizeof(default_cmds) / sizeof(irq_cmd_t), + default_cmds +}; + +void interrupt_init(void) +{ + /* Initialize the list of interrupt contexts. */ + init_interrupt_context_list(&interrupt_contexts); + + /* Set generic interrupt handler. */ + async_set_interrupt_received(driver_irq_handler); +} + +static void driver_irq_handler(ipc_callid_t iid, ipc_call_t *icall) +{ + int id = (int)IPC_GET_IMETHOD(*icall); + interrupt_context_t *ctx; + + ctx = find_interrupt_context_by_id(&interrupt_contexts, id); + if (ctx != NULL && ctx->handler != NULL) + (*ctx->handler)(ctx->dev, iid, icall); +} + +static interrupt_context_t *create_interrupt_context(void) +{ + interrupt_context_t *ctx; + + ctx = (interrupt_context_t *) malloc(sizeof(interrupt_context_t)); + if (ctx != NULL) + memset(ctx, 0, sizeof(interrupt_context_t)); + + return ctx; +} + +static void delete_interrupt_context(interrupt_context_t *ctx) +{ + if (ctx != NULL) + free(ctx); +} + +static void init_interrupt_context_list(interrupt_context_list_t *list) +{ + memset(list, 0, sizeof(interrupt_context_list_t)); + fibril_mutex_initialize(&list->mutex); + list_initialize(&list->contexts); +} + +static void +add_interrupt_context(interrupt_context_list_t *list, interrupt_context_t *ctx) +{ + fibril_mutex_lock(&list->mutex); + ctx->id = list->curr_id++; + list_append(&ctx->link, &list->contexts); + fibril_mutex_unlock(&list->mutex); +} + +static void remove_interrupt_context(interrupt_context_list_t *list, + interrupt_context_t *ctx) +{ + fibril_mutex_lock(&list->mutex); + list_remove(&ctx->link); + fibril_mutex_unlock(&list->mutex); +} + +static interrupt_context_t * +find_interrupt_context_by_id(interrupt_context_list_t *list, int id) +{ + interrupt_context_t *ctx; + + fibril_mutex_lock(&list->mutex); + + list_foreach(list->contexts, link) { + ctx = list_get_instance(link, interrupt_context_t, link); + if (ctx->id == id) { + fibril_mutex_unlock(&list->mutex); + return ctx; + } + } + + fibril_mutex_unlock(&list->mutex); + return NULL; +} + +static interrupt_context_t * +find_interrupt_context(interrupt_context_list_t *list, ddf_dev_t *dev, int irq) +{ + interrupt_context_t *ctx; + + fibril_mutex_lock(&list->mutex); + + list_foreach(list->contexts, link) { + ctx = list_get_instance(link, interrupt_context_t, link); + if (ctx->irq == irq && ctx->dev == dev) { + fibril_mutex_unlock(&list->mutex); + return ctx; + } + } + + fibril_mutex_unlock(&list->mutex); + return NULL; +} + + +int +register_interrupt_handler(ddf_dev_t *dev, int irq, interrupt_handler_t *handler, + irq_code_t *pseudocode) +{ + interrupt_context_t *ctx = create_interrupt_context(); + + ctx->dev = dev; + ctx->irq = irq; + ctx->handler = handler; + + add_interrupt_context(&interrupt_contexts, ctx); + + if (pseudocode == NULL) + pseudocode = &default_pseudocode; + + int res = irq_register(irq, dev->handle, ctx->id, pseudocode); + if (res != EOK) { + remove_interrupt_context(&interrupt_contexts, ctx); + delete_interrupt_context(ctx); + } + + return res; +} + +int unregister_interrupt_handler(ddf_dev_t *dev, int irq) +{ + interrupt_context_t *ctx = find_interrupt_context(&interrupt_contexts, + dev, irq); + int res = irq_unregister(irq, dev->handle); + + if (ctx != NULL) { + remove_interrupt_context(&interrupt_contexts, ctx); + delete_interrupt_context(ctx); + } + + return res; +} + +/** + * @} + */ Index: uspace/lib/drv/include/ddf/interrupt.h =================================================================== --- uspace/lib/drv/include/ddf/interrupt.h (revision d81eaf943155460c68c8ab3d7f3ba26043bc8f01) +++ uspace/lib/drv/include/ddf/interrupt.h (revision dc9a3bad35af1e44ff24f701c2fc929aba3a5e55) @@ -64,16 +64,5 @@ } interrupt_context_list_t; -extern interrupt_context_t *create_interrupt_context(void); -extern void delete_interrupt_context(interrupt_context_t *); -extern void init_interrupt_context_list(interrupt_context_list_t *); -extern void add_interrupt_context(interrupt_context_list_t *, - interrupt_context_t *); -extern void remove_interrupt_context(interrupt_context_list_t *, - interrupt_context_t *); -extern interrupt_context_t *find_interrupt_context_by_id( - interrupt_context_list_t *, int); -extern interrupt_context_t *find_interrupt_context( - interrupt_context_list_t *, ddf_dev_t *, int); - +extern void interrupt_init(void); extern int register_interrupt_handler(ddf_dev_t *, int, interrupt_handler_t *, irq_code_t *);