linux-imx

​

    if (id != 0)

        return -EINVAL;

​

    addr += hub->addr + (link * FSI_HUB_LINK_SIZE);

    return fsi_slave_write(hub->upstream->slave, addr, val, size);

}

​

static int hub_master_break(struct fsi_master *master, int link)

{

​

    addr = 0x4;

    cmd = cpu_to_be32(0xc0de0000);

​

    return hub_master_write(master, link, 0, addr, &cmd, sizeof(cmd));

}

​

static int hub_master_link_enable(struct fsi_master *master, int link)

{

    struct fsi_master_hub *hub = to_fsi_master_hub(master);

            | FSI_MMODE_P8_TO_LSB);

    rc = fsi_device_write(dev, FSI_MMODE, &reg, sizeof(reg));

    if (rc)

        return rc;

​

    reg = cpu_to_be32(0xffff0000);

    rc = fsi_device_write(dev, FSI_MDLYR, &reg, sizeof(reg));

    if (rc)

        return rc;

​

    rc = fsi_device_write(dev, FSI_MSENP0, &reg, sizeof(reg));

    if (rc)

        return rc;

​

    /* Leave enabled long enough for master logic to set up */

    mdelay(FSI_LINK_ENABLE_SETUP_TIME);

​

    rc = fsi_device_write(dev, FSI_MCENP0, &reg, sizeof(reg));

    if (rc)

        return rc;