1 /***************************************************************************
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
10 * Copyright (C) 2007 by James Espinoza
12 * This program is free software; you can redistribute it and/or
13 * modify it under the terms of the GNU General Public License
14 * as published by the Free Software Foundation; either version 2
15 * of the License, or (at your option) any later version.
17 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
18 * KIND, either express or implied.
20 ****************************************************************************/
25 #include "avic-imx31.h"
26 #include "gpio-imx31.h"
27 #include "mmu-imx31.h"
28 #include "system-target.h"
30 #include "serial-imx31.h"
32 #include "ccm-imx31.h"
35 static unsigned long product_rev
;
36 static unsigned long system_rev
;
38 /** IC revision info routines **/
39 unsigned int iim_system_rev(void)
41 return system_rev
& IIM_SREV_SREV
;
44 unsigned int iim_prod_rev(void)
49 static void iim_init(void)
51 /* Initialize the IC revision info (required by SDMA) */
52 ccm_module_clock_gating(CG_IIM
, CGM_ON_RUN_WAIT
);
53 product_rev
= IIM_PREV
;
54 system_rev
= IIM_SREV
;
57 /** Watchdog timer routines **/
59 /* Initialize the watchdog timer */
60 void watchdog_init(unsigned int half_seconds
)
62 uint16_t wcr
= ((half_seconds
<< WDOG_WCR_WT_POS
) & WDOG_WCR_WT
) |
63 WDOG_WCR_WOE
| /* WDOG output enabled */
64 WDOG_WCR_WDA
| /* WDOG assertion - no effect */
65 WDOG_WCR_SRS
| /* System reset - no effect */
66 WDOG_WCR_WRE
; /* Generate a WDOG signal */
68 ccm_module_clock_gating(CG_WDOG
, CGM_ON_RUN_WAIT
);
72 WDOG_WCR
= wcr
| WDOG_WCR_WDE
; /* Enable timer - hardware does
73 not allow a disable now */
77 /* Service the watchdog timer */
78 void watchdog_service(void)
84 /** GPT timer routines - basis for udelay **/
86 /* Start the general-purpose timer (1MHz) */
89 ccm_module_clock_gating(CG_GPT
, CGM_ON_RUN_WAIT
);
90 unsigned int ipg_mhz
= ccm_get_ipg_clk() / 1000000;
92 GPTCR
&= ~GPTCR_EN
; /* Disable counter */
93 GPTCR
|= GPTCR_SWR
; /* Reset module */
94 while (GPTCR
& GPTCR_SWR
);
97 * Enable in run mode only (doesn't tick while in WFI)
98 * Freerun mode (count to 0xFFFFFFFF and roll-over to 0x00000000)
100 GPTCR
= GPTCR_FRR
| GPTCR_CLKSRC_IPG_CLK
;
105 /* Stop the general-purpose timer */
111 int system_memory_guard(int newmode
)
117 void system_reboot(void)
119 /* Multi-context so no SPI available (WDT?) */
123 void system_exception_wait(void)
125 /* Called in many contexts so button reading may be a chore */
126 avic_disable_int(INT_ALL
);
131 void system_init(void)
133 static const int disable_clocks
[] =
177 /* MCR WFI enables wait mode (CCM_CCMR_LPM_WAIT_MODE = 0) */
178 imx31_regclr32(&CCM_CCMR
, CCM_CCMR_LPM
);
182 imx31_regset32(&SDHC1_CLOCK_CONTROL
, STOP_CLK
);
183 imx31_regset32(&SDHC2_CLOCK_CONTROL
, STOP_CLK
);
184 imx31_regset32(&RNGA_CONTROL
, RNGA_CONTROL_SLEEP
);
185 imx31_regclr32(&UCR1_1
, EUARTUCR1_UARTEN
);
186 imx31_regclr32(&UCR1_2
, EUARTUCR1_UARTEN
);
187 imx31_regclr32(&UCR1_3
, EUARTUCR1_UARTEN
);
188 imx31_regclr32(&UCR1_4
, EUARTUCR1_UARTEN
);
189 imx31_regclr32(&UCR1_5
, EUARTUCR1_UARTEN
);
191 for (i
= 0; i
< ARRAYLEN(disable_clocks
); i
++)
192 ccm_module_clock_gating(disable_clocks
[i
], CGM_OFF
);
199 void __attribute__((naked
)) imx31_regmod32(volatile uint32_t *reg_p
,
203 asm volatile("and r1, r1, r2 \n"
212 (void)reg_p
; (void)value
; (void)mask
;
215 void __attribute__((naked
)) imx31_regset32(volatile uint32_t *reg_p
,
218 asm volatile("mrs r3, cpsr \n"
225 (void)reg_p
; (void)mask
;
228 void __attribute__((naked
)) imx31_regclr32(volatile uint32_t *reg_p
,
231 asm volatile("mrs r3, cpsr \n"
238 (void)reg_p
; (void)mask
;
242 void system_prepare_fw_start(void)
244 disable_interrupt(IRQ_FIQ_STATUS
);
245 avic_disable_int(INT_ALL
);
251 inline void dumpregs(void)
253 asm volatile ("mov %0,r0\n\t"
257 "=r"(regs
.r0
),"=r"(regs
.r1
),
258 "=r"(regs
.r2
),"=r"(regs
.r3
):);
260 asm volatile ("mov %0,r4\n\t"
264 "=r"(regs
.r4
),"=r"(regs
.r5
),
265 "=r"(regs
.r6
),"=r"(regs
.r7
):);
267 asm volatile ("mov %0,r8\n\t"
271 "=r"(regs
.r8
),"=r"(regs
.r9
),
272 "=r"(regs
.r10
),"=r"(regs
.r11
):);
274 asm volatile ("mov %0,r12\n\t"
279 "=r"(regs
.r12
),"=r"(regs
.sp
),
280 "=r"(regs
.lr
),"=r"(regs
.pc
):);
282 dprintf("Register Dump :\n");
283 dprintf("R0=0x%x\tR1=0x%x\tR2=0x%x\tR3=0x%x\n",regs
.r0
,regs
.r1
,regs
.r2
,regs
.r3
);
284 dprintf("R4=0x%x\tR5=0x%x\tR6=0x%x\tR7=0x%x\n",regs
.r4
,regs
.r5
,regs
.r6
,regs
.r7
);
285 dprintf("R8=0x%x\tR9=0x%x\tR10=0x%x\tR11=0x%x\n",regs
.r8
,regs
.r9
,regs
.r10
,regs
.r11
);
286 dprintf("R12=0x%x\tSP=0x%x\tLR=0x%x\tPC=0x%x\n",regs
.r12
,regs
.sp
,regs
.lr
,regs
.pc
);
287 //dprintf("CPSR=0x%x\t\n",regs.cpsr);
289 DEBUGF("Register Dump :\n");
290 DEBUGF("R0=0x%x\tR1=0x%x\tR2=0x%x\tR3=0x%x\n",regs
.r0
,regs
.r1
,regs
.r2
,regs
.r3
);
291 DEBUGF("R4=0x%x\tR5=0x%x\tR6=0x%x\tR7=0x%x\n",regs
.r4
,regs
.r5
,regs
.r6
,regs
.r7
);
292 DEBUGF("R8=0x%x\tR9=0x%x\tR10=0x%x\tR11=0x%x\n",regs
.r8
,regs
.r9
,regs
.r10
,regs
.r11
);
293 DEBUGF("R12=0x%x\tSP=0x%x\tLR=0x%x\tPC=0x%x\n",regs
.r12
,regs
.sp
,regs
.lr
,regs
.pc
);
294 //DEBUGF("CPSR=0x%x\t\n",regs.cpsr);
298 #ifdef HAVE_ADJUSTABLE_CPU_FREQ
300 void set_cpu_frequency(long frequency
)