|
@@ -522,10 +522,8 @@ static int virtio_mmio_probe(struct platform_device *pdev)
|
|
|
return -EBUSY;
|
|
|
|
|
|
vm_dev = devm_kzalloc(&pdev->dev, sizeof(*vm_dev), GFP_KERNEL);
|
|
|
- if (!vm_dev) {
|
|
|
- rc = -ENOMEM;
|
|
|
- goto free_mem;
|
|
|
- }
|
|
|
+ if (!vm_dev)
|
|
|
+ return -ENOMEM;
|
|
|
|
|
|
vm_dev->vdev.dev.parent = &pdev->dev;
|
|
|
vm_dev->vdev.dev.release = virtio_mmio_release_dev;
|
|
@@ -535,17 +533,14 @@ static int virtio_mmio_probe(struct platform_device *pdev)
|
|
|
spin_lock_init(&vm_dev->lock);
|
|
|
|
|
|
vm_dev->base = devm_ioremap(&pdev->dev, mem->start, resource_size(mem));
|
|
|
- if (vm_dev->base == NULL) {
|
|
|
- rc = -EFAULT;
|
|
|
- goto free_vmdev;
|
|
|
- }
|
|
|
+ if (vm_dev->base == NULL)
|
|
|
+ return -EFAULT;
|
|
|
|
|
|
/* Check magic value */
|
|
|
magic = readl(vm_dev->base + VIRTIO_MMIO_MAGIC_VALUE);
|
|
|
if (magic != ('v' | 'i' << 8 | 'r' << 16 | 't' << 24)) {
|
|
|
dev_warn(&pdev->dev, "Wrong magic value 0x%08lx!\n", magic);
|
|
|
- rc = -ENODEV;
|
|
|
- goto unmap;
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
|
|
|
/* Check device version */
|
|
@@ -553,8 +548,7 @@ static int virtio_mmio_probe(struct platform_device *pdev)
|
|
|
if (vm_dev->version < 1 || vm_dev->version > 2) {
|
|
|
dev_err(&pdev->dev, "Version %ld not supported!\n",
|
|
|
vm_dev->version);
|
|
|
- rc = -ENXIO;
|
|
|
- goto unmap;
|
|
|
+ return -ENXIO;
|
|
|
}
|
|
|
|
|
|
vm_dev->vdev.id.device = readl(vm_dev->base + VIRTIO_MMIO_DEVICE_ID);
|
|
@@ -563,8 +557,7 @@ static int virtio_mmio_probe(struct platform_device *pdev)
|
|
|
* virtio-mmio device with an ID 0 is a (dummy) placeholder
|
|
|
* with no function. End probing now with no error reported.
|
|
|
*/
|
|
|
- rc = -ENODEV;
|
|
|
- goto unmap;
|
|
|
+ return -ENODEV;
|
|
|
}
|
|
|
vm_dev->vdev.id.vendor = readl(vm_dev->base + VIRTIO_MMIO_VENDOR_ID);
|
|
|
|
|
@@ -590,33 +583,15 @@ static int virtio_mmio_probe(struct platform_device *pdev)
|
|
|
platform_set_drvdata(pdev, vm_dev);
|
|
|
|
|
|
rc = register_virtio_device(&vm_dev->vdev);
|
|
|
- if (rc) {
|
|
|
- iounmap(vm_dev->base);
|
|
|
- devm_release_mem_region(&pdev->dev, mem->start,
|
|
|
- resource_size(mem));
|
|
|
+ if (rc)
|
|
|
put_device(&vm_dev->vdev.dev);
|
|
|
- }
|
|
|
- return rc;
|
|
|
-unmap:
|
|
|
- iounmap(vm_dev->base);
|
|
|
-free_mem:
|
|
|
- devm_release_mem_region(&pdev->dev, mem->start,
|
|
|
- resource_size(mem));
|
|
|
-free_vmdev:
|
|
|
- devm_kfree(&pdev->dev, vm_dev);
|
|
|
+
|
|
|
return rc;
|
|
|
}
|
|
|
|
|
|
static int virtio_mmio_remove(struct platform_device *pdev)
|
|
|
{
|
|
|
struct virtio_mmio_device *vm_dev = platform_get_drvdata(pdev);
|
|
|
- struct resource *mem;
|
|
|
-
|
|
|
- iounmap(vm_dev->base);
|
|
|
- mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
|
|
|
- if (mem)
|
|
|
- devm_release_mem_region(&pdev->dev, mem->start,
|
|
|
- resource_size(mem));
|
|
|
unregister_virtio_device(&vm_dev->vdev);
|
|
|
|
|
|
return 0;
|