Function syscon_probe

components/drivers/mfd/mfd-syscon.c:164–210

}

static rt_err_t syscon_probe(struct rt_platform_device *pdev)
{
    rt_err_t err;
    rt_ubase_t level;
    struct rt_ofw_node *np;
    rt_uint64_t iomem_range[2];
    struct rt_syscon *syscon = rt_calloc(1, sizeof(*syscon));

    if (!syscon)
    {
        return -RT_ENOMEM;
    }

    np = pdev->parent.ofw_node;

    if ((err = rt_ofw_get_address(np, 0, &iomem_range[0], &iomem_range[1])))
    {
        goto _fail;
    }

    syscon->iomem_size = (rt_size_t)iomem_range[1];
    syscon->iomem_base = rt_ioremap((void *)iomem_range[0], syscon->iomem_size);

    if (!syscon->iomem_base)
    {
        goto _fail;
    }

    rt_list_init(&syscon->list);
    level = rt_spin_lock_irqsave(&_syscon_nodes_lock);
    rt_list_insert_after(&_syscon_nodes, &syscon->list);
    rt_spin_unlock_irqrestore(&_syscon_nodes_lock, level);

    rt_spin_lock_init(&syscon->rw_lock);

    pdev->parent.user_data = syscon;

    syscon->np = pdev->parent.ofw_node;
    rt_ofw_data(np) = syscon;

    return RT_EOK;

_fail:
    rt_free(syscon);

    return err;
}

static rt_err_t syscon_remove(struct rt_platform_device *pdev)
{