[PATCH 5/6] OMAP4: System control module device support

[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]

 



The device file adds the device support for OMAP4 system control module.

Signed-off-by: Keerthy <j-keerthy@xxxxxx>
Cc: tony@xxxxxxxxxxx
---
 arch/arm/mach-omap2/Makefile     |    1 +
 arch/arm/mach-omap2/scm_device.c |  125 ++++++++++++++++++++++++++++++++++++++
 arch/arm/plat-omap/Kconfig       |   12 ++++
 3 files changed, 138 insertions(+), 0 deletions(-)
 create mode 100644 arch/arm/mach-omap2/scm_device.c

diff --git a/arch/arm/mach-omap2/Makefile b/arch/arm/mach-omap2/Makefile
index e6f8d36..3332693 100644
--- a/arch/arm/mach-omap2/Makefile
+++ b/arch/arm/mach-omap2/Makefile
@@ -17,6 +17,7 @@ obj-$(CONFIG_ARCH_OMAP3) += $(omap-2-3-common) $(hwmod-common)
 obj-$(CONFIG_ARCH_OMAP4) += prm44xx.o $(hwmod-common)
 
 obj-$(CONFIG_OMAP_MCBSP) += mcbsp.o
+obj-$(CONFIG_OMAP_SCM_DEV)          += scm_device.o
 
 obj-$(CONFIG_TWL4030_CORE) += omap_twl.o
 
diff --git a/arch/arm/mach-omap2/scm_device.c b/arch/arm/mach-omap2/scm_device.c
new file mode 100644
index 0000000..d942f28
--- /dev/null
+++ b/arch/arm/mach-omap2/scm_device.c
@@ -0,0 +1,125 @@
+/*
+ * OMAP4460+ SCM device file
+ *
+ * Copyright (C) 2011 Texas Instruments Incorporated - http://www.ti.com/
+ * Author: J Keerthy <j-keerthy@xxxxxx>
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU General Public License
+ * version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful, but
+ * WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
+ * General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
+ * 02110-1301 USA
+ *
+ */
+
+#include <linux/delay.h>
+#include <linux/slab.h>
+#include <linux/io.h>
+#include <linux/mutex.h>
+#include <linux/idr.h>
+#include <plat/omap_device.h>
+#include "pm.h"
+#include <plat/scm.h>
+
+static struct omap_device_pm_latency scm_latency[] = {
+	{
+		.deactivate_func = NULL,
+		.activate_func =  NULL,
+		.flags = OMAP_DEVICE_LATENCY_AUTO_ADJUST,
+	}
+};
+
+static DEFINE_IDR(scm_device_idr);
+
+static int scm_dev_init(struct omap_hwmod *oh, void *user)
+{
+	struct	omap4460plus_scm_pdata		*scm_pdata;
+	struct	omap_device			*od;
+	struct	omap4460plus_scm_dev_attr	*scm_dev_attr;
+	struct	omap_temp_sensor_registers	*reg_ptr;
+	const	char				*name_ptr;
+	int					ret = 0;
+	int					num, i;
+
+	scm_pdata =
+	    kzalloc(sizeof(*scm_pdata), GFP_KERNEL);
+	if (!scm_pdata) {
+		dev_err(&oh->od->pdev.dev,
+			"Unable to allocate memory for scm pdata\n");
+		return -ENOMEM;
+	}
+
+	ret = idr_pre_get(&scm_device_idr, GFP_KERNEL);
+	if (ret < 0)
+		goto fail_id;
+	ret = idr_get_new(&scm_device_idr, scm_pdata, &num);
+	if (ret < 0)
+		goto fail_id;
+	scm_dev_attr = oh->dev_attr;
+	scm_pdata->cnt = scm_dev_attr->cnt;
+
+	if (scm_dev_attr->cnt > 0) {
+		scm_pdata->name = kzalloc(sizeof(name_ptr) *
+						scm_dev_attr->cnt, GFP_KERNEL);
+		if (!scm_pdata->name) {
+			dev_err(&oh->od->pdev.dev,
+				"Unable to allocate memory for scm name\n");
+			ret = -ENOMEM;
+			goto fail_id;
+		}
+
+		scm_pdata->registers = kzalloc(sizeof(reg_ptr) *
+						scm_dev_attr->cnt, GFP_KERNEL);
+		if (!scm_pdata->name) {
+			dev_err(&oh->od->pdev.dev,
+				"Unable to allocate mem for scm registers\n");
+			ret = -ENOMEM;
+			kfree(scm_pdata->name);
+			goto fail_id;
+		}
+
+		for (i = 0; i < scm_dev_attr->cnt; i++) {
+			scm_pdata->registers[i] = scm_dev_attr->list[i];
+			scm_pdata->name[i] = scm_dev_attr->name[i];
+		}
+	} else {
+		dev_warn(&oh->od->pdev.dev, "Invalid device count\n");
+		ret = -EINVAL;
+		goto fail_id;
+	}
+
+	od = omap_device_build("omap4460plus_scm", num,
+		oh, scm_pdata, sizeof(*scm_pdata),
+		scm_latency,
+		ARRAY_SIZE(scm_latency), 0);
+
+	if (IS_ERR(od)) {
+		dev_warn(&oh->od->pdev.dev,
+			"Could not build omap_device for %s\n", oh->name);
+		ret = PTR_ERR(od);
+	}
+
+fail_id:
+	kfree(scm_pdata);
+
+	return ret;
+}
+
+int __init omap4460plus_devinit_scm(void)
+{
+	if (!cpu_is_omap446x())
+		return 0;
+
+	return omap_hwmod_for_each_by_class("ctrl_module",
+			scm_dev_init, NULL);
+}
+
+arch_initcall(omap4460plus_devinit_scm);
diff --git a/arch/arm/plat-omap/Kconfig b/arch/arm/plat-omap/Kconfig
index bb8f4a6..f1f572b 100644
--- a/arch/arm/plat-omap/Kconfig
+++ b/arch/arm/plat-omap/Kconfig
@@ -116,6 +116,18 @@ config OMAP_MCBSP
 	  Say Y here if you want support for the OMAP Multichannel
 	  Buffered Serial Port.
 
+config OMAP_SCM_DEV
+	bool "OMAP4 System control module Support"
+	depends on ARCH_OMAP
+	default n
+	help
+	  Say Y here if you want support for the system control
+	  module on OMAP4.
+
+	  This provides the basic support of system control module
+	  subsystem. SCM also includes instance/instances of on die
+	  temperature sensor.
+
 config OMAP_MBOX_FWK
 	tristate "Mailbox framework support"
 	depends on ARCH_OMAP
-- 
1.7.0.4

--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at  http://vger.kernel.org/majordomo-info.html


[Index of Archives]     [Linux Arm (vger)]     [ARM Kernel]     [ARM MSM]     [Linux Tegra]     [Linux WPAN Networking]     [Linux Wireless Networking]     [Maemo Users]     [Linux USB Devel]     [Video for Linux]     [Linux Audio Users]     [Yosemite Trails]     [Linux Kernel]     [Linux SCSI]

  Powered by Linux