HelenOS sources
This source file includes following definitions.
- obio_connection
- obio_add
- obio_remove
- obio_gone
#include <async.h>
#include <ddf/driver.h>
#include <ddf/log.h>
#include <ddi.h>
#include <errno.h>
#include <str_error.h>
#include <inttypes.h>
#include <ipc/irc.h>
#include <stdbool.h>
#include <stdio.h>
#include "obio.h"
#define NAME "obio"
#define OBIO_SIZE 0x1898
#define OBIO_IMR_BASE 0x200
#define OBIO_IMR(ino) (OBIO_IMR_BASE + ((ino) & INO_MASK))
#define OBIO_CIR_BASE 0x300
#define OBIO_CIR(ino) (OBIO_CIR_BASE + ((ino) & INO_MASK))
#define INO_MASK 0x1f
static void obio_connection(ipc_call_t *icall, void *arg)
{
ipc_call_t call;
obio_t *obio;
async_accept_0(icall);
obio = (obio_t *) ddf_dev_data_get(ddf_fun_get_dev((ddf_fun_t *) arg));
while (true) {
int inr;
async_get_call(&call);
switch (ipc_get_imethod(&call)) {
case IRC_ENABLE_INTERRUPT:
inr = ipc_get_arg1(&call);
pio_set_64(&obio->regs[OBIO_IMR(inr & INO_MASK)],
1UL << 31, 0);
async_answer_0(&call, EOK);
break;
case IRC_DISABLE_INTERRUPT:
async_answer_0(&call, EOK);
break;
case IRC_CLEAR_INTERRUPT:
inr = ipc_get_arg1(&call);
pio_write_64(&obio->regs[OBIO_CIR(inr & INO_MASK)], 0);
async_answer_0(&call, EOK);
break;
default:
async_answer_0(&call, EINVAL);
break;
}
}
}
errno_t obio_add(obio_t *obio, obio_res_t *res)
{
ddf_fun_t *fun_a = NULL;
errno_t rc;
bool bound = false;
rc = pio_enable((void *)res->base, OBIO_SIZE, (void **) &obio->regs);
if (rc != EOK) {
ddf_msg(LVL_ERROR, "Error mapping OBIO registers");
rc = EIO;
goto error;
}
ddf_msg(LVL_NOTE, "OBIO registers with base at 0x%" PRIxn, res->base);
fun_a = ddf_fun_create(obio->dev, fun_exposed, "a");
if (fun_a == NULL) {
ddf_msg(LVL_ERROR, "Failed creating function 'a'.");
rc = ENOMEM;
goto error;
}
ddf_fun_set_conn_handler(fun_a, obio_connection);
rc = ddf_fun_bind(fun_a);
if (rc != EOK) {
ddf_msg(LVL_ERROR, "Failed binding function 'a': %s", str_error(rc));
goto error;
}
rc = ddf_fun_add_to_category(fun_a, "irc");
if (rc != EOK)
goto error;
return EOK;
error:
if (bound)
ddf_fun_unbind(fun_a);
if (fun_a != NULL)
ddf_fun_destroy(fun_a);
return rc;
}
errno_t obio_remove(obio_t *obio)
{
return ENOTSUP;
}
errno_t obio_gone(obio_t *obio)
{
return ENOTSUP;
}
HelenOS homepage, sources at GitHub