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
22#include <plat/omap_device.h>
23
24#include "omap_opp_data.h"
25
26/* Temp variable to allow multiple calls */
27static u8 __initdata omap_table_init;
28
29/**
30 * omap_init_opp_table() - Initialize opp table as per the CPU type
31 * @opp_def:		opp default list for this silicon
32 * @opp_def_size:	number of opp entries for this silicon
33 *
34 * Register the initial OPP table with the OPP library based on the CPU
35 * type. This is meant to be used only by SoC specific registration.
36 */
37int __init omap_init_opp_table(struct omap_opp_def *opp_def,
38		u32 opp_def_size)
39{
40	int i, r;
41
42	if (!opp_def || !opp_def_size) {
43		pr_err("%s: invalid params!\n", __func__);
44		return -EINVAL;
45	}
46
47	/*
48	 * Initialize only if not already initialized even if the previous
49	 * call failed, because, no reason we'd succeed again.
50	 */
51	if (omap_table_init)
52		return -EEXIST;
53	omap_table_init = 1;
54
55	/* Lets now register with OPP library */
56	for (i = 0; i < opp_def_size; i++, opp_def++) {
57		struct omap_hwmod *oh;
58		struct device *dev;
59
60		if (!opp_def->hwmod_name) {
61			pr_err("%s: NULL name of omap_hwmod, failing [%d].\n",
62				__func__, i);
63			return -EINVAL;
64		}
65		oh = omap_hwmod_lookup(opp_def->hwmod_name);
66		if (!oh || !oh->od) {
67			pr_debug("%s: no hwmod or odev for %s, [%d] "
68				"cannot add OPPs.\n", __func__,
69				opp_def->hwmod_name, i);
70			continue;
71		}
72		dev = &oh->od->pdev->dev;
73
74		r = opp_add(dev, opp_def->freq, opp_def->u_volt);
75		if (r) {
76			dev_err(dev, "%s: add OPP %ld failed for %s [%d] "
77				"result=%d\n",
78			       __func__, opp_def->freq,
79			       opp_def->hwmod_name, i, r);
80		} else {
81			if (!opp_def->default_available)
82				r = opp_disable(dev, opp_def->freq);
83			if (r)
84				dev_err(dev, "%s: disable %ld failed for %s "
85					"[%d] result=%d\n",
86					__func__, opp_def->freq,
87					opp_def->hwmod_name, i, r);
88		}
89	}
90
91	return 0;
92}