void board_init(void)
{
/* Disable watchdog (compal loader leaves it enabled) */
wdog_enable(0);
/* Configure memory interface */
calypso_mem_cfg(CALYPSO_nCS0, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS1, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS2, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS3, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_CS4, 0, CALYPSO_MEM_8bit, 1);
calypso_mem_cfg(CALYPSO_nCS6, 0, CALYPSO_MEM_32bit, 1);
calypso_mem_cfg(CALYPSO_nCS7, 0, CALYPSO_MEM_32bit, 0);
/* Set VTCXO_DIV2 = 1, configure PLL for 104 MHz and give ARM half of that */
calypso_clock_set(2, CALYPSO_PLL13_104_MHZ, ARM_MCLK_DIV_2);
/* Configure the RHEA bridge with some sane default values */
calypso_rhea_cfg(0, 0, 0xff, 0, 1, 0, 0);
/* Initialize board-specific GPIO */
board_io_init();
/* Enable bootrom mapping to route exception vectors to RAM */
calypso_bootrom(1);
calypso_exceptions_install();
/* Initialize interrupt controller */
irq_init();
/* initialize MODEM UART to be used for sercomm*/
uart_init(SERCOMM_UART_NR, 1);
uart_baudrate(SERCOMM_UART_NR, UART_460800);
/* initialize IRDA UART to be used for old-school console code.
* note: IRDA uart only accessible on C115 and C117 PCB */
uart_init(CONS_UART_NR, 1);
uart_baudrate(CONS_UART_NR, UART_115200);
/* Initialize hardware timers */
hwtimer_init();
/* Initialize DMA controller */
dma_init();
/* Initialize real time clock */
rtc_init();
/* Initialize system timers (uses hwtimer 2) */
timer_init();
/* Initialize LCD driver (uses UWire) and backlight */
<<<<<<< HEAD
static int do_enable(int ena)
{
int result = wdog_enable(ena);
if (verbose) {
int status = 0;
wdog_status(&status);
printf("%s\n", status ? "Enabled" : "Disabled");
}
return result;
}
static int do_enable(char *arg)
{
int result;
result = wdog_enable(atoi(arg));
if (verbose) {
int status = 0;
wdog_status(&status);
printf("%s\n", status ? "Enabled" : "Disabled");
}
return result;
}
void up_addregion(void)
{
/* Disable watchdog in first non-common function */
wdog_enable(0);
// XXX: change to initialization of extern memory with save defaults
/* Configure memory interface */
calypso_mem_cfg(CALYPSO_nCS0, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS1, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS2, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS3, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_CS4, 0, CALYPSO_MEM_8bit, 1);
calypso_mem_cfg(CALYPSO_nCS6, 0, CALYPSO_MEM_32bit, 1);
calypso_mem_cfg(CALYPSO_nCS7, 0, CALYPSO_MEM_32bit, 0);
/* Set VTCXO_DIV2 = 1, configure PLL for 104 MHz and give ARM half of that */
calypso_clock_set(2, CALYPSO_PLL13_104_MHZ, ARM_MCLK_DIV_2);
/* Configure the RHEA bridge with some sane default values */
calypso_rhea_cfg(0, 0, 0xff, 0, 1, 0, 0);
}
void board_init(int with_irq)
{
/* Disable watchdog (compal loader leaves it enabled) */
wdog_enable(0);
/* Configure memory interface */
calypso_mem_cfg(CALYPSO_nCS0, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS1, 3, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS2, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_nCS3, 5, CALYPSO_MEM_16bit, 1);
calypso_mem_cfg(CALYPSO_CS4, 0, CALYPSO_MEM_8bit, 1);
calypso_mem_cfg(CALYPSO_nCS6, 0, CALYPSO_MEM_32bit, 1);
calypso_mem_cfg(CALYPSO_nCS7, 0, CALYPSO_MEM_32bit, 0);
/* Set VTCXO_DIV2 = 1, configure PLL for 104 MHz and give ARM half of that */
calypso_clock_set(2, CALYPSO_PLL13_104_MHZ, ARM_MCLK_DIV_2);
/* Configure the RHEA bridge with some sane default values */
calypso_rhea_cfg(0, 0, 0xff, 0, 1, 0, 0);
/* Initialize board-specific GPIO */
board_io_init();
/* Enable bootrom mapping to route exception vectors to RAM */
calypso_bootrom(with_irq);
calypso_exceptions_install();
/* Initialize interrupt controller */
if (with_irq)
irq_init();
sercomm_bind_uart(UART_MODEM);
cons_bind_uart(UART_IRDA);
/* initialize MODEM UART to be used for sercomm */
uart_init(UART_MODEM, with_irq);
uart_baudrate(UART_MODEM, UART_115200);
/* initialize IRDA UART to be used for old-school console code.
* note: IRDA uart only accessible on C115 and C117 PCB */
uart_init(UART_IRDA, with_irq);
uart_baudrate(UART_IRDA, UART_115200);
/* Initialize hardware timers */
hwtimer_init();
/* Initialize DMA controller */
dma_init();
/* Initialize real time clock */
rtc_init();
/* Initialize system timers (uses hwtimer 2) */
timer_init();
/* Initialize LCD driver (uses UWire) */
fb_init();
bl_mode_pwl(1);
bl_level(0);
/* Initialize keypad driver */
keypad_init(keymap, with_irq);
/* Initialize ABB driver (uses SPI) */
twl3025_init();
/* enable LEDB driver of Iota for keypad backlight */
twl3025_reg_write(AUXLED, 0x02);
}
static int testit(void)
{
int id, ack;
log("Verifying watchdog connectivity");
if (wdog_pmon_ping())
err(1, "Failed connectivity check");
log("Subscribing to process supervisor");
id = wdog_pmon_subscribe(NULL, tmo, &ack);
if (id < 0) {
perror("Failed connecting to pmon");
return 1;
}
if (false_ack)
ack += 42;
if (false_unsubscribe) {
ack += 42;
count = 0;
}
if (disable_enable)
count += 10;
if (no_kick) {
count = 0;
usleep(tmo * 1000);
}
log("Starting test loop:\n"
"\tcount : %d\n"
"\tfalse ack : %d\n"
"\tfalse unsubscribe : %d\n"
"\tdisable enable : %d\n"
"\tno kick : %d\n"
"\tpremature trigger : %d\n", count, false_ack, false_unsubscribe,
disable_enable, no_kick, premature);
while (count-- > 0) {
log("Sleeping %d msec", tmo / 2);
usleep(tmo / 2 * 1000);
log("Kicking watchdog: id %d, ack %d", id, ack);
if (wdog_pmon_kick(id, &ack))
err(1, "Failed kicking");
if (count == 8)
wdog_enable(0);
if (count == 4)
wdog_enable(1);
if (failed_kick)
ack += 42;
if (premature)
usleep(tmo / 2 * 1000 - 500000);
}
log("Unsubscribing: id %d, ack %d", id, ack);
if (wdog_pmon_unsubscribe(id, ack))
err(1, "Failed unsubscribe");
return 0;
}
int main(void)
{
/* Simulate a compal loader saying "ACK" */
int i = 0;
for (i = 0; i < sizeof(phone_ack); i++) {
putchar_asm(phone_ack[i]);
}
/* Always disable wdt (some platforms enable it on boot) */
wdog_enable(0);
/* Disable the bootrom mapping */
calypso_bootrom(0);
/* Initialize TWL3025 for power control */
twl3025_init();
/* Backlight */
bl_mode_pwl(1);
bl_level(50);
/* Initialize UART without interrupts */
uart_init(SERCOMM_UART_NR, 0);
uart_baudrate(SERCOMM_UART_NR, UART_115200);
/* Initialize HDLC subsystem */
sercomm_init();
/* Say hi */
puts("\n\nOSMOCOM Loader (revision " GIT_REVISION ")\n");
puts(hr);
/* Identify environment */
printf("Running on %s in environment %s\n", manifest_board,
manifest_environment);
/* Initialize flash driver */
if (flash_init(&the_flash, 0)) {
puts("Failed to initialize flash!\n");
} else {
printf("Found flash of %d bytes at 0x%x with %d regions\n",
the_flash.f_size, the_flash.f_base,
the_flash.f_nregions);
int i;
for (i = 0; i < the_flash.f_nregions; i++) {
printf(" Region %d of %d pages with %d bytes each.\n",
i,
the_flash.f_regions[i].fr_bnum,
the_flash.f_regions[i].fr_bsize);
}
}
/* Set up a key handler for powering off */
keypad_set_handler(&key_handler);
/* Set up loader communications */
sercomm_register_rx_cb(SC_DLCI_LOADER, &cmd_handler);
/* Notify any running osmoload about our startup */
loader_send_init(SC_DLCI_LOADER);
/* Wait for events */
while (1) {
keypad_poll();
uart_poll(SERCOMM_UART_NR);
}
/* NOT REACHED */
twl3025_power_off();
}
