static int validate_reg(struct nvhost_device *ndev, u32 offset, int count)
{
struct resource *r = nvhost_get_resource(ndev, IORESOURCE_MEM, 0);
int err = 0;
if (offset + 4 * count > resource_size(r)
|| (offset + 4 * count < offset))
err = -EPERM;
return err;
}
int nvhost_get_irq(struct nvhost_device *dev, unsigned int num)
{
struct resource *r = nvhost_get_resource(dev, IORESOURCE_IRQ, num);
return r ? r->start : -ENXIO;
}
static int __devinit nvhost_probe(struct nvhost_device *dev,
struct nvhost_device_id *id_table)
{
struct nvhost_master *host;
struct resource *regs, *intr0, *intr1;
int i, err;
regs = nvhost_get_resource(dev, IORESOURCE_MEM, 0);
intr0 = nvhost_get_resource(dev, IORESOURCE_IRQ, 0);
intr1 = nvhost_get_resource(dev, IORESOURCE_IRQ, 1);
if (!regs || !intr0 || !intr1) {
dev_err(&dev->dev, "missing required platform resources\n");
return -ENXIO;
}
host = kzalloc(sizeof(*host), GFP_KERNEL);
if (!host)
return -ENOMEM;
/* Register host1x device as bus master */
host->dev = dev;
/* Copy host1x parameters */
memcpy(&host->info, dev->dev.platform_data,
sizeof(struct host1x_device_info));
host->reg_mem = request_mem_region(regs->start,
resource_size(regs), dev->name);
if (!host->reg_mem) {
dev_err(&dev->dev, "failed to get host register memory\n");
err = -ENXIO;
goto fail;
}
host->aperture = ioremap(regs->start, resource_size(regs));
if (!host->aperture) {
dev_err(&dev->dev, "failed to remap host registers\n");
err = -ENXIO;
goto fail;
}
err = nvhost_alloc_resources(host);
if (err) {
dev_err(&dev->dev, "failed to init chip support\n");
goto fail;
}
host->memmgr = mem_op().alloc_mgr();
if (!host->memmgr) {
dev_err(&dev->dev, "unable to create nvmap client\n");
err = -EIO;
goto fail;
}
/* Register host1x device as bus master */
host->dev = dev;
/* Give pointer to host1x via driver */
nvhost_set_drvdata(dev, host);
nvhost_bus_add_host(host);
err = nvhost_syncpt_init(dev, &host->syncpt);
if (err)
goto fail;
err = nvhost_intr_init(&host->intr, intr1->start, intr0->start);
if (err)
goto fail;
err = nvhost_user_init(host);
if (err)
goto fail;
err = nvhost_module_init(dev);
if (err)
goto fail;
for (i = 0; i < host->dev->num_clks; i++)
clk_enable(host->dev->clk[i]);
nvhost_syncpt_reset(&host->syncpt);
for (i = 0; i < host->dev->num_clks; i++)
clk_disable(host->dev->clk[0]);
nvhost_debug_init(host);
dev_info(&dev->dev, "initialized\n");
return 0;
fail:
nvhost_free_resources(host);
if (host->memmgr)
mem_op().put_mgr(host->memmgr);
kfree(host);
return err;
}
