void tpl_shutdown(void)
{
/* Enable interrupts because disabled bu ShutdownOS and we
need them to shutdown the NXT */
ENABLE_FIQ();
ENABLE_IRQ();
ecrobot_term_bt_connection(); /* shutdown bluetooth connection */
display_clear(1);
systick_wait_ms(10);
nxt_lcd_power_down(); /* reset LCD hardware */
systick_wait_ms(10);
while(1)
{
nxt_avr_power_down();
}
}
SINT main(void)
{
#ifdef NO_RUN_ENTER_STOP_EXIT
init_OS_flag(); /* this should be called before device init */
nxt_device_init();
ecrobot_initDeviceStatus(); // added 10/28/2010 to fix a bug by tchikama
ecrobot_init_nxtstate();
if (execution_mode() == EXECUTED_FROM_FLASH)
{
/*
* Call buttons_get() because ecrobot_get_button_state() has button bouncer.
* The button bouncer requires multiple periodical calls to make it work, but
* in this case, only single call (no while loop), so buttons_get is called.
*/
if ((buttons_get() & 0x0F) == (ENTER_PRESSED | STOP_PRESSED))
{
/* set flash request and shut down the NXT
* at the next start, NXT BIOS will be executed.
*/
display_clear(0);
display_goto_xy(0, 0);
display_string("PWR ON: NXT BIOS");
display_update();
systick_wait_ms(1000);
set_flash_request();
display_clear(1);
systick_wait_ms(10);
nxt_lcd_power_down(); /* reset LCD hardware */
systick_wait_ms(10);
while(1)
{
nxt_avr_power_down();
}
}
}
/* device init should be called prior to running the application */
ecrobot_device_initialize();
ecrobot_setDeviceInitialized();
nxt_motor_set_count(NXT_PORT_A, 0);
nxt_motor_set_count(NXT_PORT_B, 0);
nxt_motor_set_count(NXT_PORT_C, 0);
cpp_constructor();
display_clear(1);
systick_wait_ms(10);
#ifdef NXT_JSP
interrupts_get_and_disable();
#else
disable_int(); /* set_OS_flag and Start OS have to be atomic */
#endif
set_OS_flag(); /* this shoud be called before starting OS */
#ifdef NXT_JSP
lejos_osek_run(); /* start TOPPERS JSP */
#else
StartOS(1); /* start TOPPERS OSEK */
#endif
/* never reached here */
#else
/*
* Default start up sequence
*/
U32 st;
U32 last_act_time = 0;
U32 flash_req_cnt = 0;
init_OS_flag(); /* this should be called before device init */
nxt_device_init();
ecrobot_initDeviceStatus(); // added 10/28/2010 to fix a bug by tchikama
ecrobot_init_nxtstate();
show_splash_screen();
show_main_screen();
display_status_bar(1); /* clear status bar */
add_status_info(execution_mode());
display_status_bar(0); /* update status bar */
while(1)
{
/* device init should be called prior to running the application */
ecrobot_device_initialize();
ecrobot_setDeviceInitialized();
/* check the buttons every 10msec */
st = systick_get_ms();
if (st >= last_act_time + 10)
{
last_act_time = st;
ecrobot_poll_nxtstate();
display_status_bar(0);
/*
* executed in FLASH: setup for the application flash
* executed in SRAM: no effect
*/
if ((ecrobot_get_button_state() == (ENTER_PRESSED | STOP_PRESSED)) &&
(execution_mode() == EXECUTED_FROM_FLASH))
{
flash_req_cnt++;
/* keep pusing ENTER + STOP buttons more than 1000msec */
if (flash_req_cnt >= 100)
{
/* set flash request and shut down the NXT
* at the next start, NXT BIOS will be executed.
*/
ecrobot_device_terminate();
set_flash_request();
display_clear(1);
systick_wait_ms(10);
nxt_lcd_power_down(); /* reset LCD hardware */
systick_wait_ms(10);
while(1)
{
nxt_avr_power_down();
}
}
}
else
{
flash_req_cnt = 0;
if ((ecrobot_get_button_state() == EXIT_PRESSED) || (systick_get_ms() > SLEEP_TIME))
{
/* shut down the NXT */
ecrobot_device_terminate();
display_clear(1);
systick_wait_ms(10);
nxt_lcd_power_down(); /* reset LCD hardware */
systick_wait_ms(10);
while(1)
{
nxt_avr_power_down();
}
}
else if (ecrobot_get_button_state() == RUN_PRESSED)
{
nxt_motor_set_count(NXT_PORT_A, 0);
nxt_motor_set_count(NXT_PORT_B, 0);
nxt_motor_set_count(NXT_PORT_C, 0);
cpp_constructor();
display_clear(1);
systick_wait_ms(10);
#ifdef NXT_JSP
interrupts_get_and_disable();
#else
disable_int(); /* set_OS_flag and Start OS have to be atomic */
#endif
set_OS_flag(); /* this shoud be called before starting OS */
#ifdef NXT_JSP
lejos_osek_run(); /* start TOPPERS JSP */
#else
StartOS(1); /* start TOPPERS OSEK */
#endif
/* never reached here */
}
}
}
}
#endif
return 0;
}
