1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
|
/*
* 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;
/**
* opp_def_list_enable_opp() - enable opp by hwmod_name and frequency
* @list: opp default list for this silicon
* @size: number of opp entries for this silicon
* @hwmod_name: hwmod for which the provided opp_freq exists
* @opp_freq: frequency for which the state should be updated
* @state: new state to set for opp availability
*/
int __init opp_def_list_enable_opp(struct omap_opp_def *list,
unsigned int size,
const char *hwmod_name,
unsigned long opp_freq, bool state)
{
int i;
for (i = 0; i < size; i++) {
struct omap_opp_def *entry = &list[i];
if (entry->hwmod_name == hwmod_name &&
entry->freq == opp_freq) {
entry->default_available = state;
return 0;
}
}
WARN(1, "Unable to find opp for %s, frequency %ld\n",
hwmod_name, opp_freq);
return -EINVAL;
}
/**
* opp_def_list_update_voltage_opp() - update opp u_volt entry by hwmod_name
* and frequency
* @list: opp default list for this silicon
* @size: number of opp entries for this silicon
* @hwmod_name: hwmod for which the provided opp_freq exists
* @opp_freq: frequency for which the voltage should be updated
* @u_volt: new voltage value for the provided opp
*/
int __init opp_def_list_update_opp_voltage(struct omap_opp_def *list,
unsigned int size,
const char *hwmod_name,
unsigned long opp_freq,
unsigned long u_volt)
{
int i;
for (i = 0; i < size; i++) {
struct omap_opp_def *entry = &list[i];
if (entry->hwmod_name == hwmod_name &&
entry->freq == opp_freq) {
entry->u_volt = u_volt;
return 0;
}
}
WARN(1, "Unable to find opp for %s, frequency %ld\n",
hwmod_name, opp_freq);
return -EINVAL;
}
static int __init of_omap_set_opp_exceptions(struct omap_opp_def *list,
unsigned int size,
const char *hwmod_name,
struct device_node *np,
const char *of_prop_name,
unsigned long freq,
bool state)
{
const __be32 *val;
const struct property *prop;
int nr;
prop = of_find_property(np, of_prop_name, NULL);
if (!prop)
return -ENODEV;
if (!prop->value)
return -ENODATA;
/*
* Each OPP is a a single frequency value in kHz.
*/
nr = prop->length / sizeof(u32);
val = prop->value;
while (nr) {
unsigned long exception_freq = be32_to_cpup(val++) * 1000;
if (exception_freq == freq) {
if (opp_def_list_enable_opp(list, size, hwmod_name,
freq, state))
return -EINVAL;
else
return 0;
}
nr--;
}
return 0;
}
static int __init of_omap_check_opp_exceptions(struct device *dev,
struct omap_opp_def *list,
unsigned int size,
const char *hwmod_name,
unsigned long freq)
{
struct device_node *np;
np = of_node_get(dev->of_node);
if (!np)
return -ENOENT;
of_omap_set_opp_exceptions(list, size, hwmod_name, np,
"ti,opp-enable-exception",
freq, true);
of_omap_set_opp_exceptions(list, size, hwmod_name, np,
"ti,opp-disable-exception",
freq, false);
of_node_put(np);
return 0;
}
/**
* 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 (!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;
}
of_omap_check_opp_exceptions(dev, opp_def, opp_def_size,
opp_def->hwmod_name,
opp_def->freq);
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;
}
|
