Platform device added

1 files changed, 25 insertions, 0 deletions

diff --git a/kernel-devel/module-basics/vain_plat/vain_plat_2.c b/kernel-devel/module-basics/vain_plat/vain_plat_2.c
new file mode 100644
index 0000000..9c5a980
--- /dev/null
+++ b/kernel-devel/module-basics/vain_plat/vain_plat_2.c
@@ -0,0 +1,25 @@
+static int __devinit vain_plat_probe(struct platform_device *pdev)
+{
+	struct vain_plat_info *info;
+	struct resource *res, *mem;
+	int err;
+
+	info = kzalloc(sizeof(struct vain_plat_info), GFP_KERNEL);
+	if (unlikely(!info)) {
+		dev_err(&pdev->dev, "Could not allocate memory\n");
+		err = -ENOMEM;
+		goto out;
+	}
+
+	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
+	if (unlikely(!res)) {
+		dev_err(&pdev->dev, "I/O address already in use\n");
+		err = -ENOENT;
+		goto err_free;
+	}
+
+	mem = request_mem_region(res->start, resource_size(res), pdev->name);
+	if (!mem) {
+		err = -EBUSY;
+		goto err_free;
+	}