Merge tag 'dt-for-linus-2' of git://git.kernel.org/pub/scm/linux/kernel/git/arm/arm-soc
[linux-3.10.git] / arch / arm / mach-omap2 / opp.c
1 /*
2  * OMAP SoC specific OPP wrapper function
3  *
4  * Copyright (C) 2009-2010 Texas Instruments Incorporated - http://www.ti.com/
5  *      Nishanth Menon
6  *      Kevin Hilman
7  * Copyright (C) 2010 Nokia Corporation.
8  *      Eduardo Valentin
9  *
10  * This program is free software; you can redistribute it and/or modify
11  * it under the terms of the GNU General Public License version 2 as
12  * published by the Free Software Foundation.
13  *
14  * This program is distributed "as is" WITHOUT ANY WARRANTY of any
15  * kind, whether express or implied; without even the implied warranty
16  * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  */
19 #include <linux/module.h>
20 #include <linux/opp.h>
21 #include <linux/cpu.h>
22
23 #include "omap_device.h"
24
25 #include "omap_opp_data.h"
26
27 /* Temp variable to allow multiple calls */
28 static u8 __initdata omap_table_init;
29
30 /**
31  * omap_init_opp_table() - Initialize opp table as per the CPU type
32  * @opp_def:            opp default list for this silicon
33  * @opp_def_size:       number of opp entries for this silicon
34  *
35  * Register the initial OPP table with the OPP library based on the CPU
36  * type. This is meant to be used only by SoC specific registration.
37  */
38 int __init omap_init_opp_table(struct omap_opp_def *opp_def,
39                 u32 opp_def_size)
40 {
41         int i, r;
42
43         if (!opp_def || !opp_def_size) {
44                 pr_err("%s: invalid params!\n", __func__);
45                 return -EINVAL;
46         }
47
48         /*
49          * Initialize only if not already initialized even if the previous
50          * call failed, because, no reason we'd succeed again.
51          */
52         if (omap_table_init)
53                 return -EEXIST;
54         omap_table_init = 1;
55
56         /* Lets now register with OPP library */
57         for (i = 0; i < opp_def_size; i++, opp_def++) {
58                 struct omap_hwmod *oh;
59                 struct device *dev;
60
61                 if (!opp_def->hwmod_name) {
62                         pr_err("%s: NULL name of omap_hwmod, failing [%d].\n",
63                                 __func__, i);
64                         return -EINVAL;
65                 }
66
67                 if (!strncmp(opp_def->hwmod_name, "mpu", 3)) {
68                         /* 
69                          * All current OMAPs share voltage rail and
70                          * clock source, so CPU0 is used to represent
71                          * the MPU-SS.
72                          */
73                         dev = get_cpu_device(0);
74                 } else {
75                         oh = omap_hwmod_lookup(opp_def->hwmod_name);
76                         if (!oh || !oh->od) {
77                                 pr_debug("%s: no hwmod or odev for %s, [%d] cannot add OPPs.\n",
78                                          __func__, opp_def->hwmod_name, i);
79                                 continue;
80                         }
81                         dev = &oh->od->pdev->dev;
82                 }
83
84                 r = opp_add(dev, opp_def->freq, opp_def->u_volt);
85                 if (r) {
86                         dev_err(dev, "%s: add OPP %ld failed for %s [%d] result=%d\n",
87                                 __func__, opp_def->freq,
88                                 opp_def->hwmod_name, i, r);
89                 } else {
90                         if (!opp_def->default_available)
91                                 r = opp_disable(dev, opp_def->freq);
92                         if (r)
93                                 dev_err(dev, "%s: disable %ld failed for %s [%d] result=%d\n",
94                                         __func__, opp_def->freq,
95                                         opp_def->hwmod_name, i, r);
96                 }
97         }
98
99         return 0;
100 }