Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / arch / arm / mach-omap2 / opp.c

diff --git a/kernel/arch/arm/mach-omap2/opp.c b/kernel/arch/arm/mach-omap2/opp.c
new file mode 100644 (file)
index 0000000..a358a07
--- /dev/null
+++ b/kernel/arch/arm/mach-omap2/opp.c
@@ -0,0 +1,104 @@
+/*
+ * OMAP SoC specific OPP wrapper function
+ *
+ * Copyright (C) 2009-2010 Texas Instruments Incorporated - http://www.ti.com/
+ *     Nishanth Menon
+ *     Kevin Hilman
+ * Copyright (C) 2010 Nokia Corporation.
+ *      Eduardo Valentin
+ *
+ * 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 "as is" WITHOUT ANY WARRANTY of any
+ * kind, whether express or implied; without even the implied warranty
+ * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+#include <linux/module.h>
+#include <linux/of.h>
+#include <linux/pm_opp.h>
+#include <linux/cpu.h>
+
+#include "omap_device.h"
+
+#include "omap_opp_data.h"
+
+/* Temp variable to allow multiple calls */
+static u8 __initdata omap_table_init;
+
+/**
+ * omap_init_opp_table() - Initialize opp table as per the CPU type
+ * @opp_def:           opp default list for this silicon
+ * @opp_def_size:      number of opp entries for this silicon
+ *
+ * Register the initial OPP table with the OPP library based on the CPU
+ * type. This is meant to be used only by SoC specific registration.
+ */
+int __init omap_init_opp_table(struct omap_opp_def *opp_def,
+               u32 opp_def_size)
+{
+       int i, r;
+
+       if (of_have_populated_dt())
+               return -EINVAL;
+
+       if (!opp_def || !opp_def_size) {
+               pr_err("%s: invalid params!\n", __func__);
+               return -EINVAL;
+       }
+
+       /*
+        * Initialize only if not already initialized even if the previous
+        * call failed, because, no reason we'd succeed again.
+        */
+       if (omap_table_init)
+               return -EEXIST;
+       omap_table_init = 1;
+
+       /* Lets now register with OPP library */
+       for (i = 0; i < opp_def_size; i++, opp_def++) {
+               struct omap_hwmod *oh;
+               struct device *dev;
+
+               if (!opp_def->hwmod_name) {
+                       pr_err("%s: NULL name of omap_hwmod, failing [%d].\n",
+                               __func__, i);
+                       return -EINVAL;
+               }
+
+               if (!strncmp(opp_def->hwmod_name, "mpu", 3)) {
+                       /* 
+                        * All current OMAPs share voltage rail and
+                        * clock source, so CPU0 is used to represent
+                        * the MPU-SS.
+                        */
+                       dev = get_cpu_device(0);
+               } else {
+                       oh = omap_hwmod_lookup(opp_def->hwmod_name);
+                       if (!oh || !oh->od) {
+                               pr_debug("%s: no hwmod or odev for %s, [%d] cannot add OPPs.\n",
+                                        __func__, opp_def->hwmod_name, i);
+                               continue;
+                       }
+                       dev = &oh->od->pdev->dev;
+               }
+
+               r = dev_pm_opp_add(dev, opp_def->freq, opp_def->u_volt);
+               if (r) {
+                       dev_err(dev, "%s: add OPP %ld failed for %s [%d] result=%d\n",
+                               __func__, opp_def->freq,
+                               opp_def->hwmod_name, i, r);
+               } else {
+                       if (!opp_def->default_available)
+                               r = dev_pm_opp_disable(dev, opp_def->freq);
+                       if (r)
+                               dev_err(dev, "%s: disable %ld failed for %s [%d] result=%d\n",
+                                       __func__, opp_def->freq,
+                                       opp_def->hwmod_name, i, r);
+               }
+       }
+
+       return 0;
+}