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
|
/*
* Copyright (C) ST-Ericsson SA 2011
*
* License Terms: GNU General Public License v2
*/
#include <linux/kernel.h>
#include <linux/cpufreq.h>
#include <mach/prcmu.h>
#include "cpufreq.h"
static struct cpufreq_frequency_table freq_table[] = {
[0] = {
.index = 0,
.frequency = 200000,
},
[1] = {
.index = 1,
.frequency = 300000,
},
[2] = {
.index = 2,
.frequency = 600000,
},
[3] = {
/* Used for MAX_OPP, if available */
.index = 3,
.frequency = CPUFREQ_TABLE_END,
},
[4] = {
.index = 4,
.frequency = CPUFREQ_TABLE_END,
},
};
static enum arm_opp idx2opp[] = {
ARM_EXTCLK,
ARM_50_OPP,
ARM_100_OPP,
ARM_MAX_OPP
};
/*
* Below is a temporary workaround for wlan performance issues
*/
#include <linux/kernel_stat.h>
#include <linux/workqueue.h>
#include <linux/cpu.h>
#include <mach/irqs.h>
#define WLAN_PROBE_DELAY 3000 /* 3 seconds */
#define WLAN_LIMIT (3000/3) /* If we have more than 1000 irqs per second */
static struct delayed_work work_wlan_workaround;
bool wlan_mode_on;
static void wlan_load(struct work_struct *work)
{
int cpu;
unsigned int num_irqs = 0;
static unsigned int old_num_irqs = UINT_MAX;
for_each_online_cpu(cpu)
num_irqs += kstat_irqs_cpu(IRQ_DB8500_SDMMC1, cpu);
if ((num_irqs > old_num_irqs) &&
(num_irqs - old_num_irqs) > WLAN_LIMIT)
wlan_mode_on = true;
else
wlan_mode_on = false;
old_num_irqs = num_irqs;
schedule_delayed_work_on(0,
&work_wlan_workaround,
msecs_to_jiffies(WLAN_PROBE_DELAY));
}
static int __init u8500_cpufreq_register(void)
{
int i = 0;
BUILD_BUG_ON(ARRAY_SIZE(idx2opp) + 1 != ARRAY_SIZE(freq_table));
if (cpu_is_u8500v2() && !prcmu_is_u8400()) {
freq_table[1].frequency = 400000;
freq_table[2].frequency = 800000;
if (prcmu_has_arm_maxopp())
freq_table[3].frequency = 1000000;
}
INIT_DELAYED_WORK_DEFERRABLE(&work_wlan_workaround,
wlan_load);
schedule_delayed_work_on(0,
&work_wlan_workaround,
msecs_to_jiffies(WLAN_PROBE_DELAY));
pr_info("u8500-cpufreq : Available frequencies:\n");
while (freq_table[i].frequency != CPUFREQ_TABLE_END)
pr_info(" %d Mhz\n", freq_table[i++].frequency/1000);
return ux500_cpufreq_register(freq_table, idx2opp);
}
device_initcall(u8500_cpufreq_register);
|