xref: /OK3568_Linux_fs/kernel/drivers/vfio/platform/vfio_platform.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
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/platform_device.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 platform devices - User Level meta-driver"
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun static bool reset_required = true;
19*4882a593Smuzhiyun module_param(reset_required, bool, 0444);
20*4882a593Smuzhiyun MODULE_PARM_DESC(reset_required, "override reset requirement (default: 1)");
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun /* probing devices from the linux platform bus */
23*4882a593Smuzhiyun 
get_platform_resource(struct vfio_platform_device * vdev,int num)24*4882a593Smuzhiyun static struct resource *get_platform_resource(struct vfio_platform_device *vdev,
25*4882a593Smuzhiyun 					      int num)
26*4882a593Smuzhiyun {
27*4882a593Smuzhiyun 	struct platform_device *dev = (struct platform_device *) vdev->opaque;
28*4882a593Smuzhiyun 	int i;
29*4882a593Smuzhiyun 
30*4882a593Smuzhiyun 	for (i = 0; i < dev->num_resources; i++) {
31*4882a593Smuzhiyun 		struct resource *r = &dev->resource[i];
32*4882a593Smuzhiyun 
33*4882a593Smuzhiyun 		if (resource_type(r) & (IORESOURCE_MEM|IORESOURCE_IO)) {
34*4882a593Smuzhiyun 			if (!num)
35*4882a593Smuzhiyun 				return r;
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun 			num--;
38*4882a593Smuzhiyun 		}
39*4882a593Smuzhiyun 	}
40*4882a593Smuzhiyun 	return NULL;
41*4882a593Smuzhiyun }
42*4882a593Smuzhiyun 
get_platform_irq(struct vfio_platform_device * vdev,int i)43*4882a593Smuzhiyun static int get_platform_irq(struct vfio_platform_device *vdev, int i)
44*4882a593Smuzhiyun {
45*4882a593Smuzhiyun 	struct platform_device *pdev = (struct platform_device *) vdev->opaque;
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun 	return platform_get_irq_optional(pdev, i);
48*4882a593Smuzhiyun }
49*4882a593Smuzhiyun 
vfio_platform_probe(struct platform_device * pdev)50*4882a593Smuzhiyun static int vfio_platform_probe(struct platform_device *pdev)
51*4882a593Smuzhiyun {
52*4882a593Smuzhiyun 	struct vfio_platform_device *vdev;
53*4882a593Smuzhiyun 	int ret;
54*4882a593Smuzhiyun 
55*4882a593Smuzhiyun 	vdev = kzalloc(sizeof(*vdev), GFP_KERNEL);
56*4882a593Smuzhiyun 	if (!vdev)
57*4882a593Smuzhiyun 		return -ENOMEM;
58*4882a593Smuzhiyun 
59*4882a593Smuzhiyun 	vdev->opaque = (void *) pdev;
60*4882a593Smuzhiyun 	vdev->name = pdev->name;
61*4882a593Smuzhiyun 	vdev->flags = VFIO_DEVICE_FLAGS_PLATFORM;
62*4882a593Smuzhiyun 	vdev->get_resource = get_platform_resource;
63*4882a593Smuzhiyun 	vdev->get_irq = get_platform_irq;
64*4882a593Smuzhiyun 	vdev->parent_module = THIS_MODULE;
65*4882a593Smuzhiyun 	vdev->reset_required = reset_required;
66*4882a593Smuzhiyun 
67*4882a593Smuzhiyun 	ret = vfio_platform_probe_common(vdev, &pdev->dev);
68*4882a593Smuzhiyun 	if (ret)
69*4882a593Smuzhiyun 		kfree(vdev);
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 	return ret;
72*4882a593Smuzhiyun }
73*4882a593Smuzhiyun 
vfio_platform_remove(struct platform_device * pdev)74*4882a593Smuzhiyun static int vfio_platform_remove(struct platform_device *pdev)
75*4882a593Smuzhiyun {
76*4882a593Smuzhiyun 	struct vfio_platform_device *vdev;
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	vdev = vfio_platform_remove_common(&pdev->dev);
79*4882a593Smuzhiyun 	if (vdev) {
80*4882a593Smuzhiyun 		kfree(vdev);
81*4882a593Smuzhiyun 		return 0;
82*4882a593Smuzhiyun 	}
83*4882a593Smuzhiyun 
84*4882a593Smuzhiyun 	return -EINVAL;
85*4882a593Smuzhiyun }
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun static struct platform_driver vfio_platform_driver = {
88*4882a593Smuzhiyun 	.probe		= vfio_platform_probe,
89*4882a593Smuzhiyun 	.remove		= vfio_platform_remove,
90*4882a593Smuzhiyun 	.driver	= {
91*4882a593Smuzhiyun 		.name	= "vfio-platform",
92*4882a593Smuzhiyun 	},
93*4882a593Smuzhiyun };
94*4882a593Smuzhiyun 
95*4882a593Smuzhiyun module_platform_driver(vfio_platform_driver);
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun MODULE_VERSION(DRIVER_VERSION);
98*4882a593Smuzhiyun MODULE_LICENSE("GPL v2");
99*4882a593Smuzhiyun MODULE_AUTHOR(DRIVER_AUTHOR);
100*4882a593Smuzhiyun MODULE_DESCRIPTION(DRIVER_DESC);
101