1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun * Copyright (C) 2013 - Virtual Open Systems
4*4882a593Smuzhiyun * Author: Antonios Motakis <a.motakis@virtualopensystems.com>
5*4882a593Smuzhiyun */
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun #include <linux/module.h>
8*4882a593Smuzhiyun #include <linux/slab.h>
9*4882a593Smuzhiyun #include <linux/vfio.h>
10*4882a593Smuzhiyun #include <linux/amba/bus.h>
11*4882a593Smuzhiyun
12*4882a593Smuzhiyun #include "vfio_platform_private.h"
13*4882a593Smuzhiyun
14*4882a593Smuzhiyun #define DRIVER_VERSION "0.10"
15*4882a593Smuzhiyun #define DRIVER_AUTHOR "Antonios Motakis <a.motakis@virtualopensystems.com>"
16*4882a593Smuzhiyun #define DRIVER_DESC "VFIO for AMBA devices - User Level meta-driver"
17*4882a593Smuzhiyun
18*4882a593Smuzhiyun /* probing devices from the AMBA bus */
19*4882a593Smuzhiyun
get_amba_resource(struct vfio_platform_device * vdev,int i)20*4882a593Smuzhiyun static struct resource *get_amba_resource(struct vfio_platform_device *vdev,
21*4882a593Smuzhiyun int i)
22*4882a593Smuzhiyun {
23*4882a593Smuzhiyun struct amba_device *adev = (struct amba_device *) vdev->opaque;
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun if (i == 0)
26*4882a593Smuzhiyun return &adev->res;
27*4882a593Smuzhiyun
28*4882a593Smuzhiyun return NULL;
29*4882a593Smuzhiyun }
30*4882a593Smuzhiyun
get_amba_irq(struct vfio_platform_device * vdev,int i)31*4882a593Smuzhiyun static int get_amba_irq(struct vfio_platform_device *vdev, int i)
32*4882a593Smuzhiyun {
33*4882a593Smuzhiyun struct amba_device *adev = (struct amba_device *) vdev->opaque;
34*4882a593Smuzhiyun int ret = 0;
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun if (i < AMBA_NR_IRQS)
37*4882a593Smuzhiyun ret = adev->irq[i];
38*4882a593Smuzhiyun
39*4882a593Smuzhiyun /* zero is an unset IRQ for AMBA devices */
40*4882a593Smuzhiyun return ret ? ret : -ENXIO;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun
vfio_amba_probe(struct amba_device * adev,const struct amba_id * id)43*4882a593Smuzhiyun static int vfio_amba_probe(struct amba_device *adev, const struct amba_id *id)
44*4882a593Smuzhiyun {
45*4882a593Smuzhiyun struct vfio_platform_device *vdev;
46*4882a593Smuzhiyun int ret;
47*4882a593Smuzhiyun
48*4882a593Smuzhiyun vdev = kzalloc(sizeof(*vdev), GFP_KERNEL);
49*4882a593Smuzhiyun if (!vdev)
50*4882a593Smuzhiyun return -ENOMEM;
51*4882a593Smuzhiyun
52*4882a593Smuzhiyun vdev->name = kasprintf(GFP_KERNEL, "vfio-amba-%08x", adev->periphid);
53*4882a593Smuzhiyun if (!vdev->name) {
54*4882a593Smuzhiyun kfree(vdev);
55*4882a593Smuzhiyun return -ENOMEM;
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun vdev->opaque = (void *) adev;
59*4882a593Smuzhiyun vdev->flags = VFIO_DEVICE_FLAGS_AMBA;
60*4882a593Smuzhiyun vdev->get_resource = get_amba_resource;
61*4882a593Smuzhiyun vdev->get_irq = get_amba_irq;
62*4882a593Smuzhiyun vdev->parent_module = THIS_MODULE;
63*4882a593Smuzhiyun vdev->reset_required = false;
64*4882a593Smuzhiyun
65*4882a593Smuzhiyun ret = vfio_platform_probe_common(vdev, &adev->dev);
66*4882a593Smuzhiyun if (ret) {
67*4882a593Smuzhiyun kfree(vdev->name);
68*4882a593Smuzhiyun kfree(vdev);
69*4882a593Smuzhiyun }
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun return ret;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun
vfio_amba_remove(struct amba_device * adev)74*4882a593Smuzhiyun static void vfio_amba_remove(struct amba_device *adev)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun struct vfio_platform_device *vdev =
77*4882a593Smuzhiyun vfio_platform_remove_common(&adev->dev);
78*4882a593Smuzhiyun
79*4882a593Smuzhiyun kfree(vdev->name);
80*4882a593Smuzhiyun kfree(vdev);
81*4882a593Smuzhiyun }
82*4882a593Smuzhiyun
83*4882a593Smuzhiyun static const struct amba_id pl330_ids[] = {
84*4882a593Smuzhiyun { 0, 0 },
85*4882a593Smuzhiyun };
86*4882a593Smuzhiyun
87*4882a593Smuzhiyun MODULE_DEVICE_TABLE(amba, pl330_ids);
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun static struct amba_driver vfio_amba_driver = {
90*4882a593Smuzhiyun .probe = vfio_amba_probe,
91*4882a593Smuzhiyun .remove = vfio_amba_remove,
92*4882a593Smuzhiyun .id_table = pl330_ids,
93*4882a593Smuzhiyun .drv = {
94*4882a593Smuzhiyun .name = "vfio-amba",
95*4882a593Smuzhiyun .owner = THIS_MODULE,
96*4882a593Smuzhiyun },
97*4882a593Smuzhiyun };
98*4882a593Smuzhiyun
99*4882a593Smuzhiyun module_amba_driver(vfio_amba_driver);
100*4882a593Smuzhiyun
101*4882a593Smuzhiyun MODULE_VERSION(DRIVER_VERSION);
102*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
103*4882a593Smuzhiyun MODULE_AUTHOR(DRIVER_AUTHOR);
104*4882a593Smuzhiyun MODULE_DESCRIPTION(DRIVER_DESC);
105