blob: bd41d59a7cab08ecbca342a665f5f944aa67b6bc [file] [log] [blame]
Nishanth Menonfd1478c2010-12-09 09:13:46 -06001/*
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>
Kevin Hilman24d7b402012-09-06 14:03:08 -070021#include <linux/cpu.h>
Nishanth Menonfd1478c2010-12-09 09:13:46 -060022
Tony Lindgren25c7d492012-10-02 17:25:48 -070023#include "omap_device.h"
Nishanth Menonfd1478c2010-12-09 09:13:46 -060024
25#include "omap_opp_data.h"
26
27/* Temp variable to allow multiple calls */
28static 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 */
38int __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 */
Nishanth Menonb1105472012-05-18 12:26:19 -050057 for (i = 0; i < opp_def_size; i++, opp_def++) {
Nishanth Menonfd1478c2010-12-09 09:13:46 -060058 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 }
Kevin Hilman24d7b402012-09-06 14:03:08 -070066
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;
Nishanth Menonfd1478c2010-12-09 09:13:46 -060082 }
Nishanth Menonfd1478c2010-12-09 09:13:46 -060083
84 r = opp_add(dev, opp_def->freq, opp_def->u_volt);
85 if (r) {
Paul Walmsley7852ec02012-07-26 00:54:26 -060086 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);
Nishanth Menonfd1478c2010-12-09 09:13:46 -060089 } else {
90 if (!opp_def->default_available)
91 r = opp_disable(dev, opp_def->freq);
92 if (r)
Paul Walmsley7852ec02012-07-26 00:54:26 -060093 dev_err(dev, "%s: disable %ld failed for %s [%d] result=%d\n",
Nishanth Menonfd1478c2010-12-09 09:13:46 -060094 __func__, opp_def->freq,
95 opp_def->hwmod_name, i, r);
96 }
Nishanth Menonfd1478c2010-12-09 09:13:46 -060097 }
98
99 return 0;
100}