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; }