2 * (C) 2004-2009 Dominik Brodowski <linux@dominikbrodowski.de>
4 * Licensed under the terms of the GNU GPL License version 2.
20 #include "helpers/helpers.h"
22 #define NORM_FREQ_LEN 32
24 static struct option set_opts[] = {
25 {"min", required_argument, NULL, 'd'},
26 {"max", required_argument, NULL, 'u'},
27 {"governor", required_argument, NULL, 'g'},
28 {"freq", required_argument, NULL, 'f'},
29 {"related", no_argument, NULL, 'r'},
33 static void print_error(void)
35 printf(_("Error setting new values. Common errors:\n"
36 "- Do you have proper administration rights? (super-user?)\n"
37 "- Is the governor you requested available and modprobed?\n"
38 "- Trying to set an invalid policy?\n"
39 "- Trying to set a specific frequency, but userspace governor is not available,\n"
40 " for example because of hardware which cannot be set to a specific frequency\n"
41 " or because the userspace governor isn't loaded?\n"));
49 const struct freq_units def_units[] = {
51 {"khz", 0}, /* default */
58 static void print_unknown_arg(void)
60 printf(_("invalid or unknown argument\n"));
63 static unsigned long string_to_frequency(const char *str)
65 char normalized[NORM_FREQ_LEN];
66 const struct freq_units *unit;
70 int power = 0, match_count = 0, i, cp, pad;
75 for (scan = str; isdigit(*scan) || *scan == '.'; scan++) {
76 if (*scan == '.' && match_count == 0)
78 else if (*scan == '.' && match_count == 1)
84 for (unit = def_units; unit->str_unit; unit++) {
86 scan[i] && tolower(scan[i]) == unit->str_unit[i];
92 power = unit->power_of_ten;
98 /* count the number of digits to be copied */
99 for (cp = 0; isdigit(str[cp]); cp++)
102 if (str[cp] == '.') {
103 while (power > -1 && isdigit(str[cp+1]))
106 if (power >= -1) /* not enough => pad */
108 else /* to much => strip */
109 pad = 0, cp += power + 1;
111 if (cp <= 0 || cp + pad > NORM_FREQ_LEN - 1)
115 for (i = 0; i < cp; i++, str++) {
118 normalized[i] = *str;
121 for (; i < cp + pad; i++)
124 /* round up, down ? */
125 match_count = (normalized[i-1] >= '5');
126 /* and drop the decimal part */
127 normalized[i-1] = 0; /* cp > 0 && pad >= 0 ==> i > 0 */
129 /* final conversion (and applying rounding) */
131 freq = strtoul(normalized, &end, 10);
135 if (match_count && freq != ULONG_MAX)
141 static int do_new_policy(unsigned int cpu, struct cpufreq_policy *new_pol)
143 struct cpufreq_policy *cur_pol = cpufreq_get_policy(cpu);
147 printf(_("wrong, unknown or unhandled CPU?\n"));
152 new_pol->min = cur_pol->min;
155 new_pol->max = cur_pol->max;
157 if (!new_pol->governor)
158 new_pol->governor = cur_pol->governor;
160 ret = cpufreq_set_policy(cpu, new_pol);
162 cpufreq_put_policy(cur_pol);
168 static int do_one_cpu(unsigned int cpu, struct cpufreq_policy *new_pol,
169 unsigned long freq, unsigned int pc)
173 return cpufreq_set_frequency(cpu, freq);
176 /* if only one value of a policy is to be changed, we can
180 return cpufreq_modify_policy_min(cpu, new_pol->min);
181 else if (new_pol->max)
182 return cpufreq_modify_policy_max(cpu, new_pol->max);
183 else if (new_pol->governor)
184 return cpufreq_modify_policy_governor(cpu,
189 return do_new_policy(cpu, new_pol);
193 int cmd_freq_set(int argc, char **argv)
196 extern int optind, opterr, optopt;
197 int ret = 0, cont = 1;
198 int double_parm = 0, related = 0, policychange = 0;
199 unsigned long freq = 0;
203 struct cpufreq_policy new_pol = {
209 /* parameter parsing */
211 ret = getopt_long(argc, argv, "d:u:g:f:r", set_opts, NULL);
228 new_pol.min = string_to_frequency(optarg);
229 if (new_pol.min == 0) {
238 new_pol.max = string_to_frequency(optarg);
239 if (new_pol.max == 0) {
247 freq = string_to_frequency(optarg);
254 if (new_pol.governor)
257 if ((strlen(optarg) < 3) || (strlen(optarg) > 18)) {
261 if ((sscanf(optarg, "%19s", gov)) != 1) {
265 new_pol.governor = gov;
270 /* parameter checking */
272 printf("the same parameter was passed more than once\n");
276 if (freq && policychange) {
277 printf(_("the -f/--freq parameter cannot be combined with -d/--min, -u/--max or\n"
278 "-g/--governor parameters\n"));
282 if (!freq && !policychange) {
283 printf(_("At least one parameter out of -f/--freq, -d/--min, -u/--max, and\n"
284 "-g/--governor must be passed\n"));
288 /* Default is: set all CPUs */
289 if (bitmask_isallclear(cpus_chosen))
290 bitmask_setall(cpus_chosen);
292 /* Also set frequency settings for related CPUs if -r is passed */
294 for (cpu = bitmask_first(cpus_chosen);
295 cpu <= bitmask_last(cpus_chosen); cpu++) {
296 struct cpufreq_affected_cpus *cpus;
298 if (!bitmask_isbitset(cpus_chosen, cpu) ||
299 cpupower_is_cpu_online(cpu) != 1)
302 cpus = cpufreq_get_related_cpus(cpu);
306 bitmask_setbit(cpus_chosen, cpus->cpu);
309 /* Set the last cpu in related cpus list */
310 bitmask_setbit(cpus_chosen, cpus->cpu);
311 cpufreq_put_related_cpus(cpus);
317 for (cpu = bitmask_first(cpus_chosen);
318 cpu <= bitmask_last(cpus_chosen); cpu++) {
320 if (!bitmask_isbitset(cpus_chosen, cpu) ||
321 cpupower_is_cpu_online(cpu) != 1)
324 printf(_("Setting cpu: %d\n"), cpu);
325 ret = do_one_cpu(cpu, &new_pol, freq, policychange);