Function pic_mbox_probe

components/drivers/mailbox/mailbox-pic.c:161–263

}

static rt_err_t pic_mbox_probe(struct rt_platform_device *pdev)
{
    rt_err_t err;
    rt_uint64_t size;
    rt_uint32_t value;
    char dev_name[RT_NAME_MAX];
    struct rt_ofw_node *pic_np;
    struct rt_device *dev = &pdev->parent;
    struct pic_mbox *pic_mbox = rt_calloc(1, sizeof(*pic_mbox));

    if (!pic_mbox)
    {
        return -RT_ENOMEM;
    }

    if ((err = rt_dm_dev_get_address(dev, 0, RT_NULL, &size)))
    {
        goto _fail;
    }

    if ((err = rt_dm_dev_prop_read_u32(dev, "position", &value)))
    {
        goto _fail;
    }

    if (!value)
    {
        pic_mbox->regs = rt_dm_dev_iomap(dev, 0);

        if (!pic_mbox->regs)
        {
            goto _fail;
        }

        pic_mbox->peer_regs = pic_mbox->regs + size / 2;

        /* Init by the captain */
        HWREG32(pic_mbox->regs + MAILBOX_IMASK) = 0xffffffff;
        HWREG32(pic_mbox->regs + MAILBOX_ISTATE) = 0;
        HWREG32(pic_mbox->peer_regs + MAILBOX_IMASK) = 0xffffffff;
        HWREG32(pic_mbox->peer_regs + MAILBOX_ISTATE) = 0;
    }
    else
    {
        pic_mbox->peer_regs = rt_dm_dev_iomap(dev, 0);

        if (!pic_mbox->peer_regs)
        {
            goto _fail;
        }

        pic_mbox->regs = pic_mbox->peer_regs + size / 2;
    }

    pic_mbox->irq = rt_dm_dev_get_irq(dev, 0);

    if (pic_mbox->irq < 0)
    {