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