HelenOS sources
This source file includes following definitions.
- msim_get_resources
- msim_enable_interrupt
- msim_get_pio_window
- msim_add_fun
- msim_add_functions
- msim_dev_add
- msim_init
- main
#include <assert.h>
#include <ddf/driver.h>
#include <ddf/log.h>
#include <errno.h>
#include <ipc/dev_iface.h>
#include <ops/hw_res.h>
#include <ops/pio_window.h>
#include <stdbool.h>
#include <stdio.h>
#define NAME "msim"
#define MSIM_DDISK_BASE UINT32_C(0x10000200)
#define MSIM_DDISK_SIZE UINT32_C(0x00000010)
#define MSIM_DDISK_IRQ 6
#define MSIM_KBD_ADDRESS UINT32_C(0x10000000)
#define MSIM_KBD_SIZE 1
#define MSIM_KBD_IRQ 2
typedef struct msim_fun {
hw_resource_list_t hw_resources;
pio_window_t pio_window;
} msim_fun_t;
static errno_t msim_dev_add(ddf_dev_t *dev);
static void msim_init(void);
static driver_ops_t msim_ops = {
.dev_add = &msim_dev_add
};
static driver_t msim_driver = {
.name = NAME,
.driver_ops = &msim_ops
};
static hw_resource_t disk_regs[] = {
{
.type = MEM_RANGE,
.res.mem_range = {
.address = 0,
.size = 16,
.relative = true,
.endianness = LITTLE_ENDIAN
}
},
{
.type = INTERRUPT,
.res.interrupt = {
.irq = MSIM_DDISK_IRQ
}
}
};
static msim_fun_t disk_data = {
.hw_resources = {
sizeof(disk_regs) / sizeof(disk_regs[0]),
disk_regs
},
.pio_window = {
.mem = {
.base = MSIM_DDISK_BASE,
.size = MSIM_DDISK_SIZE
}
}
};
static hw_resource_t console_regs[] = {
{
.type = MEM_RANGE,
.res.mem_range = {
.address = 0,
.size = 1,
.relative = true,
.endianness = LITTLE_ENDIAN
}
},
{
.type = INTERRUPT,
.res.interrupt = {
.irq = MSIM_KBD_IRQ
}
}
};
static msim_fun_t console_data = {
.hw_resources = {
sizeof(console_regs) / sizeof(console_regs[0]),
console_regs
},
.pio_window = {
.mem = {
.base = MSIM_KBD_ADDRESS,
.size = MSIM_KBD_SIZE
}
}
};
static msim_fun_t *msim_fun(ddf_fun_t *fnode)
{
return ddf_fun_data_get(fnode);
}
static hw_resource_list_t *msim_get_resources(ddf_fun_t *fnode)
{
msim_fun_t *fun = msim_fun(fnode);
assert(fun != NULL);
return &fun->hw_resources;
}
static errno_t msim_enable_interrupt(ddf_fun_t *fun, int irq)
{
return EOK;
}
static pio_window_t *msim_get_pio_window(ddf_fun_t *fnode)
{
msim_fun_t *fun = msim_fun(fnode);
assert(fun != NULL);
return &fun->pio_window;
}
static hw_res_ops_t fun_hw_res_ops = {
.get_resource_list = &msim_get_resources,
.enable_interrupt = &msim_enable_interrupt,
};
static pio_window_ops_t fun_pio_window_ops = {
.get_pio_window = &msim_get_pio_window
};
static ddf_dev_ops_t msim_fun_ops;
static bool
msim_add_fun(ddf_dev_t *dev, const char *name, const char *str_match_id,
msim_fun_t *fun_proto)
{
ddf_msg(LVL_DEBUG, "Adding new function '%s'.", name);
ddf_fun_t *fnode = NULL;
errno_t rc;
fnode = ddf_fun_create(dev, fun_inner, name);
if (fnode == NULL)
goto failure;
msim_fun_t *fun = ddf_fun_data_alloc(fnode, sizeof(msim_fun_t));
if (fun == NULL)
goto failure;
*fun = *fun_proto;
rc = ddf_fun_add_match_id(fnode, str_match_id, 100);
if (rc != EOK)
goto failure;
ddf_fun_set_ops(fnode, &msim_fun_ops);
if (ddf_fun_bind(fnode) != EOK) {
ddf_msg(LVL_ERROR, "Failed binding function %s.", name);
goto failure;
}
return true;
failure:
if (fnode != NULL)
ddf_fun_destroy(fnode);
ddf_msg(LVL_ERROR, "Failed adding function '%s'.", name);
return false;
}
static bool msim_add_functions(ddf_dev_t *dev)
{
if (!msim_add_fun(dev, "disk0", "msim/ddisk", &disk_data))
return false;
if (!msim_add_fun(dev, "console", "msim/console", &console_data))
return false;
return true;
}
static errno_t msim_dev_add(ddf_dev_t *dev)
{
ddf_msg(LVL_DEBUG, "msim_dev_add, device handle = %d",
(int) ddf_dev_get_handle(dev));
if (!msim_add_functions(dev))
ddf_msg(LVL_ERROR, "Failed to add functions for the MSIM platform.");
return EOK;
}
static void msim_init(void)
{
ddf_log_init(NAME);
msim_fun_ops.interfaces[HW_RES_DEV_IFACE] = &fun_hw_res_ops;
msim_fun_ops.interfaces[PIO_WINDOW_DEV_IFACE] = &fun_pio_window_ops;
}
int main(int argc, char *argv[])
{
printf(NAME ": HelenOS MSIM platform driver\n");
msim_init();
return ddf_driver_main(&msim_driver);
}
HelenOS homepage, sources at GitHub