2
* Copyright (c) 2012 Jan Vesely
5
* Redistribution and use in source and binary forms, with or without
6
* modification, are permitted provided that the following conditions
9
* - Redistributions of source code must retain the above copyright
10
* notice, this list of conditions and the following disclaimer.
11
* - Redistributions in binary form must reproduce the above copyright
12
* notice, this list of conditions and the following disclaimer in the
13
* documentation and/or other materials provided with the distribution.
14
* - The name of the author may not be used to endorse or promote products
15
* derived from this software without specific prior written permission.
17
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
18
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
19
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
20
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
21
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
22
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
23
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
24
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
25
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
26
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30
* @defgroup root_amdm37x TI AM/DM37x platform driver.
31
* @brief HelenOS TI AM/DM37x platform driver.
46
static void log(const volatile void *place, uint32_t val, volatile void* base, size_t size, void *data, bool write)
48
printf("PIO %s: %p(%p) %#"PRIx32"\n", write ? "WRITE" : "READ",
49
(place - base) + data, place, val);
53
int amdm37x_init(amdm37x_t *device, bool trace)
58
ret = pio_enable((void*)USBHOST_CM_BASE_ADDRESS, USBHOST_CM_SIZE,
59
(void**)&device->cm.usbhost);
63
ret = pio_enable((void*)CORE_CM_BASE_ADDRESS, CORE_CM_SIZE,
64
(void**)&device->cm.core);
68
ret = pio_enable((void*)CLOCK_CONTROL_CM_BASE_ADDRESS,
69
CLOCK_CONTROL_CM_SIZE, (void**)&device->cm.clocks);
73
ret = pio_enable((void*)MPU_CM_BASE_ADDRESS,
74
MPU_CM_SIZE, (void**)&device->cm.mpu);
78
ret = pio_enable((void*)IVA2_CM_BASE_ADDRESS,
79
IVA2_CM_SIZE, (void**)&device->cm.iva2);
83
ret = pio_enable((void*)CLOCK_CONTROL_PRM_BASE_ADDRESS,
84
CLOCK_CONTROL_PRM_SIZE, (void**)&device->prm.clocks);
88
ret = pio_enable((void*)GLOBAL_REG_PRM_BASE_ADDRESS,
89
GLOBAL_REG_PRM_SIZE, (void**)&device->prm.global);
93
ret = pio_enable((void*)AMDM37x_USBTLL_BASE_ADDRESS,
94
AMDM37x_USBTLL_SIZE, (void**)&device->tll);
98
ret = pio_enable((void*)AMDM37x_UHH_BASE_ADDRESS,
99
AMDM37x_UHH_SIZE, (void**)&device->uhh);
104
pio_trace_enable(device->tll, AMDM37x_USBTLL_SIZE, log, (void*)AMDM37x_USBTLL_BASE_ADDRESS);
105
pio_trace_enable(device->cm.clocks, CLOCK_CONTROL_CM_SIZE, log, (void*)CLOCK_CONTROL_CM_BASE_ADDRESS);
106
pio_trace_enable(device->cm.core, CORE_CM_SIZE, log, (void*)CORE_CM_BASE_ADDRESS);
107
pio_trace_enable(device->cm.mpu, MPU_CM_SIZE, log, (void*)MPU_CM_BASE_ADDRESS);
108
pio_trace_enable(device->cm.iva2, IVA2_CM_SIZE, log, (void*)IVA2_CM_BASE_ADDRESS);
109
pio_trace_enable(device->cm.usbhost, USBHOST_CM_SIZE, log, (void*)USBHOST_CM_BASE_ADDRESS);
110
pio_trace_enable(device->uhh, AMDM37x_UHH_SIZE, log, (void*)AMDM37x_UHH_BASE_ADDRESS);
111
pio_trace_enable(device->prm.clocks, CLOCK_CONTROL_PRM_SIZE, log, (void*)CLOCK_CONTROL_PRM_BASE_ADDRESS);
112
pio_trace_enable(device->prm.global, GLOBAL_REG_PRM_SIZE, log, (void*)GLOBAL_REG_PRM_BASE_ADDRESS);
118
/** Set DPLLs 1,2,3,4,5 to ON (locked) and autoidle.
119
* @param device Register map.
121
* The idea is to get all DPLLs running and make hw control their power mode,
122
* based on the module requirements (module ICLKs and FCLKs).
124
void amdm37x_setup_dpll_on_autoidle(amdm37x_t *device)
127
/* Get SYS_CLK value, it is used as reference clock by all DPLLs,
128
* NFI who sets this or why it is set to specific value. */
129
const unsigned osc_clk = pio_read_32(&device->prm.clocks->clksel)
130
& CLOCK_CONTROL_PRM_CLKSEL_SYS_CLKIN_MASK;
131
const unsigned clk_reg = pio_read_32(&device->prm.global->clksrc_ctrl);
132
const unsigned base_freq = sys_clk_freq_kHz(osc_clk)
133
/ GLOBAL_REG_PRM_CLKSRC_CTRL_SYSCLKDIV_GET(clk_reg);
134
ddf_msg(LVL_NOTE, "Base frequency: %d.%dMhz",
135
base_freq / 1000, base_freq % 1000);
138
/* DPLL1 provides MPU(CPU) clock.
139
* It uses SYS_CLK as reference clock and core clock (DPLL3) as
140
* high frequency bypass (MPU then runs on L3 interconnect freq).
141
* It should be setup by fw or u-boot.*/
142
mpu_cm_regs_t *mpu = device->cm.mpu;
144
/* Current MPU frequency. */
145
if (pio_read_32(&mpu->clkstst) & MPU_CM_CLKSTST_CLKACTIVITY_MPU_ACTIVE_FLAG) {
146
if (pio_read_32(&mpu->idlest_pll) & MPU_CM_IDLEST_PLL_ST_MPU_CLK_LOCKED_FLAG) {
147
/* DPLL active and locked */
148
const uint32_t reg = pio_read_32(&mpu->clksel1_pll);
149
const unsigned multiplier =
150
(reg & MPU_CM_CLKSEL1_PLL_MPU_DPLL_MULT_MASK)
151
>> MPU_CM_CLKSEL1_PLL_MPU_DPLL_MULT_SHIFT;
152
const unsigned divisor =
153
(reg & MPU_CM_CLKSEL1_PLL_MPU_DPLL_DIV_MASK)
154
>> MPU_CM_CLKSEL1_PLL_MPU_DPLL_DIV_SHIFT;
155
const unsigned divisor2 =
156
(pio_read_32(&mpu->clksel2_pll)
157
& MPU_CM_CLKSEL2_PLL_MPU_DPLL_CLKOUT_DIV_MASK);
158
if (multiplier && divisor && divisor2) {
159
/** See AMDM37x TRM p. 300 for the formula */
160
const unsigned freq =
161
((base_freq * multiplier) / (divisor + 1))
163
ddf_msg(LVL_NOTE, "MPU running at %d.%d MHz",
164
freq / 1000, freq % 1000);
166
ddf_msg(LVL_WARN, "Frequency divisor and/or "
167
"multiplier value invalid: %d %d %d",
168
multiplier, divisor, divisor2);
171
/* DPLL in LP bypass mode */
172
const unsigned divisor =
173
MPU_CM_CLKSEL1_PLL_MPU_CLK_SRC_VAL(
174
pio_read_32(&mpu->clksel1_pll));
175
ddf_msg(LVL_NOTE, "MPU DPLL in bypass mode, running at"
176
" CORE CLK / %d MHz", divisor);
179
ddf_msg(LVL_WARN, "MPU clock domain is not active, we should not be running...");
181
// TODO: Enable this (automatic MPU downclocking):
183
/* Enable low power bypass mode, this will take effect the next lock or
184
* relock sequence. */
185
//TODO: We might need to force re-lock after enabling this
186
pio_set_32(&mpu->clken_pll, MPU_CM_CLKEN_PLL_EN_MPU_DPLL_LP_MODE_FLAG, 5);
187
/* Enable automatic relocking */
188
pio_change_32(&mpu->autoidle_pll, MPU_CM_AUTOIDLE_PLL_AUTO_MPU_DPLL_ENABLED, MPU_CM_AUTOIDLE_PLL_AUTO_MPU_DPLL_MASK, 5);
191
/* DPLL2 provides IVA(video acceleration) clock.
192
* It uses SYS_CLK as reference clokc and core clock (DPLL3) as
193
* high frequency bypass (IVA runs on L3 freq).
195
// TODO: We can probably turn this off entirely. IVA is left unused.
196
/* Enable low power bypass mode, this will take effect the next lock or
197
* relock sequence. */
198
//TODO: We might need to force re-lock after enabling this
199
pio_set_32(&device->cm.iva2->clken_pll, MPU_CM_CLKEN_PLL_EN_MPU_DPLL_LP_MODE_FLAG, 5);
200
/* Enable automatic relocking */
201
pio_change_32(&device->cm.iva2->autoidle_pll, MPU_CM_AUTOIDLE_PLL_AUTO_MPU_DPLL_ENABLED, MPU_CM_AUTOIDLE_PLL_AUTO_MPU_DPLL_MASK, 5);
203
/* DPLL3 provides tons of clocks:
204
* CORE_CLK, COREX2_CLK, DSS_TV_CLK, 12M_CLK, 48M_CLK, 96M_CLK, L3_ICLK,
205
* and L4_ICLK. It uses SYS_CLK as reference clock and low frequency
206
* bypass. It should be setup by fw or u-boot as it controls critical
209
if (pio_read_32(&device->cm.clocks->idlest_ckgen) & CLOCK_CONTROL_CM_IDLEST_CKGEN_ST_CORE_CLK_FLAG) {
210
/* DPLL active and locked */
212
pio_read_32(&device->cm.clocks->clksel1_pll);
213
const unsigned multiplier =
214
CLOCK_CONTROL_CM_CLKSEL1_PLL_CORE_DPLL_MULT_GET(reg);
215
const unsigned divisor =
216
CLOCK_CONTROL_CM_CLKSEL1_PLL_CORE_DPLL_DIV_GET(reg);
217
const unsigned divisor2 =
218
CLOCK_CONTROL_CM_CLKSEL1_PLL_CORE_DPLL_CLKOUT_DIV_GET(reg);
219
if (multiplier && divisor && divisor2) {
220
/** See AMDM37x TRM p. 300 for the formula */
221
const unsigned freq =
222
((base_freq * multiplier) / (divisor + 1)) / divisor2;
223
ddf_msg(LVL_NOTE, "CORE CLK running at %d.%d MHz",
224
freq / 1000, freq % 1000);
225
const unsigned l3_div =
226
pio_read_32(&device->cm.core->clksel)
227
& CORE_CM_CLKSEL_CLKSEL_L3_MASK;
228
if (l3_div == CORE_CM_CLKSEL_CLKSEL_L3_DIVIDED1 ||
229
l3_div == CORE_CM_CLKSEL_CLKSEL_L3_DIVIDED2) {
230
ddf_msg(LVL_NOTE, "L3 interface at %d.%d MHz",
231
(freq / l3_div) / 1000,
232
(freq / l3_div) % 1000);
234
ddf_msg(LVL_WARN,"L3 interface clock divisor is"
235
" invalid: %d", l3_div);
238
ddf_msg(LVL_WARN, "DPLL3 frequency divisor and/or "
239
"multiplier value invalid: %d %d %d",
240
multiplier, divisor, divisor2);
243
ddf_msg(LVL_WARN, "CORE CLK in bypass mode, fruunig at SYS_CLK"
244
" frreq of %d.%d MHz", base_freq / 1000, base_freq % 1000);
247
/* Set DPLL3 to automatic to save power */
248
pio_change_32(&device->cm.clocks->autoidle_pll,
249
CLOCK_CONTROL_CM_AUTOIDLE_PLL_AUTO_CORE_DPLL_AUTOMATIC,
250
CLOCK_CONTROL_CM_AUTOIDLE_PLL_AUTO_CORE_DPLL_MASK, 5);
252
/* DPLL4 provides peripheral domain clocks:
253
* CAM_MCLK, EMU_PER_ALWON_CLK, DSS1_ALWON_FCLK, and 96M_ALWON_FCLK.
254
* It uses SYS_CLK as reference clock and low frequency bypass.
255
* 96M clock is used by McBSP[1,5], MMC[1,2,3], I2C[1,2,3], so
256
* we can probably turn this off entirely (DSS is still non-functional).
258
/* Set DPLL4 to automatic to save power */
259
pio_change_32(&device->cm.clocks->autoidle_pll,
260
CLOCK_CONTROL_CM_AUTOIDLE_PLL_AUTO_PERIPH_DPLL_AUTOMATIC,
261
CLOCK_CONTROL_CM_AUTOIDLE_PLL_AUTO_PERIPH_DPLL_MASK, 5);
263
/* DPLL5 provide peripheral domain clocks: 120M_FCLK.
264
* It uses SYS_CLK as reference clock and low frequency bypass.
265
* 120M clock is used by HS USB and USB TLL.
268
if ((pio_read_32(&device->cm.clocks->clken2_pll)
269
& CLOCK_CONTROL_CM_CLKEN2_PLL_EN_PERIPH2_DPLL_MASK)
270
!= CLOCK_CONTROL_CM_CLKEN2_PLL_EN_PERIPH2_DPLL_LOCK) {
271
/* Compute divisors and multiplier
272
* See AMDM37x TRM p. 300 for the formula */
273
// TODO: base_freq does not have to be rounded to Mhz
274
// (that's why I used KHz as unit).
275
const unsigned mult = 120;
276
const unsigned div = (base_freq / 1000) - 1;
277
const unsigned div2 = 1;
278
if ( ((base_freq % 1000) != 0) || (div > 127)) {
279
ddf_msg(LVL_ERROR, "Rounding error, or divisor to big "
280
"freq: %d, div: %d", base_freq, div);
286
pio_change_32(&device->cm.clocks->clksel4_pll,
287
CLOCK_CONTROL_CM_CLKSEL4_PLL_PERIPH2_DPLL_MULT_CREATE(mult),
288
CLOCK_CONTROL_CM_CLKSEL4_PLL_PERIPH2_DPLL_MULT_MASK, 10);
290
/* Set DPLL divisor */
291
pio_change_32(&device->cm.clocks->clksel4_pll,
292
CLOCK_CONTROL_CM_CLKSEL4_PLL_PERIPH2_DPLL_DIV_CREATE(div),
293
CLOCK_CONTROL_CM_CLKSEL4_PLL_PERIPH2_DPLL_DIV_MASK, 10);
295
/* Set output clock divisor */
296
pio_change_32(&device->cm.clocks->clksel5_pll,
297
CLOCK_CONTROL_CM_CLKSEL5_PLL_DIV120M_CREATE(div2),
298
CLOCK_CONTROL_CM_CLKSEL5_PLL_DIV120M_MASK, 10);
301
pio_change_32(&device->cm.clocks->clken2_pll,
302
CLOCK_CONTROL_CM_CLKEN2_PLL_EN_PERIPH2_DPLL_LOCK,
303
CLOCK_CONTROL_CM_CLKEN2_PLL_EN_PERIPH2_DPLL_MASK, 10);
306
/* Set DPLL5 to automatic to save power */
307
pio_change_32(&device->cm.clocks->autoidle2_pll,
308
CLOCK_CONTROL_CM_AUTOIDLE2_PLL_AUTO_PERIPH2_DPLL_AUTOMATIC,
309
CLOCK_CONTROL_CM_AUTOIDLE2_PLL_AUTO_PERIPH2_DPLL_MASK, 5);
312
/** Enable/disable function and interface clocks for USBTLL and USBHOST.
313
* @param device Register map.
314
* @param on True to switch clocks on.
316
void amdm37x_usb_clocks_set(amdm37x_t *device, bool enabled)
319
/* Enable interface and function clock for USB TLL */
320
pio_set_32(&device->cm.core->fclken3,
321
CORE_CM_FCLKEN3_EN_USBTLL_FLAG, 5);
322
pio_set_32(&device->cm.core->iclken3,
323
CORE_CM_ICLKEN3_EN_USBTLL_FLAG, 5);
325
/* Enable interface and function clock for USB hosts */
326
pio_set_32(&device->cm.usbhost->fclken,
327
USBHOST_CM_FCLKEN_EN_USBHOST1_FLAG |
328
USBHOST_CM_FCLKEN_EN_USBHOST2_FLAG, 5);
329
pio_set_32(&device->cm.usbhost->iclken,
330
USBHOST_CM_ICLKEN_EN_USBHOST, 5);
332
printf("DPLL5 (and everything else) should be on: %"
333
PRIx32" %"PRIx32".\n",
334
pio_read_32(&device->cm.clocks->idlest_ckgen),
335
pio_read_32(&device->cm.clocks->idlest2_ckgen));
338
/* Disable interface and function clock for USB hosts */
339
pio_clear_32(&device->cm.usbhost->iclken,
340
USBHOST_CM_ICLKEN_EN_USBHOST, 5);
341
pio_clear_32(&device->cm.usbhost->fclken,
342
USBHOST_CM_FCLKEN_EN_USBHOST1_FLAG |
343
USBHOST_CM_FCLKEN_EN_USBHOST2_FLAG, 5);
345
/* Disable interface and function clock for USB TLL */
346
pio_clear_32(&device->cm.core->iclken3,
347
CORE_CM_ICLKEN3_EN_USBTLL_FLAG, 5);
348
pio_clear_32(&device->cm.core->fclken3,
349
CORE_CM_FCLKEN3_EN_USBTLL_FLAG, 5);
353
/** Initialize USB TLL port connections.
355
* Different modes are on page 3312 of the Manual Figure 22-34.
356
* Select mode than can operate in FS/LS.
358
int amdm37x_usb_tll_init(amdm37x_t *device)
361
if (pio_read_32(&device->cm.core->idlest3) & CORE_CM_IDLEST3_ST_USBTLL_FLAG) {
362
ddf_msg(LVL_ERROR, "USB TLL is not accessible");
367
pio_set_32(&device->tll->sysconfig, TLL_SYSCONFIG_SOFTRESET_FLAG, 5);
368
ddf_msg(LVL_DEBUG2, "Waiting for USB TLL reset");
369
while (!(pio_read_32(&device->tll->sysstatus) & TLL_SYSSTATUS_RESET_DONE_FLAG));
370
ddf_msg(LVL_DEBUG, "USB TLL Reset done.");
372
/* Setup idle mode (smart idle) */
373
pio_change_32(&device->tll->sysconfig,
374
TLL_SYSCONFIG_CLOCKACTIVITY_FLAG | TLL_SYSCONFIG_AUTOIDLE_FLAG |
375
TLL_SYSCONFIG_SIDLE_MODE_SMART, TLL_SYSCONFIG_SIDLE_MODE_MASK, 5);
377
/* Smart idle for UHH */
378
pio_change_32(&device->uhh->sysconfig,
379
UHH_SYSCONFIG_CLOCKACTIVITY_FLAG | UHH_SYSCONFIG_AUTOIDLE_FLAG |
380
UHH_SYSCONFIG_SIDLE_MODE_SMART, UHH_SYSCONFIG_SIDLE_MODE_MASK, 5);
382
/* Set all ports to go through TLL(UTMI)
383
* Direct connection can only work in HS mode */
384
pio_set_32(&device->uhh->hostconfig,
385
UHH_HOSTCONFIG_P1_ULPI_BYPASS_FLAG |
386
UHH_HOSTCONFIG_P2_ULPI_BYPASS_FLAG |
387
UHH_HOSTCONFIG_P3_ULPI_BYPASS_FLAG, 5);
390
pio_set_32(&device->tll->shared_conf, TLL_SHARED_CONF_FCLK_IS_ON_FLAG, 5);
392
for (unsigned i = 0; i < 3; ++i) {
393
/* Serial mode is the only one capable of FS/LS operation.
394
* Select FS/LS mode, no idea what the difference is
395
* one of bidirectional modes might be good choice
396
* 2 = 3pin bidi phy. */
397
pio_change_32(&device->tll->channel_conf[i],
398
TLL_CHANNEL_CONF_CHANMODE_UTMI_SERIAL_MODE |
399
TLL_CHANNEL_CONF_FSLSMODE_3PIN_BIDI_PHY,
400
TLL_CHANNEL_CONF_CHANMODE_MASK |
401
TLL_CHANNEL_CONF_FSLSMODE_MASK, 5);