/** Get address of registers and IRQ for given device.
*
* @param[in] dev Device asking for the addresses.
* @param[out] mem_reg_address Base address of the memory range.
* @param[out] mem_reg_size Size of the memory range.
* @param[out] irq_no IRQ assigned to the device.
* @return Error code.
*/
int get_my_registers(ddf_dev_t *dev,
uintptr_t *mem_reg_address, size_t *mem_reg_size, int *irq_no)
{
assert(dev);
async_sess_t *parent_sess =
devman_parent_device_connect(EXCHANGE_SERIALIZE,
ddf_dev_get_handle(dev), IPC_FLAG_BLOCKING);
if (!parent_sess)
return ENOMEM;
hw_res_list_parsed_t hw_res;
hw_res_list_parsed_init(&hw_res);
const int ret = hw_res_get_list_parsed(parent_sess, &hw_res, 0);
async_hangup(parent_sess);
if (ret != EOK) {
return ret;
}
/* We want one irq and one mem range. */
if (hw_res.irqs.count != 1 || hw_res.mem_ranges.count != 1) {
hw_res_list_parsed_clean(&hw_res);
return EINVAL;
}
if (mem_reg_address)
*mem_reg_address = hw_res.mem_ranges.ranges[0].address;
if (mem_reg_size)
*mem_reg_size = hw_res.mem_ranges.ranges[0].size;
if (irq_no)
*irq_no = hw_res.irqs.irqs[0];
hw_res_list_parsed_clean(&hw_res);
return EOK;
}
/** Get address of I/O registers.
*
* @param[in] dev Device asking for the addresses.
* @param[out] io_reg_address Base address of the memory range.
* @param[out] io_reg_size Size of the memory range.
* @return Error code.
*/
int hc_get_my_registers(
const ddf_dev_t *dev, uintptr_t *io_reg_address, size_t *io_reg_size)
{
assert(dev);
async_sess_t *parent_sess =
devman_parent_device_connect(EXCHANGE_SERIALIZE, dev->handle,
IPC_FLAG_BLOCKING);
if (!parent_sess)
return ENOMEM;
hw_res_list_parsed_t hw_res;
hw_res_list_parsed_init(&hw_res);
const int ret = hw_res_get_list_parsed(parent_sess, &hw_res, 0);
async_hangup(parent_sess);
if (ret != EOK) {
return ret;
}
if (hw_res.io_ranges.count != 1) {
hw_res_list_parsed_clean(&hw_res);
return EINVAL;
}
if (io_reg_address != NULL)
*io_reg_address = hw_res.io_ranges.ranges[0].address;
if (io_reg_size != NULL)
*io_reg_size = hw_res.io_ranges.ranges[0].size;
hw_res_list_parsed_clean(&hw_res);
return EOK;
}
/**
* Connect to the parent's driver and get HW resources list in parsed format.
* Note: this function should be called only from add_device handler, therefore
* we don't need to use locks.
*
* @param nic_data
* @param[out] resources Parsed lists of resources.
*
* @return EOK or negative error code
*/
int nic_get_resources(nic_t *nic_data, hw_res_list_parsed_t *resources)
{
ddf_dev_t *dev = nic_data->dev;
async_sess_t *parent_sess;
/* Connect to the parent's driver. */
parent_sess = ddf_dev_parent_sess_create(dev, EXCHANGE_SERIALIZE);
if (parent_sess == NULL)
return EPARTY;
return hw_res_get_list_parsed(parent_sess, resources, 0);
}
/** Get address of I/O registers.
*
* @param[in] dev Device asking for the addresses.
* @param[out] io_reg_address Base address of the memory range.
* @param[out] io_reg_size Size of the memory range.
* @param[out] kbd_irq Primary port IRQ.
* @param[out] mouse_irq Auxiliary port IRQ.
*
* @return Error code.
*
*/
static int get_my_registers(ddf_dev_t *dev, uintptr_t *io_reg_address,
size_t *io_reg_size, int *kbd_irq, int *mouse_irq)
{
assert(dev);
async_sess_t *parent_sess = ddf_dev_parent_sess_create(
dev, EXCHANGE_SERIALIZE);
if (parent_sess == NULL)
return ENOMEM;
hw_res_list_parsed_t hw_resources;
hw_res_list_parsed_init(&hw_resources);
const int ret = hw_res_get_list_parsed(parent_sess, &hw_resources, 0);
if (ret != EOK)
return ret;
if ((hw_resources.irqs.count != 2) ||
(hw_resources.io_ranges.count != 1)) {
hw_res_list_parsed_clean(&hw_resources);
return EINVAL;
}
if (io_reg_address)
*io_reg_address = hw_resources.io_ranges.ranges[0].address;
if (io_reg_size)
*io_reg_size = hw_resources.io_ranges.ranges[0].size;
if (kbd_irq)
*kbd_irq = hw_resources.irqs.irqs[0];
if (mouse_irq)
*mouse_irq = hw_resources.irqs.irqs[1];
hw_res_list_parsed_clean(&hw_resources);
return EOK;
}
/** Initialize new SB16 driver instance.
*
* @param[in] device DDF instance of the device to initialize.
* @return Error code.
*/
static int sb_add_device(ddf_dev_t *device)
{
bool handler_regd = false;
const size_t irq_cmd_count = sb16_irq_code_size();
irq_cmd_t irq_cmds[irq_cmd_count];
irq_pio_range_t irq_ranges[1];
sb16_t *soft_state = ddf_dev_data_alloc(device, sizeof(sb16_t));
int rc = soft_state ? EOK : ENOMEM;
if (rc != EOK) {
ddf_log_error("Failed to allocate sb16 structure.");
goto error;
}
addr_range_t sb_regs;
addr_range_t *p_sb_regs = &sb_regs;
addr_range_t mpu_regs;
addr_range_t *p_mpu_regs = &mpu_regs;
int irq = 0, dma8 = 0, dma16 = 0;
rc = sb_get_res(device, &p_sb_regs, &p_mpu_regs, &irq, &dma8, &dma16);
if (rc != EOK) {
ddf_log_error("Failed to get resources: %s.", str_error(rc));
goto error;
}
sb16_irq_code(p_sb_regs, dma8, dma16, irq_cmds, irq_ranges);
irq_code_t irq_code = {
.cmdcount = irq_cmd_count,
.cmds = irq_cmds,
.rangecount = 1,
.ranges = irq_ranges
};
rc = register_interrupt_handler(device, irq, irq_handler, &irq_code);
if (rc != EOK) {
ddf_log_error("Failed to register irq handler: %s.",
str_error(rc));
goto error;
}
handler_regd = true;
rc = sb_enable_interrupts(device);
if (rc != EOK) {
ddf_log_error("Failed to enable interrupts: %s.",
str_error(rc));
goto error;
}
rc = sb16_init_sb16(soft_state, p_sb_regs, device, dma8, dma16);
if (rc != EOK) {
ddf_log_error("Failed to init sb16 driver: %s.",
str_error(rc));
goto error;
}
rc = sb16_init_mpu(soft_state, p_mpu_regs);
if (rc == EOK) {
ddf_fun_t *mpu_fun =
ddf_fun_create(device, fun_exposed, "midi");
if (mpu_fun) {
rc = ddf_fun_bind(mpu_fun);
if (rc != EOK)
ddf_log_error(
"Failed to bind midi function: %s.",
str_error(rc));
} else {
ddf_log_error("Failed to create midi function.");
}
} else {
ddf_log_warning("Failed to init mpu driver: %s.",
str_error(rc));
}
/* MPU state does not matter */
return EOK;
error:
if (handler_regd)
unregister_interrupt_handler(device, irq);
return rc;
}
static int sb_get_res(ddf_dev_t *device, addr_range_t **pp_sb_regs,
addr_range_t **pp_mpu_regs, int *irq, int *dma8, int *dma16)
{
assert(device);
async_sess_t *parent_sess = devman_parent_device_connect(
ddf_dev_get_handle(device), IPC_FLAG_BLOCKING);
if (!parent_sess)
return ENOMEM;
hw_res_list_parsed_t hw_res;
hw_res_list_parsed_init(&hw_res);
const int ret = hw_res_get_list_parsed(parent_sess, &hw_res, 0);
async_hangup(parent_sess);
if (ret != EOK) {
return ret;
}
/* 1x IRQ, 1-2x DMA(8,16), 1-2x IO (MPU is separate). */
if (hw_res.irqs.count != 1 ||
(hw_res.io_ranges.count != 1 && hw_res.io_ranges.count != 2) ||
(hw_res.dma_channels.count != 1 && hw_res.dma_channels.count != 2)) {
hw_res_list_parsed_clean(&hw_res);
return EINVAL;
}
if (irq)
*irq = hw_res.irqs.irqs[0];
if (dma8) {
if (hw_res.dma_channels.channels[0] < 4) {
*dma8 = hw_res.dma_channels.channels[0];
} else {
if (hw_res.dma_channels.count == 2 &&
hw_res.dma_channels.channels[1] < 4) {
*dma8 = hw_res.dma_channels.channels[1];
}
}
}
if (dma16) {
if (hw_res.dma_channels.channels[0] > 4) {
*dma16 = hw_res.dma_channels.channels[0];
} else {
if (hw_res.dma_channels.count == 2 &&
hw_res.dma_channels.channels[1] > 4) {
*dma16 = hw_res.dma_channels.channels[1];
}
}
}
if (hw_res.io_ranges.count == 1) {
if (pp_sb_regs && *pp_sb_regs)
**pp_sb_regs = hw_res.io_ranges.ranges[0];
if (pp_mpu_regs)
*pp_mpu_regs = NULL;
} else {
const int sb =
(hw_res.io_ranges.ranges[0].size >= sizeof(sb16_regs_t))
? 0 : 1;
const int mpu = 1 - sb;
if (pp_sb_regs && *pp_sb_regs)
**pp_sb_regs = hw_res.io_ranges.ranges[sb];
if (pp_mpu_regs && *pp_mpu_regs)
**pp_mpu_regs = hw_res.io_ranges.ranges[mpu];
}
return EOK;
}
