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"
29 #include "powermgmt-target.h"
31 #include "serial-imx31.h"
33 #include "ccm-imx31.h"
35 #include "dvfs_dptc-imx31.h"
37 static unsigned long product_rev
;
38 static unsigned long system_rev
;
40 /** IC revision info routines **/
41 unsigned int iim_system_rev(void)
43 return system_rev
& IIM_SREV_SREV
;
46 unsigned int iim_prod_rev(void)
51 static void iim_init(void)
53 /* Initialize the IC revision info (required by SDMA) */
54 ccm_module_clock_gating(CG_IIM
, CGM_ON_RUN_WAIT
);
55 product_rev
= IIM_PREV
;
56 system_rev
= IIM_SREV
;
59 /** Watchdog timer routines **/
61 /* Initialize the watchdog timer */
62 void watchdog_init(unsigned int half_seconds
)
64 uint16_t wcr
= ((half_seconds
<< WDOG_WCR_WT_POS
) & WDOG_WCR_WT
) |
65 WDOG_WCR_WOE
| /* WDOG output enabled */
66 WDOG_WCR_WDA
| /* WDOG assertion - no effect */
67 WDOG_WCR_SRS
| /* System reset - no effect */
68 WDOG_WCR_WRE
; /* Generate a WDOG signal */
70 ccm_module_clock_gating(CG_WDOG
, CGM_ON_RUN_WAIT
);
74 WDOG_WCR
= wcr
| WDOG_WCR_WDE
; /* Enable timer - hardware does
75 not allow a disable now */
79 /* Service the watchdog timer */
80 void watchdog_service(void)
86 /** GPT timer routines - basis for udelay **/
88 /* Start the general-purpose timer (1MHz) */
91 ccm_module_clock_gating(CG_GPT
, CGM_ON_RUN_WAIT
);
92 unsigned int ipg_mhz
= ccm_get_ipg_clk() / 1000000;
94 GPTCR
&= ~GPTCR_EN
; /* Disable counter */
95 GPTCR
|= GPTCR_SWR
; /* Reset module */
96 while (GPTCR
& GPTCR_SWR
);
99 * Enable in run mode only (doesn't tick while in WFI)
100 * Freerun mode (count to 0xFFFFFFFF and roll-over to 0x00000000)
102 GPTCR
= GPTCR_FRR
| GPTCR_CLKSRC_IPG_CLK
;
107 /* Stop the general-purpose timer */
113 int system_memory_guard(int newmode
)
119 void system_halt(void)
121 disable_interrupt(IRQ_FIQ_STATUS
);
122 avic_set_ni_level(AVIC_NIL_DISABLE
);
127 void system_reboot(void)
129 /* Multi-context so no SPI available (WDT?) */
133 void system_exception_wait(void)
135 /* Called in many contexts so button reading may be a chore */
139 void system_init(void)
141 static const int disable_clocks
[] =
185 /* Initialize frequency with current */
186 cpu_frequency
= ccm_get_mcu_clk();
188 /* MCR WFI enables wait mode (CCM_CCMR_LPM_WAIT_MODE = 0) */
189 imx31_regclr32(&CCM_CCMR
, CCM_CCMR_LPM
);
193 imx31_regset32(&SDHC1_CLOCK_CONTROL
, STOP_CLK
);
194 imx31_regset32(&SDHC2_CLOCK_CONTROL
, STOP_CLK
);
195 imx31_regset32(&RNGA_CONTROL
, RNGA_CONTROL_SLEEP
);
196 imx31_regclr32(&UCR1_1
, EUARTUCR1_UARTEN
);
197 imx31_regclr32(&UCR1_2
, EUARTUCR1_UARTEN
);
198 imx31_regclr32(&UCR1_3
, EUARTUCR1_UARTEN
);
199 imx31_regclr32(&UCR1_4
, EUARTUCR1_UARTEN
);
200 imx31_regclr32(&UCR1_5
, EUARTUCR1_UARTEN
);
202 for (i
= 0; i
< ARRAYLEN(disable_clocks
); i
++)
203 ccm_module_clock_gating(disable_clocks
[i
], CGM_OFF
);
210 void __attribute__((naked
)) imx31_regmod32(volatile uint32_t *reg_p
,
214 asm volatile("and r1, r1, r2 \n"
223 (void)reg_p
; (void)value
; (void)mask
;
226 void __attribute__((naked
)) imx31_regset32(volatile uint32_t *reg_p
,
229 asm volatile("mrs r3, cpsr \n"
236 (void)reg_p
; (void)mask
;
239 void __attribute__((naked
)) imx31_regclr32(volatile uint32_t *reg_p
,
242 asm volatile("mrs r3, cpsr \n"
249 (void)reg_p
; (void)mask
;
253 void system_prepare_fw_start(void)
258 disable_interrupt(IRQ_FIQ_STATUS
);
259 avic_set_ni_level(AVIC_NIL_DISABLE
);
264 void rolo_restart_firmware(const unsigned char *source
, unsigned char *dest
,
265 int length
) __attribute__((noreturn
));
267 void __attribute__((noreturn
))
268 rolo_restart(const unsigned char *source
, unsigned char *dest
, int length
)
270 /* Some housekeeping tasks must be performed for a safe changeover */
271 charging_algorithm_close();
272 system_prepare_fw_start();
274 /* Copying routine where new image is run */
275 rolo_restart_firmware(source
, dest
, length
);
277 #endif /* BOOTLOADER */
280 inline void dumpregs(void)
282 asm volatile ("mov %0,r0\n\t"
286 "=r"(regs
.r0
),"=r"(regs
.r1
),
287 "=r"(regs
.r2
),"=r"(regs
.r3
):);
289 asm volatile ("mov %0,r4\n\t"
293 "=r"(regs
.r4
),"=r"(regs
.r5
),
294 "=r"(regs
.r6
),"=r"(regs
.r7
):);
296 asm volatile ("mov %0,r8\n\t"
300 "=r"(regs
.r8
),"=r"(regs
.r9
),
301 "=r"(regs
.r10
),"=r"(regs
.r11
):);
303 asm volatile ("mov %0,r12\n\t"
308 "=r"(regs
.r12
),"=r"(regs
.sp
),
309 "=r"(regs
.lr
),"=r"(regs
.pc
):);
311 dprintf("Register Dump :\n");
312 dprintf("R0=0x%x\tR1=0x%x\tR2=0x%x\tR3=0x%x\n",regs
.r0
,regs
.r1
,regs
.r2
,regs
.r3
);
313 dprintf("R4=0x%x\tR5=0x%x\tR6=0x%x\tR7=0x%x\n",regs
.r4
,regs
.r5
,regs
.r6
,regs
.r7
);
314 dprintf("R8=0x%x\tR9=0x%x\tR10=0x%x\tR11=0x%x\n",regs
.r8
,regs
.r9
,regs
.r10
,regs
.r11
);
315 dprintf("R12=0x%x\tSP=0x%x\tLR=0x%x\tPC=0x%x\n",regs
.r12
,regs
.sp
,regs
.lr
,regs
.pc
);
316 //dprintf("CPSR=0x%x\t\n",regs.cpsr);
318 DEBUGF("Register Dump :\n");
319 DEBUGF("R0=0x%x\tR1=0x%x\tR2=0x%x\tR3=0x%x\n",regs
.r0
,regs
.r1
,regs
.r2
,regs
.r3
);
320 DEBUGF("R4=0x%x\tR5=0x%x\tR6=0x%x\tR7=0x%x\n",regs
.r4
,regs
.r5
,regs
.r6
,regs
.r7
);
321 DEBUGF("R8=0x%x\tR9=0x%x\tR10=0x%x\tR11=0x%x\n",regs
.r8
,regs
.r9
,regs
.r10
,regs
.r11
);
322 DEBUGF("R12=0x%x\tSP=0x%x\tLR=0x%x\tPC=0x%x\n",regs
.r12
,regs
.sp
,regs
.lr
,regs
.pc
);
323 //DEBUGF("CPSR=0x%x\t\n",regs.cpsr);
327 #ifdef HAVE_ADJUSTABLE_CPU_FREQ
329 void set_cpu_frequency(long frequency
)