faeaa54925
The main() function has a special meaning to gcc and using it can result in different code generation. Use armcm_main() to avoid that. Also, invoke SystemInit() from the board specific armcm_main() code. This gives the board code more control over board initialization. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
67 lines
1.5 KiB
C
67 lines
1.5 KiB
C
// Main starting point for LPC176x boards.
|
|
//
|
|
// Copyright (C) 2018 Kevin O'Connor <kevin@koconnor.net>
|
|
//
|
|
// This file may be distributed under the terms of the GNU GPLv3 license.
|
|
|
|
#include "board/armcm_boot.h" // armcm_main
|
|
#include "internal.h" // enable_pclock
|
|
#include "sched.h" // sched_main
|
|
|
|
|
|
/****************************************************************
|
|
* watchdog handler
|
|
****************************************************************/
|
|
|
|
void
|
|
watchdog_reset(void)
|
|
{
|
|
LPC_WDT->WDFEED = 0xaa;
|
|
LPC_WDT->WDFEED = 0x55;
|
|
}
|
|
DECL_TASK(watchdog_reset);
|
|
|
|
void
|
|
watchdog_init(void)
|
|
{
|
|
LPC_WDT->WDTC = 4000000 / 2; // 500ms timeout
|
|
LPC_WDT->WDCLKSEL = 1<<31; // Lock to internal RC
|
|
LPC_WDT->WDMOD = 0x03; // select reset and enable
|
|
watchdog_reset();
|
|
}
|
|
DECL_INIT(watchdog_init);
|
|
|
|
|
|
/****************************************************************
|
|
* misc functions
|
|
****************************************************************/
|
|
|
|
// Check if a peripheral clock has been enabled
|
|
int
|
|
is_enabled_pclock(uint32_t pclk)
|
|
{
|
|
return !!(LPC_SC->PCONP & (1<<pclk));
|
|
}
|
|
|
|
// Enable a peripheral clock
|
|
void
|
|
enable_pclock(uint32_t pclk)
|
|
{
|
|
LPC_SC->PCONP |= 1<<pclk;
|
|
if (pclk < 16) {
|
|
uint32_t shift = pclk * 2;
|
|
LPC_SC->PCLKSEL0 = (LPC_SC->PCLKSEL0 & ~(0x3<<shift)) | (0x1<<shift);
|
|
} else {
|
|
uint32_t shift = (pclk - 16) * 2;
|
|
LPC_SC->PCLKSEL1 = (LPC_SC->PCLKSEL1 & ~(0x3<<shift)) | (0x1<<shift);
|
|
}
|
|
}
|
|
|
|
// Main entry point - called from armcm_boot.c:ResetHandler()
|
|
void
|
|
armcm_main(void)
|
|
{
|
|
SystemInit();
|
|
sched_main();
|
|
}
|