blob: f9ff22665ab235c2448dad6fdf2861dcea55fbcc [file] [log] [blame]
Matt Wagantalld1af38e2011-08-06 01:38:02 -07001/*
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07002 * MSM architecture clock driver
3 *
4 * Copyright (C) 2007 Google, Inc.
Pankaj Kumarc9136b32012-01-02 18:46:13 +05305 * Copyright (c) 2007-2012, Code Aurora Forum. All rights reserved.
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -07006 * Author: San Mehat <san@android.com>
7 *
8 * This software is licensed under the terms of the GNU General Public
9 * License version 2, as published by the Free Software Foundation, and
10 * may be copied, distributed, and modified under those terms.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 */
18
19#include <linux/version.h>
20#include <linux/kernel.h>
Matt Wagantallbf430eb2012-03-22 11:45:49 -070021#include <linux/module.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070022#include <linux/init.h>
23#include <linux/errno.h>
24#include <linux/string.h>
25#include <linux/delay.h>
26#include <linux/clk.h>
27#include <linux/cpufreq.h>
28#include <linux/mutex.h>
29#include <linux/io.h>
30#include <linux/sort.h>
Matt Wagantallbf430eb2012-03-22 11:45:49 -070031#include <linux/platform_device.h>
32
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070033#include <mach/board.h>
34#include <mach/msm_iomap.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070035#include <mach/socinfo.h>
Taniya Dasc43e6872012-03-21 16:41:14 +053036#include <asm/mach-types.h>
37#include <asm/cpu.h>
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070038
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070039#include "smd_private.h"
40#include "acpuclock.h"
41
42#define A11S_CLK_CNTL_ADDR (MSM_CSR_BASE + 0x100)
43#define A11S_CLK_SEL_ADDR (MSM_CSR_BASE + 0x104)
44#define A11S_VDD_SVS_PLEVEL_ADDR (MSM_CSR_BASE + 0x124)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070045
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070046
Matt Wagantall6d9ebee2011-08-26 12:15:24 -070047#define POWER_COLLAPSE_KHZ 19200
48
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070049/* Max CPU frequency allowed by hardware while in standby waiting for an irq. */
50#define MAX_WAIT_FOR_IRQ_KHZ 128000
51
Pankaj Kumar3912c982011-12-07 16:59:03 +053052/**
53 * enum - For acpuclock PLL IDs
54 */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070055enum {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070056 ACPU_PLL_0 = 0,
57 ACPU_PLL_1,
58 ACPU_PLL_2,
59 ACPU_PLL_3,
60 ACPU_PLL_4,
Pankaj Kumar0249bed2012-03-08 15:20:54 +053061 ACPU_PLL_TCXO,
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070062 ACPU_PLL_END,
63};
64
Pankaj Kumar3912c982011-12-07 16:59:03 +053065struct acpu_clk_src {
66 struct clk *clk;
67 const char *name;
68};
69
70static struct acpu_clk_src pll_clk[ACPU_PLL_END] = {
71 [ACPU_PLL_0] = { .name = "pll0_clk" },
72 [ACPU_PLL_1] = { .name = "pll1_clk" },
73 [ACPU_PLL_2] = { .name = "pll2_clk" },
74 [ACPU_PLL_4] = { .name = "pll4_clk" },
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070075};
76
77struct clock_state {
78 struct clkctl_acpu_speed *current_speed;
79 struct mutex lock;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070080 uint32_t max_speed_delta_khz;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070081 struct clk *ebi1_clk;
82};
83
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070084struct clkctl_acpu_speed {
85 unsigned int use_for_scaling;
86 unsigned int a11clk_khz;
87 int pll;
88 unsigned int a11clk_src_sel;
89 unsigned int a11clk_src_div;
90 unsigned int ahbclk_khz;
91 unsigned int ahbclk_div;
92 int vdd;
93 unsigned int axiclk_khz;
Taniya Dasc43e6872012-03-21 16:41:14 +053094 unsigned long lpj; /* loops_per_jiffy */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -070095 /* Pointers in acpu_freq_tbl[] for max up/down steppings. */
96 struct clkctl_acpu_speed *down[ACPU_PLL_END];
97 struct clkctl_acpu_speed *up[ACPU_PLL_END];
98};
99
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700100static struct clock_state drv_state = { 0 };
101static struct clkctl_acpu_speed *acpu_freq_tbl;
102
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700103/*
104 * ACPU freq tables used for different PLLs frequency combinations. The
105 * correct table is selected during init.
106 *
107 * Table stepping up/down entries are calculated during boot to choose the
108 * largest frequency jump that's less than max_speed_delta_khz on each PLL.
109 */
110
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530111/* 7627 with GSM capable modem */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700112static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_pll4_0[] = {
113 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 19200, 0, 0, 30720 },
114 { 0, 120000, ACPU_PLL_0, 4, 7, 60000, 1, 3, 61440 },
115 { 1, 122880, ACPU_PLL_1, 1, 1, 61440, 1, 3, 61440 },
116 { 0, 200000, ACPU_PLL_2, 2, 5, 66667, 2, 4, 61440 },
117 { 1, 245760, ACPU_PLL_1, 1, 0, 122880, 1, 4, 61440 },
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530118 { 1, 320000, ACPU_PLL_0, 4, 2, 160000, 1, 5, 160000 },
119 { 0, 400000, ACPU_PLL_2, 2, 2, 133333, 2, 5, 160000 },
120 { 1, 480000, ACPU_PLL_0, 4, 1, 160000, 2, 6, 160000 },
121 { 1, 600000, ACPU_PLL_2, 2, 1, 200000, 2, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530122 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700123};
124
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530125/* 7627 with CDMA capable modem */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700126static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_1200_pll4_0[] = {
127 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 19200, 0, 0, 24576 },
128 { 1, 98304, ACPU_PLL_1, 1, 1, 98304, 0, 3, 49152 },
129 { 0, 120000, ACPU_PLL_0, 4, 7, 60000, 1, 3, 49152 },
130 { 1, 196608, ACPU_PLL_1, 1, 0, 65536, 2, 4, 98304 },
131 { 0, 200000, ACPU_PLL_2, 2, 5, 66667, 2, 4, 98304 },
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530132 { 1, 320000, ACPU_PLL_0, 4, 2, 160000, 1, 5, 160000 },
133 { 0, 400000, ACPU_PLL_2, 2, 2, 133333, 2, 5, 160000 },
134 { 1, 480000, ACPU_PLL_0, 4, 1, 160000, 2, 6, 160000 },
135 { 1, 600000, ACPU_PLL_2, 2, 1, 200000, 2, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530136 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700137};
138
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530139/* 7627 with GSM capable modem - PLL2 @ 800 */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700140static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_800_pll4_0[] = {
141 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 19200, 0, 0, 30720 },
142 { 0, 120000, ACPU_PLL_0, 4, 7, 60000, 1, 3, 61440 },
143 { 1, 122880, ACPU_PLL_1, 1, 1, 61440, 1, 3, 61440 },
144 { 0, 200000, ACPU_PLL_2, 2, 3, 66667, 2, 4, 61440 },
145 { 1, 245760, ACPU_PLL_1, 1, 0, 122880, 1, 4, 61440 },
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530146 { 1, 320000, ACPU_PLL_0, 4, 2, 160000, 1, 5, 160000 },
147 { 0, 400000, ACPU_PLL_2, 2, 1, 133333, 2, 5, 160000 },
148 { 1, 480000, ACPU_PLL_0, 4, 1, 160000, 2, 6, 160000 },
149 { 1, 800000, ACPU_PLL_2, 2, 0, 200000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530150 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700151};
152
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530153/* 7627 with CDMA capable modem - PLL2 @ 800 */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700154static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_800_pll4_0[] = {
155 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 19200, 0, 0, 24576 },
156 { 1, 98304, ACPU_PLL_1, 1, 1, 98304, 0, 3, 49152 },
157 { 0, 120000, ACPU_PLL_0, 4, 7, 60000, 1, 3, 49152 },
158 { 1, 196608, ACPU_PLL_1, 1, 0, 65536, 2, 4, 98304 },
159 { 0, 200000, ACPU_PLL_2, 2, 3, 66667, 2, 4, 98304 },
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530160 { 1, 320000, ACPU_PLL_0, 4, 2, 160000, 1, 5, 160000 },
161 { 0, 400000, ACPU_PLL_2, 2, 1, 133333, 2, 5, 160000 },
162 { 1, 480000, ACPU_PLL_0, 4, 1, 160000, 2, 6, 160000 },
163 { 1, 800000, ACPU_PLL_2, 2, 0, 200000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530164 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700165};
166
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530167/* 7627a PLL2 @ 1200MHz with GSM capable modem */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700168static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_pll4_800[] = {
Trilok Soni7d6c8652011-07-14 15:35:07 +0530169 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
170 { 0, 61440, ACPU_PLL_1, 1, 3, 7680, 3, 1, 61440 },
171 { 1, 122880, ACPU_PLL_1, 1, 1, 15360, 3, 2, 61440 },
172 { 1, 245760, ACPU_PLL_1, 1, 0, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530173 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni7d6c8652011-07-14 15:35:07 +0530174 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
175 { 0, 400000, ACPU_PLL_4, 6, 1, 50000, 3, 4, 122880 },
176 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530177 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni7d6c8652011-07-14 15:35:07 +0530178 { 1, 800000, ACPU_PLL_4, 6, 0, 100000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530179 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700180};
181
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530182/* 7627a PLL2 @ 1200MHz with CDMA capable modem */
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700183static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_1200_pll4_800[] = {
Trilok Soni7d6c8652011-07-14 15:35:07 +0530184 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
185 { 0, 65536, ACPU_PLL_1, 1, 3, 8192, 3, 1, 49152 },
186 { 1, 98304, ACPU_PLL_1, 1, 1, 12288, 3, 2, 49152 },
187 { 1, 196608, ACPU_PLL_1, 1, 0, 24576, 3, 3, 98304 },
Trilok Soniabb750b2011-07-13 16:47:18 +0530188 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 120000 },
189 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 120000 },
190 { 0, 400000, ACPU_PLL_4, 6, 1, 50000, 3, 4, 120000 },
191 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 120000 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530192 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni7d6c8652011-07-14 15:35:07 +0530193 { 1, 800000, ACPU_PLL_4, 6, 0, 100000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530194 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700195};
196
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530197/* 7627aa PLL4 @ 1008MHz with GSM capable modem */
Trilok Sonif597e242011-06-06 12:37:16 +0530198static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_pll4_1008[] = {
199 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
200 { 0, 61440, ACPU_PLL_1, 1, 3, 7680, 3, 1, 61440 },
201 { 1, 122880, ACPU_PLL_1, 1, 1, 15360, 3, 2, 61440 },
202 { 1, 245760, ACPU_PLL_1, 1, 0, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530203 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Sonif597e242011-06-06 12:37:16 +0530204 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
205 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530206 { 0, 504000, ACPU_PLL_4, 6, 1, 63000, 3, 6, 160000 },
207 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Sonif597e242011-06-06 12:37:16 +0530208 { 1, 1008000, ACPU_PLL_4, 6, 0, 126000, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530209 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Sonif597e242011-06-06 12:37:16 +0530210};
211
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530212/* 7627aa PLL4 @ 1008MHz with CDMA capable modem */
Trilok Sonid7b05e52011-08-17 18:09:08 +0530213static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_1200_pll4_1008[] = {
214 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
215 { 0, 65536, ACPU_PLL_1, 1, 3, 8192, 3, 1, 49152 },
216 { 1, 98304, ACPU_PLL_1, 1, 1, 12288, 3, 2, 49152 },
217 { 1, 196608, ACPU_PLL_1, 1, 0, 24576, 3, 3, 98304 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530218 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Sonid7b05e52011-08-17 18:09:08 +0530219 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
220 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530221 { 0, 504000, ACPU_PLL_4, 6, 1, 63000, 3, 6, 160000 },
222 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Sonid7b05e52011-08-17 18:09:08 +0530223 { 1, 1008000, ACPU_PLL_4, 6, 0, 126000, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530224 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Sonid7b05e52011-08-17 18:09:08 +0530225};
226
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530227/* 8625 PLL4 @ 1209MHz with GSM capable modem */
228static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_pll4_1209[] = {
229 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
230 { 0, 61440, ACPU_PLL_1, 1, 3, 7680, 3, 1, 61440 },
231 { 1, 122880, ACPU_PLL_1, 1, 1, 15360, 3, 2, 61440 },
232 { 1, 245760, ACPU_PLL_1, 1, 0, 30720, 3, 3, 61440 },
233 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
234 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530235 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
236 { 0, 604800, ACPU_PLL_4, 6, 1, 75600, 3, 6, 160000 },
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530237 { 1, 1209600, ACPU_PLL_4, 6, 0, 151200, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530238 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530239};
240
241/* 8625 PLL4 @ 1209MHz with CDMA capable modem */
242static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_1200_pll4_1209[] = {
243 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
244 { 0, 65536, ACPU_PLL_1, 1, 3, 8192, 3, 1, 49152 },
245 { 1, 98304, ACPU_PLL_1, 1, 1, 12288, 3, 2, 49152 },
246 { 1, 196608, ACPU_PLL_1, 1, 0, 24576, 3, 3, 98304 },
247 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
248 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530249 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
250 { 0, 604800, ACPU_PLL_4, 6, 1, 75600, 3, 6, 160000 },
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530251 { 1, 1209600, ACPU_PLL_4, 6, 0, 151200, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530252 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530253};
254
Trilok Soni48631722012-05-17 20:56:42 +0530255/* 8625 PLL4 @ 1152MHz with GSM capable modem */
256static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_pll4_1152[] = {
257 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
258 { 0, 61440, ACPU_PLL_1, 1, 3, 7680, 3, 1, 61440 },
259 { 1, 122880, ACPU_PLL_1, 1, 1, 15360, 3, 2, 61440 },
260 { 1, 245760, ACPU_PLL_1, 1, 0, 30720, 3, 3, 61440 },
261 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
262 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
263 { 0, 576000, ACPU_PLL_4, 6, 1, 72000, 3, 6, 160000 },
264 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
265 { 1, 1152000, ACPU_PLL_4, 6, 0, 144000, 3, 7, 200000},
266 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
267};
268
269/* 8625 PLL4 @ 1115MHz with CDMA capable modem */
270static struct clkctl_acpu_speed pll0_960_pll1_196_pll2_1200_pll4_1152[] = {
271 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
272 { 0, 65536, ACPU_PLL_1, 1, 3, 8192, 3, 1, 49152 },
273 { 1, 98304, ACPU_PLL_1, 1, 1, 12288, 3, 2, 49152 },
274 { 1, 196608, ACPU_PLL_1, 1, 0, 24576, 3, 3, 98304 },
275 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
276 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
277 { 0, 576000, ACPU_PLL_4, 6, 1, 72000, 3, 6, 160000 },
278 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
279 { 1, 1152000, ACPU_PLL_4, 6, 0, 144000, 3, 7, 200000},
280 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
281};
282
283
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530284/* 7625a PLL2 @ 1200MHz with GSM capable modem */
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530285static struct clkctl_acpu_speed pll0_960_pll1_245_pll2_1200_25a[] = {
Trilok Soni54d35c42011-07-14 17:47:50 +0530286 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
287 { 0, 61440, ACPU_PLL_1, 1, 3, 7680, 3, 1, 61440 },
288 { 1, 122880, ACPU_PLL_1, 1, 1, 15360, 3, 2, 61440 },
289 { 1, 245760, ACPU_PLL_1, 1, 0, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530290 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni54d35c42011-07-14 17:47:50 +0530291 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530292 { 0, 400000, ACPU_PLL_2, 2, 2, 50000, 3, 4, 122880 },
Trilok Soni54d35c42011-07-14 17:47:50 +0530293 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
294 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530295 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni54d35c42011-07-14 17:47:50 +0530296};
297
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530298/* 7627a PLL2 @ 1200MHz with GSM capable modem */
Trilok Soni9bb022c2011-10-31 18:25:19 +0530299static struct clkctl_acpu_speed pll0_960_pll1_737_pll2_1200_pll4_800[] = {
300 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
301 { 0, 61440, ACPU_PLL_1, 1, 11, 7680, 3, 1, 61440 },
302 { 1, 122880, ACPU_PLL_1, 1, 5, 15360, 3, 2, 61440 },
303 { 1, 245760, ACPU_PLL_1, 1, 2, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530304 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530305 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
306 { 0, 400000, ACPU_PLL_4, 6, 1, 50000, 3, 4, 122880 },
307 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530308 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530309 { 1, 800000, ACPU_PLL_4, 6, 0, 100000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530310 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni9bb022c2011-10-31 18:25:19 +0530311};
312
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530313/* 7627a PLL2 @ 1200MHz with CDMA capable modem */
Trilok Soni9bb022c2011-10-31 18:25:19 +0530314static struct clkctl_acpu_speed pll0_960_pll1_589_pll2_1200_pll4_800[] = {
315 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
316 { 0, 65536, ACPU_PLL_1, 1, 8, 8192, 3, 1, 49152 },
317 { 1, 98304, ACPU_PLL_1, 1, 5, 12288, 3, 2, 49152 },
318 { 1, 196608, ACPU_PLL_1, 1, 2, 24576, 3, 3, 98304 },
319 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 120000 },
320 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 120000 },
321 { 0, 400000, ACPU_PLL_4, 6, 1, 50000, 3, 4, 120000 },
322 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 120000 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530323 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530324 { 1, 800000, ACPU_PLL_4, 6, 0, 100000, 3, 7, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530325 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni9bb022c2011-10-31 18:25:19 +0530326};
327
Pankaj Kumar714c5cc2012-01-05 13:14:38 +0530328/* 7627aa PLL4 @ 1008MHz with GSM capable modem */
Trilok Soni9bb022c2011-10-31 18:25:19 +0530329static struct clkctl_acpu_speed pll0_960_pll1_737_pll2_1200_pll4_1008[] = {
330 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
331 { 0, 61440, ACPU_PLL_1, 1, 11, 7680, 3, 1, 61440 },
332 { 1, 122880, ACPU_PLL_1, 1, 5, 15360, 3, 2, 61440 },
333 { 1, 245760, ACPU_PLL_1, 1, 2, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530334 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530335 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
336 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530337 { 0, 504000, ACPU_PLL_4, 6, 1, 63000, 3, 6, 160000 },
338 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530339 { 1, 1008000, ACPU_PLL_4, 6, 0, 126000, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530340 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni9bb022c2011-10-31 18:25:19 +0530341};
342
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530343/* 7627aa PLL4 @ 1008MHz with CDMA capable modem */
Trilok Soni9bb022c2011-10-31 18:25:19 +0530344static struct clkctl_acpu_speed pll0_960_pll1_589_pll2_1200_pll4_1008[] = {
345 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 24576 },
346 { 0, 65536, ACPU_PLL_1, 1, 8, 8192, 3, 1, 49152 },
347 { 1, 98304, ACPU_PLL_1, 1, 5, 12288, 3, 2, 49152 },
348 { 1, 196608, ACPU_PLL_1, 1, 2, 24576, 3, 3, 98304 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530349 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530350 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
351 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
Pankaj Kumar501e14e2012-04-10 14:51:41 +0530352 { 0, 504000, ACPU_PLL_4, 6, 1, 63000, 3, 6, 160000 },
353 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 160000 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530354 { 1, 1008000, ACPU_PLL_4, 6, 0, 126000, 3, 7, 200000},
Taniya Dasc43e6872012-03-21 16:41:14 +0530355 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni9bb022c2011-10-31 18:25:19 +0530356};
357
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530358/* 7625a PLL2 @ 1200MHz with GSM capable modem */
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530359static struct clkctl_acpu_speed pll0_960_pll1_737_pll2_1200_25a[] = {
Trilok Soni9bb022c2011-10-31 18:25:19 +0530360 { 0, 19200, ACPU_PLL_TCXO, 0, 0, 2400, 3, 0, 30720 },
361 { 0, 61440, ACPU_PLL_1, 1, 11, 7680, 3, 1, 61440 },
362 { 1, 122880, ACPU_PLL_1, 1, 5, 15360, 3, 2, 61440 },
363 { 1, 245760, ACPU_PLL_1, 1, 2, 30720, 3, 3, 61440 },
Pankaj Kumar2764fe72012-02-23 00:53:28 +0530364 { 0, 300000, ACPU_PLL_2, 2, 3, 37500, 3, 4, 122880 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530365 { 1, 320000, ACPU_PLL_0, 4, 2, 40000, 3, 4, 122880 },
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530366 { 0, 400000, ACPU_PLL_2, 2, 2, 50000, 3, 4, 122880 },
Trilok Soni9bb022c2011-10-31 18:25:19 +0530367 { 1, 480000, ACPU_PLL_0, 4, 1, 60000, 3, 5, 122880 },
368 { 1, 600000, ACPU_PLL_2, 2, 1, 75000, 3, 6, 200000 },
Taniya Dasc43e6872012-03-21 16:41:14 +0530369 { 0, 0, 0, 0, 0, 0, 0, 0, 0, 0, {0, 0, 0, 0}, {0, 0, 0, 0} }
Trilok Soni9bb022c2011-10-31 18:25:19 +0530370};
371
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700372#define PLL_CONFIG(m0, m1, m2, m4) { \
Pankaj Kumar3912c982011-12-07 16:59:03 +0530373 m0, m1, m2, m4, \
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700374 pll0_##m0##_pll1_##m1##_pll2_##m2##_pll4_##m4 \
375}
376
377struct pll_freq_tbl_map {
Pankaj Kumar3912c982011-12-07 16:59:03 +0530378 unsigned int pll0_rate;
379 unsigned int pll1_rate;
380 unsigned int pll2_rate;
381 unsigned int pll4_rate;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700382 struct clkctl_acpu_speed *tbl;
383};
384
385static struct pll_freq_tbl_map acpu_freq_tbl_list[] = {
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700386 PLL_CONFIG(960, 196, 1200, 0),
387 PLL_CONFIG(960, 245, 1200, 0),
388 PLL_CONFIG(960, 196, 800, 0),
389 PLL_CONFIG(960, 245, 800, 0),
390 PLL_CONFIG(960, 245, 1200, 800),
391 PLL_CONFIG(960, 196, 1200, 800),
Trilok Sonif597e242011-06-06 12:37:16 +0530392 PLL_CONFIG(960, 245, 1200, 1008),
Trilok Sonid7b05e52011-08-17 18:09:08 +0530393 PLL_CONFIG(960, 196, 1200, 1008),
Trilok Soni9bb022c2011-10-31 18:25:19 +0530394 PLL_CONFIG(960, 737, 1200, 800),
395 PLL_CONFIG(960, 589, 1200, 800),
396 PLL_CONFIG(960, 737, 1200, 1008),
397 PLL_CONFIG(960, 589, 1200, 1008),
Pankaj Kumar50c705c2012-01-10 12:02:07 +0530398 PLL_CONFIG(960, 245, 1200, 1209),
399 PLL_CONFIG(960, 196, 1200, 1209),
Trilok Soni48631722012-05-17 20:56:42 +0530400 PLL_CONFIG(960, 245, 1200, 1152),
401 PLL_CONFIG(960, 196, 1200, 1152),
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700402 { 0, 0, 0, 0, 0 }
403};
404
405#ifdef CONFIG_CPU_FREQ_MSM
Pankaj Kumar873bc7a2011-12-21 17:25:44 +0530406static struct cpufreq_frequency_table freq_table[NR_CPUS][20];
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700407
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700408static void __devinit cpufreq_table_init(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700409{
Pankaj Kumar873bc7a2011-12-21 17:25:44 +0530410 int cpu;
411 for_each_possible_cpu(cpu) {
412 unsigned int i, freq_cnt = 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700413
Pankaj Kumar873bc7a2011-12-21 17:25:44 +0530414 /* Construct the freq_table table from acpu_freq_tbl since
415 * the freq_table values need to match frequencies specified
416 * in acpu_freq_tbl and acpu_freq_tbl needs to be fixed up
417 * during init.
418 */
419 for (i = 0; acpu_freq_tbl[i].a11clk_khz != 0
420 && freq_cnt < ARRAY_SIZE(*freq_table)-1; i++) {
421 if (acpu_freq_tbl[i].use_for_scaling) {
422 freq_table[cpu][freq_cnt].index = freq_cnt;
423 freq_table[cpu][freq_cnt].frequency
424 = acpu_freq_tbl[i].a11clk_khz;
425 freq_cnt++;
426 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700427 }
Pankaj Kumar873bc7a2011-12-21 17:25:44 +0530428
429 /* freq_table not big enough to store all usable freqs. */
430 BUG_ON(acpu_freq_tbl[i].a11clk_khz != 0);
431
432 freq_table[cpu][freq_cnt].index = freq_cnt;
433 freq_table[cpu][freq_cnt].frequency = CPUFREQ_TABLE_END;
434 /* Register table with CPUFreq. */
435 cpufreq_frequency_table_get_attr(freq_table[cpu], cpu);
436 pr_info("CPU%d: %d scaling frequencies supported.\n",
437 cpu, freq_cnt);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700438 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700439}
440#endif
441
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700442static int acpuclk_set_vdd_level(int vdd)
443{
444 uint32_t current_vdd;
445
Pankaj Kumar9406a3b2011-12-23 18:07:15 +0530446 /*
447 * NOTE: v1.0 of 7x27a/7x25a chip doesn't have working
448 * VDD switching support.
449 */
450 if ((cpu_is_msm7x27a() || cpu_is_msm7x25a()) &&
451 (SOCINFO_VERSION_MINOR(socinfo_get_version()) < 1))
452 return 0;
453
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700454 current_vdd = readl_relaxed(A11S_VDD_SVS_PLEVEL_ADDR) & 0x07;
455
456 pr_debug("Switching VDD from %u mV -> %d mV\n",
457 current_vdd, vdd);
458
459 writel_relaxed((1 << 7) | (vdd << 3), A11S_VDD_SVS_PLEVEL_ADDR);
460 mb();
Matt Wagantallec57f062011-08-16 23:54:46 -0700461 udelay(62);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700462 if ((readl_relaxed(A11S_VDD_SVS_PLEVEL_ADDR) & 0x7) != vdd) {
463 pr_err("VDD set failed\n");
464 return -EIO;
465 }
466
467 pr_debug("VDD switched\n");
468
469 return 0;
470}
471
472/* Set proper dividers for the given clock speed. */
473static void acpuclk_set_div(const struct clkctl_acpu_speed *hunt_s)
474{
475 uint32_t reg_clkctl, reg_clksel, clk_div, src_sel;
476
477 reg_clksel = readl_relaxed(A11S_CLK_SEL_ADDR);
478
479 /* AHB_CLK_DIV */
480 clk_div = (reg_clksel >> 1) & 0x03;
481 /* CLK_SEL_SRC1NO */
482 src_sel = reg_clksel & 1;
483
484 /*
485 * If the new clock divider is higher than the previous, then
486 * program the divider before switching the clock
487 */
488 if (hunt_s->ahbclk_div > clk_div) {
489 reg_clksel &= ~(0x3 << 1);
490 reg_clksel |= (hunt_s->ahbclk_div << 1);
491 writel_relaxed(reg_clksel, A11S_CLK_SEL_ADDR);
492 }
493
494 /* Program clock source and divider */
495 reg_clkctl = readl_relaxed(A11S_CLK_CNTL_ADDR);
496 reg_clkctl &= ~(0xFF << (8 * src_sel));
497 reg_clkctl |= hunt_s->a11clk_src_sel << (4 + 8 * src_sel);
498 reg_clkctl |= hunt_s->a11clk_src_div << (0 + 8 * src_sel);
499 writel_relaxed(reg_clkctl, A11S_CLK_CNTL_ADDR);
500
501 /* Program clock source selection */
502 reg_clksel ^= 1;
503 writel_relaxed(reg_clksel, A11S_CLK_SEL_ADDR);
504
Pankaj Kumard66a9192012-04-11 19:35:38 +0530505 /* Wait for the clock switch to complete */
506 mb();
507 udelay(50);
508
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700509 /*
510 * If the new clock divider is lower than the previous, then
511 * program the divider after switching the clock
512 */
513 if (hunt_s->ahbclk_div < clk_div) {
514 reg_clksel &= ~(0x3 << 1);
515 reg_clksel |= (hunt_s->ahbclk_div << 1);
516 writel_relaxed(reg_clksel, A11S_CLK_SEL_ADDR);
517 }
518}
519
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530520static int acpuclk_7627_set_rate(int cpu, unsigned long rate,
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700521 enum setrate_reason reason)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700522{
523 uint32_t reg_clkctl;
524 struct clkctl_acpu_speed *cur_s, *tgt_s, *strt_s;
525 int res, rc = 0;
526 unsigned int plls_enabled = 0, pll;
527
528 if (reason == SETRATE_CPUFREQ)
529 mutex_lock(&drv_state.lock);
530
531 strt_s = cur_s = drv_state.current_speed;
532
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700533 WARN_ONCE(cur_s == NULL, "%s: not initialized\n", __func__);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700534 if (cur_s == NULL) {
535 rc = -ENOENT;
536 goto out;
537 }
538
539 if (rate == cur_s->a11clk_khz)
540 goto out;
541
542 for (tgt_s = acpu_freq_tbl; tgt_s->a11clk_khz != 0; tgt_s++) {
543 if (tgt_s->a11clk_khz == rate)
544 break;
545 }
546
547 if (tgt_s->a11clk_khz == 0) {
548 rc = -EINVAL;
549 goto out;
550 }
551
552 /* Choose the highest speed at or below 'rate' with same PLL. */
553 if (reason != SETRATE_CPUFREQ
554 && tgt_s->a11clk_khz < cur_s->a11clk_khz) {
555 while (tgt_s->pll != ACPU_PLL_TCXO && tgt_s->pll != cur_s->pll)
556 tgt_s--;
557 }
558
559 if (strt_s->pll != ACPU_PLL_TCXO)
560 plls_enabled |= 1 << strt_s->pll;
561
562 if (reason == SETRATE_CPUFREQ) {
563 if (strt_s->pll != tgt_s->pll && tgt_s->pll != ACPU_PLL_TCXO) {
Trilok Soni57c07782012-05-07 16:52:16 +0530564 rc = clk_enable(pll_clk[tgt_s->pll].clk);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700565 if (rc < 0) {
566 pr_err("PLL%d enable failed (%d)\n",
567 tgt_s->pll, rc);
568 goto out;
569 }
570 plls_enabled |= 1 << tgt_s->pll;
571 }
572 }
573 /* Need to do this when coming out of power collapse since some modem
574 * firmwares reset the VDD when the application processor enters power
575 * collapse. */
576 if (reason == SETRATE_CPUFREQ || reason == SETRATE_PC) {
577 /* Increase VDD if needed. */
578 if (tgt_s->vdd > cur_s->vdd) {
579 rc = acpuclk_set_vdd_level(tgt_s->vdd);
580 if (rc < 0) {
581 pr_err("Unable to switch ACPU vdd (%d)\n", rc);
582 goto out;
583 }
584 }
585 }
586
587 /* Set wait states for CPU inbetween frequency changes */
588 reg_clkctl = readl_relaxed(A11S_CLK_CNTL_ADDR);
589 reg_clkctl |= (100 << 16); /* set WT_ST_CNT */
590 writel_relaxed(reg_clkctl, A11S_CLK_CNTL_ADDR);
591
592 pr_debug("Switching from ACPU rate %u KHz -> %u KHz\n",
593 strt_s->a11clk_khz, tgt_s->a11clk_khz);
594
595 while (cur_s != tgt_s) {
596 /*
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530597 * Always jump to target freq if within max_speed_delta_khz,
598 * regardless of PLL. If differnece is greater, use the
599 * predefined steppings in the table.
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700600 */
601 int d = abs((int)(cur_s->a11clk_khz - tgt_s->a11clk_khz));
602 if (d > drv_state.max_speed_delta_khz) {
603
604 if (tgt_s->a11clk_khz > cur_s->a11clk_khz) {
605 /* Step up: jump to target PLL as early as
606 * possible so indexing using TCXO (up[-1])
607 * never occurs. */
608 if (likely(cur_s->up[tgt_s->pll]))
609 cur_s = cur_s->up[tgt_s->pll];
610 else
611 cur_s = cur_s->up[cur_s->pll];
612 } else {
613 /* Step down: stay on current PLL as long as
614 * possible so indexing using TCXO (down[-1])
615 * never occurs. */
616 if (likely(cur_s->down[cur_s->pll]))
617 cur_s = cur_s->down[cur_s->pll];
618 else
619 cur_s = cur_s->down[tgt_s->pll];
620 }
621
622 if (cur_s == NULL) { /* This should not happen. */
623 pr_err("No stepping frequencies found. "
624 "strt_s:%u tgt_s:%u\n",
625 strt_s->a11clk_khz, tgt_s->a11clk_khz);
626 rc = -EINVAL;
627 goto out;
628 }
629
630 } else {
631 cur_s = tgt_s;
632 }
633
634 pr_debug("STEP khz = %u, pll = %d\n",
635 cur_s->a11clk_khz, cur_s->pll);
636
637 if (cur_s->pll != ACPU_PLL_TCXO
638 && !(plls_enabled & (1 << cur_s->pll))) {
Trilok Soni57c07782012-05-07 16:52:16 +0530639 rc = clk_enable(pll_clk[cur_s->pll].clk);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700640 if (rc < 0) {
641 pr_err("PLL%d enable failed (%d)\n",
642 cur_s->pll, rc);
643 goto out;
644 }
645 plls_enabled |= 1 << cur_s->pll;
646 }
647
648 acpuclk_set_div(cur_s);
649 drv_state.current_speed = cur_s;
Taniya Dasc43e6872012-03-21 16:41:14 +0530650 /* Re-adjust lpj for the new clock speed. */
651#ifdef CONFIG_SMP
652 for_each_possible_cpu(cpu) {
653 per_cpu(cpu_data, cpu).loops_per_jiffy =
654 cur_s->lpj;
655 }
656#endif
657 /* Adjust the global one */
658 loops_per_jiffy = cur_s->lpj;
659
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700660 }
661
662 /* Nothing else to do for SWFI. */
663 if (reason == SETRATE_SWFI)
664 goto out;
665
666 /* Change the AXI bus frequency if we can. */
667 if (strt_s->axiclk_khz != tgt_s->axiclk_khz) {
668 res = clk_set_rate(drv_state.ebi1_clk,
669 tgt_s->axiclk_khz * 1000);
670 if (res < 0)
671 pr_warning("Setting AXI min rate failed (%d)\n", res);
672 }
673
674 /* Disable PLLs we are not using anymore. */
675 if (tgt_s->pll != ACPU_PLL_TCXO)
676 plls_enabled &= ~(1 << tgt_s->pll);
677 for (pll = ACPU_PLL_0; pll < ACPU_PLL_END; pll++)
Pankaj Kumar3912c982011-12-07 16:59:03 +0530678 if (plls_enabled & (1 << pll))
Trilok Soni57c07782012-05-07 16:52:16 +0530679 clk_disable(pll_clk[pll].clk);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700680
681 /* Nothing else to do for power collapse. */
682 if (reason == SETRATE_PC)
683 goto out;
684
685 /* Drop VDD level if we can. */
686 if (tgt_s->vdd < strt_s->vdd) {
687 res = acpuclk_set_vdd_level(tgt_s->vdd);
688 if (res < 0)
689 pr_warning("Unable to drop ACPU vdd (%d)\n", res);
690 }
691
692 pr_debug("ACPU speed change complete\n");
693out:
694 if (reason == SETRATE_CPUFREQ)
695 mutex_unlock(&drv_state.lock);
696 return rc;
697}
698
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700699static void __devinit acpuclk_hw_init(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700700{
701 struct clkctl_acpu_speed *speed;
Trilok Soni7d6c8652011-07-14 15:35:07 +0530702 uint32_t div, sel, reg_clksel;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700703 int res;
704
705 /*
Trilok Soni57c07782012-05-07 16:52:16 +0530706 * Prepare all the PLLs because we enable/disable them
707 * from atomic context and can't always ensure they're
708 * all prepared in non-atomic context. Same goes for
709 * ebi1_acpu_clk.
710 */
711 BUG_ON(clk_prepare(pll_clk[ACPU_PLL_0].clk));
712 BUG_ON(clk_prepare(pll_clk[ACPU_PLL_1].clk));
713 BUG_ON(clk_prepare(pll_clk[ACPU_PLL_2].clk));
714 BUG_ON(clk_prepare(pll_clk[ACPU_PLL_4].clk));
715 BUG_ON(clk_prepare(drv_state.ebi1_clk));
716
717 /*
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700718 * Determine the rate of ACPU clock
719 */
720
721 if (!(readl_relaxed(A11S_CLK_SEL_ADDR) & 0x01)) { /* CLK_SEL_SRC1N0 */
722 /* CLK_SRC0_SEL */
723 sel = (readl_relaxed(A11S_CLK_CNTL_ADDR) >> 12) & 0x7;
724 /* CLK_SRC0_DIV */
725 div = (readl_relaxed(A11S_CLK_CNTL_ADDR) >> 8) & 0x0f;
726 } else {
727 /* CLK_SRC1_SEL */
728 sel = (readl_relaxed(A11S_CLK_CNTL_ADDR) >> 4) & 0x07;
729 /* CLK_SRC1_DIV */
730 div = readl_relaxed(A11S_CLK_CNTL_ADDR) & 0x0f;
731 }
732
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700733 for (speed = acpu_freq_tbl; speed->a11clk_khz != 0; speed++) {
734 if (speed->a11clk_src_sel == sel
735 && (speed->a11clk_src_div == div))
736 break;
737 }
738 if (speed->a11clk_khz == 0) {
739 pr_err("Error - ACPU clock reports invalid speed\n");
740 return;
741 }
742
743 drv_state.current_speed = speed;
Pankaj Kumar3912c982011-12-07 16:59:03 +0530744 if (speed->pll != ACPU_PLL_TCXO) {
Trilok Soni57c07782012-05-07 16:52:16 +0530745 if (clk_enable(pll_clk[speed->pll].clk))
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700746 pr_warning("Failed to vote for boot PLL\n");
Pankaj Kumar3912c982011-12-07 16:59:03 +0530747 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700748
Trilok Soni7d6c8652011-07-14 15:35:07 +0530749 /* Fix div2 to 2 for 7x27/5a(aa) targets */
750 if (!cpu_is_msm7x27()) {
751 reg_clksel = readl_relaxed(A11S_CLK_SEL_ADDR);
752 reg_clksel &= ~(0x3 << 14);
753 reg_clksel |= (0x1 << 14);
754 writel_relaxed(reg_clksel, A11S_CLK_SEL_ADDR);
755 }
756
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700757 res = clk_set_rate(drv_state.ebi1_clk, speed->axiclk_khz * 1000);
758 if (res < 0)
759 pr_warning("Setting AXI min rate failed (%d)\n", res);
Trilok Soni57c07782012-05-07 16:52:16 +0530760 res = clk_enable(drv_state.ebi1_clk);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700761 if (res < 0)
762 pr_warning("Enabling AXI clock failed (%d)\n", res);
763
764 pr_info("ACPU running at %d KHz\n", speed->a11clk_khz);
765}
766
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530767static unsigned long acpuclk_7627_get_rate(int cpu)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700768{
769 WARN_ONCE(drv_state.current_speed == NULL,
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700770 "%s: not initialized\n", __func__);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700771 if (drv_state.current_speed)
772 return drv_state.current_speed->a11clk_khz;
773 else
774 return 0;
775}
776
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700777/*----------------------------------------------------------------------------
778 * Clock driver initialization
779 *---------------------------------------------------------------------------*/
Pankaj Kumar3912c982011-12-07 16:59:03 +0530780#define MHZ 1000000
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700781static void __devinit select_freq_plan(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700782{
Pankaj Kumar3912c982011-12-07 16:59:03 +0530783 unsigned long pll_mhz[ACPU_PLL_END];
784 struct pll_freq_tbl_map *t;
785 int i;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700786
Pankaj Kumar3912c982011-12-07 16:59:03 +0530787 /* Get PLL clocks */
788 for (i = 0; i < ACPU_PLL_END; i++) {
789 if (pll_clk[i].name) {
790 pll_clk[i].clk = clk_get_sys("acpu", pll_clk[i].name);
791 if (IS_ERR(pll_clk[i].clk)) {
792 pll_mhz[i] = 0;
793 continue;
794 }
795 /* Get PLL's Rate */
796 pll_mhz[i] = clk_get_rate(pll_clk[i].clk)/MHZ;
797 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700798 }
799
Pankaj Kumar3912c982011-12-07 16:59:03 +0530800 /*
801 * For the pll configuration used in acpuclock table e.g.
802 * pll0_960_pll1_245_pll2_1200" is same for 7627 and
803 * 7625a (as pll0,pll1,pll2) having same rates, but frequency
804 * table is different for both targets.
805 *
806 * Hence below for loop will not be able to select correct
807 * table based on PLL rates as rates are same. Hence we need
808 * to add this cpu check for selecting the correct acpuclock table.
809 */
Trilok Soni54d35c42011-07-14 17:47:50 +0530810 if (cpu_is_msm7x25a()) {
Pankaj Kumar3912c982011-12-07 16:59:03 +0530811 if (pll_mhz[ACPU_PLL_1] == 245) {
Trilok Soni54d35c42011-07-14 17:47:50 +0530812 acpu_freq_tbl =
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530813 pll0_960_pll1_245_pll2_1200_25a;
Pankaj Kumar3912c982011-12-07 16:59:03 +0530814 } else if (pll_mhz[ACPU_PLL_1] == 737) {
Trilok Soni9bb022c2011-10-31 18:25:19 +0530815 acpu_freq_tbl =
Pankaj Kumarc9136b32012-01-02 18:46:13 +0530816 pll0_960_pll1_737_pll2_1200_25a;
Trilok Soni54d35c42011-07-14 17:47:50 +0530817 }
818 } else {
819 /* Select the right table to use. */
Pankaj Kumar3912c982011-12-07 16:59:03 +0530820 for (t = acpu_freq_tbl_list; t->tbl != 0; t++) {
821 if (t->pll0_rate == pll_mhz[ACPU_PLL_0]
822 && t->pll1_rate == pll_mhz[ACPU_PLL_1]
823 && t->pll2_rate == pll_mhz[ACPU_PLL_2]
824 && t->pll4_rate == pll_mhz[ACPU_PLL_4]) {
825 acpu_freq_tbl = t->tbl;
Trilok Soni54d35c42011-07-14 17:47:50 +0530826 break;
827 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700828 }
829 }
830
831 if (acpu_freq_tbl == NULL) {
832 pr_crit("Unknown PLL configuration!\n");
833 BUG();
834 }
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700835}
836
837/*
838 * Hardware requires the CPU to be dropped to less than MAX_WAIT_FOR_IRQ_KHZ
839 * before entering a wait for irq low-power mode. Find a suitable rate.
840 */
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700841static unsigned long __devinit find_wait_for_irq_khz(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700842{
843 unsigned long found_khz = 0;
844 int i;
845
846 for (i = 0; acpu_freq_tbl[i].a11clk_khz &&
847 acpu_freq_tbl[i].a11clk_khz <= MAX_WAIT_FOR_IRQ_KHZ; i++)
848 found_khz = acpu_freq_tbl[i].a11clk_khz;
849
850 return found_khz;
851}
852
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700853static void __devinit lpj_init(void)
Taniya Dasc43e6872012-03-21 16:41:14 +0530854{
855 int i = 0, cpu;
856 const struct clkctl_acpu_speed *base_clk = drv_state.current_speed;
857 unsigned long loops;
858
859 for_each_possible_cpu(cpu) {
860#ifdef CONFIG_SMP
861 loops = per_cpu(cpu_data, cpu).loops_per_jiffy;
862#else
863 loops = loops_per_jiffy;
864#endif
865 for (i = 0; acpu_freq_tbl[i].a11clk_khz; i++) {
866 acpu_freq_tbl[i].lpj = cpufreq_scale(
867 loops,
868 base_clk->a11clk_khz,
869 acpu_freq_tbl[i].a11clk_khz);
870 }
871 }
872}
873
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700874static void __devinit precompute_stepping(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700875{
876 int i, step_idx;
877
878#define cur_freq acpu_freq_tbl[i].a11clk_khz
879#define step_freq acpu_freq_tbl[step_idx].a11clk_khz
880#define cur_pll acpu_freq_tbl[i].pll
881#define step_pll acpu_freq_tbl[step_idx].pll
882
883 for (i = 0; acpu_freq_tbl[i].a11clk_khz; i++) {
884
885 /* Calculate max "up" step for each destination PLL */
886 step_idx = i + 1;
887 while (step_freq && (step_freq - cur_freq)
888 <= drv_state.max_speed_delta_khz) {
889 acpu_freq_tbl[i].up[step_pll] =
890 &acpu_freq_tbl[step_idx];
891 step_idx++;
892 }
893 if (step_idx == (i + 1) && step_freq) {
894 pr_crit("Delta between freqs %u KHz and %u KHz is"
895 " too high!\n", cur_freq, step_freq);
896 BUG();
897 }
898
899 /* Calculate max "down" step for each destination PLL */
900 step_idx = i - 1;
901 while (step_idx >= 0 && (cur_freq - step_freq)
902 <= drv_state.max_speed_delta_khz) {
903 acpu_freq_tbl[i].down[step_pll] =
904 &acpu_freq_tbl[step_idx];
905 step_idx--;
906 }
907 if (step_idx == (i - 1) && i > 0) {
908 pr_crit("Delta between freqs %u KHz and %u KHz is"
909 " too high!\n", cur_freq, step_freq);
910 BUG();
911 }
912 }
913}
914
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700915static void __devinit print_acpu_freq_tbl(void)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700916{
917 struct clkctl_acpu_speed *t;
918 short down_idx[ACPU_PLL_END];
919 short up_idx[ACPU_PLL_END];
920 int i, j;
921
922#define FREQ_IDX(freq_ptr) (freq_ptr - acpu_freq_tbl)
923 pr_info("Id CPU-KHz PLL DIV AHB-KHz ADIV AXI-KHz "
924 "D0 D1 D2 D4 U0 U1 U2 U4\n");
925
926 t = &acpu_freq_tbl[0];
927 for (i = 0; t->a11clk_khz != 0; i++) {
928
929 for (j = 0; j < ACPU_PLL_END; j++) {
930 down_idx[j] = t->down[j] ? FREQ_IDX(t->down[j]) : -1;
931 up_idx[j] = t->up[j] ? FREQ_IDX(t->up[j]) : -1;
932 }
933
934 pr_info("%2d %7d %3d %3d %7d %4d %7d "
935 "%2d %2d %2d %2d %2d %2d %2d %2d\n",
936 i, t->a11clk_khz, t->pll, t->a11clk_src_div + 1,
937 t->ahbclk_khz, t->ahbclk_div + 1, t->axiclk_khz,
938 down_idx[0], down_idx[1], down_idx[2], down_idx[4],
939 up_idx[0], up_idx[1], up_idx[2], up_idx[4]);
940
941 t++;
942 }
943}
944
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700945
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530946static struct acpuclk_data acpuclk_7627_data = {
947 .set_rate = acpuclk_7627_set_rate,
948 .get_rate = acpuclk_7627_get_rate,
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700949 .power_collapse_khz = POWER_COLLAPSE_KHZ,
Matt Wagantallec57f062011-08-16 23:54:46 -0700950 .switch_time_us = 50,
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700951};
952
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700953static int __devinit acpuclk_7627_probe(struct platform_device *pdev)
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700954{
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700955 const struct acpuclk_pdata *pdata = pdev->dev.platform_data;
956
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700957 pr_info("%s()\n", __func__);
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700958
959 drv_state.ebi1_clk = clk_get(NULL, "ebi1_acpu_clk");
960 BUG_ON(IS_ERR(drv_state.ebi1_clk));
961
962 mutex_init(&drv_state.lock);
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700963 drv_state.max_speed_delta_khz = pdata->max_speed_delta_khz;
Pankaj Kumar3912c982011-12-07 16:59:03 +0530964 select_freq_plan();
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530965 acpuclk_7627_data.wait_for_irq_khz = find_wait_for_irq_khz();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700966 precompute_stepping();
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700967 acpuclk_hw_init();
Taniya Dasc43e6872012-03-21 16:41:14 +0530968 lpj_init();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700969 print_acpu_freq_tbl();
Pankaj Kumar6e66f372011-12-05 14:41:58 +0530970 acpuclk_register(&acpuclk_7627_data);
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700971
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700972#ifdef CONFIG_CPU_FREQ_MSM
973 cpufreq_table_init();
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700974#endif
Matt Wagantall6d9ebee2011-08-26 12:15:24 -0700975 return 0;
Bryan Huntsman3f2bc4d2011-08-16 17:27:22 -0700976}
Matt Wagantallec57f062011-08-16 23:54:46 -0700977
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700978static struct platform_driver acpuclk_7627_driver = {
979 .probe = acpuclk_7627_probe,
980 .driver = {
981 .name = "acpuclk-7627",
982 .owner = THIS_MODULE,
983 },
Matt Wagantallec57f062011-08-16 23:54:46 -0700984};
985
Matt Wagantallbf430eb2012-03-22 11:45:49 -0700986static int __init acpuclk_7627_init(void)
987{
988 return platform_driver_register(&acpuclk_7627_driver);
989}
990postcore_initcall(acpuclk_7627_init);