int main() {
PWR_Init();
CLOCK_Init();
UART_Initialize();
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
dump_bootloader();
}
static void wait_release()
{
printf("Wait Release\n");
while(1) {
CLOCK_ResetWatchdog();
u32 buttons = ScanButtons();
if (! CHAN_ButtonIsPressed(buttons, BUT_ENTER))
break;
if(PWR_CheckPowerSwitch())
PWR_Shutdown();
}
printf("Released\n");
}
void EventLoop()
{
CLOCK_ResetWatchdog();
unsigned int time;
#ifdef HEAP_DEBUG
static int heap = 0;
int h = _sbrk_r(NULL, 0);
if(h > heap) {
printf("heap: %x\n", h);
heap = h;
}
#endif
#ifdef TIMING_DEBUG
debug_timing(0, 0);
#endif
priority_ready &= ~(1 << MEDIUM_PRIORITY);
if(PWR_CheckPowerSwitch()) {
if(! (BATTERY_Check() & BATTERY_CRITICAL)) {
CONFIG_SaveModelIfNeeded();
CONFIG_SaveTxIfNeeded();
}
if(Transmitter.music_shutdown) {
MUSIC_Play(MUSIC_SHUTDOWN);
// We wait ~1sec for shutdown music finished
time = CLOCK_getms()+700;
while(CLOCK_getms()<time);
}
PWR_Shutdown();
}
BUTTON_Handler();
TOUCH_Handler();
if (priority_ready & (1 << LOW_PRIORITY)) {
priority_ready &= ~(1 << LOW_PRIORITY);
PAGE_Event();
PROTOCOL_CheckDialogs();
TIMER_Update();
TELEMETRY_Alarm();
BATTERY_Check();
AUTODIMMER_Update();
#if DATALOG_ENABLED
DATALOG_Update();
#endif
GUI_RefreshScreen();
}
#ifdef TIMING_DEBUG
debug_timing(0, 1);
#endif
}
void debug_buttons()
{
u32 data = ScanButtons();
while(1) {
u32 val = ScanButtons();
u32 delta = val ^ data;
for(int i = 1; i < BUT_LAST; i++) {
if(delta & (1 << (i-1))) {
printf("%s(%s) ", INPUT_ButtonName(i), (val &(1 << (i-1)))? "Down" : "Up");
}
}
if (delta) {
printf("\n");
data = val;
}
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
}
}
static void calibrate_sticks(void)
{
// bug fix: should turn of safety dialog during calibrating, or it might fail when stick is not calibrated and safety setting is on
PAGE_DisableSafetyDialog(1);
PROTOCOL_DeInit();
PAGE_SetModal(1);
PAGE_RemoveAllObjects();
PAGE_SetActionCB(_action_cb_calibrate);
snprintf(tempstring, sizeof(tempstring), "%s", _tr("Center all \nsticks and knobs\nthen press ENT"));
GUI_CreateLabelBox(&guic->msg, 1, 10, LCD_WIDTH -1, LCD_HEIGHT - 10,
LCD_HEIGHT > 70? &NARROW_FONT:&DEFAULT_FONT, NULL, NULL, tempstring);
memcpy(cp->calibration, Transmitter.calibration, sizeof(cp->calibration));
while(1) {
CLOCK_ResetWatchdog();
if(PWR_CheckPowerSwitch())
PWR_Shutdown();
if(priority_ready & (1 << MEDIUM_PRIORITY)) {
BUTTON_Handler();
priority_ready &= ~(1 << MEDIUM_PRIORITY);
}
if(priority_ready & (1 << LOW_PRIORITY)) {
//Only sample every 100msec
GUI_RefreshScreen();
priority_ready = 0;
}
for (u8 i = 0; i < INP_HAS_CALIBRATION; i++) {
s32 value = CHAN_ReadRawInput(i + 1);
if (value > Transmitter.calibration[i].max)
Transmitter.calibration[i].max = value;
else if (value < Transmitter.calibration[i].min)
Transmitter.calibration[i].min = value;
}
if (calibrate_state == CALI_SUCCESSEXIT || calibrate_state == CALI_EXIT)
break;
}
if (calibrate_state == CALI_EXIT)
memcpy(Transmitter.calibration, cp->calibration, sizeof(cp->calibration));
PAGE_SetActionCB(NULL);
PROTOCOL_Init(0);
PAGE_TxConfigureInit(-1); // should be -1 so that devo10 can get back to previous item selection
PAGE_DisableSafetyDialog(0);
}
void PAGE_CalibInit(int page)
{
(void)page;
PROTOCOL_DeInit();
PAGE_SetActionCB(_action_cb_calibrate);
snprintf(tempstring, sizeof(tempstring), "%s", _tr("Center all \nsticks and knobs\nthen press ENT"));
GUI_CreateLabelBox(&guic->msg, 1, CALIB_Y, 0, 0,
LCD_HEIGHT > 70? &NARROW_FONT:&DEFAULT_FONT, NULL, NULL, tempstring);
memcpy(cp->calibration, Transmitter.calibration, sizeof(cp->calibration));
while(1) {
CLOCK_ResetWatchdog();
if(PWR_CheckPowerSwitch())
PWR_Shutdown();
if(priority_ready & (1 << MEDIUM_PRIORITY)) {
BUTTON_Handler();
priority_ready &= ~(1 << MEDIUM_PRIORITY);
}
if(priority_ready & (1 << LOW_PRIORITY)) {
//Only sample every 100msec
GUI_RefreshScreen();
priority_ready = 0;
}
for (u8 i = 0; i < INP_HAS_CALIBRATION; i++) {
s32 value = CHAN_ReadRawInput(i + 1);
if (value > Transmitter.calibration[i].max)
Transmitter.calibration[i].max = value;
else if (value < Transmitter.calibration[i].min)
Transmitter.calibration[i].min = value;
}
if (calibrate_state == CALI_SUCCESSEXIT || calibrate_state == CALI_EXIT)
break;
}
if (calibrate_state == CALI_EXIT)
memcpy(Transmitter.calibration, cp->calibration, sizeof(cp->calibration));
PAGE_Pop();
// PAGE_SetActionCB(NULL);
// PROTOCOL_Init(0);
// PAGE_SetModal(0);
// //cp->enable = CALIB_NONE;
// PAGE_ChangeByID(PAGEID_TXCFG, 0);
}
void debug_switches()
{
s32 data[INP_LAST];
for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) {
data[i] = CHAN_ReadRawInput(i);
}
while(1) {
u32 changed = 0;
for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) {
s32 val = CHAN_ReadRawInput(i);
if (val != data[i]) {
printf("%s=%d ", INPUT_SourceName(tempstring, i), val);
data[i] = val;
changed = 1;
}
}
if (changed) { printf("\n"); }
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
}
}
int main() {
PWR_Init();
CLOCK_Init();
UART_Initialize();
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
#if SPI_BOOTLOADER
Initialize_ButtonMatrix();
SPIFlash_Init(); //This must come before LCD_Init() for 7e
SPI_FlashBlockWriteEnable(1); //Enable writing to all banks of SPIFlash
LCD_Init();
LCD_Clear(0x0000);
BACKLIGHT_Init();
BACKLIGHT_Brightness(5);
LCD_SetFont(0);
LCD_SetFontColor(0xffff);
dump_bootloader(0);
#else
dump_bootloader(1);
#endif
}
int main() {
Init();
#ifndef MODULAR
//Banner();
#endif
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
LCD_Clear(0x0000);
#ifdef TEST_ADC
ADC_ScanChannels(); while(1);
#endif
u32 buttons = ScanButtons();
if(CHAN_ButtonIsPressed(buttons, BUT_ENTER) || !FS_Mount(NULL, NULL)) {
LCD_DrawUSBLogo(LCD_WIDTH, LCD_HEIGHT);
USB_Connect();
LCD_Clear(0x0000);
FS_Mount(NULL, NULL);
}
CONFIG_LoadTx();
SPI_ProtoInit();
CONFIG_ReadDisplay();
CONFIG_ReadModel(CONFIG_GetCurrentModel());
CONFIG_ReadLang(Transmitter.language);
BACKLIGHT_Brightness(Transmitter.backlight);
LCD_Contrast(Transmitter.contrast);
LCD_SetFont(DEFAULT_FONT.font);
LCD_SetFontColor(DEFAULT_FONT.font_color);
#if !HAS_EXTENDED_AUDIO
// If Extended Audio is present, move startup msg to Splash page to allow additional audio hardware initialization time
MUSIC_Play(MUSIC_STARTUP);
#else
if (Transmitter.splash_delay < 5)
MUSIC_Play(MUSIC_STARTUP); // if no splash page startup msg is used force playing here
#endif
GUI_HandleButtons(1);
MIXER_Init();
PAGE_Init();
CLOCK_StartWatchdog();
#if HAS_DATALOG
DATALOG_Init();
#endif
priority_ready = 0;
CLOCK_SetMsecCallback(LOW_PRIORITY, LOW_PRIORITY_MSEC);
CLOCK_SetMsecCallback(MEDIUM_PRIORITY, MEDIUM_PRIORITY_MSEC);
// We need to wait until we've actually measured the ADC before proceeding
while(! (priority_ready & (1 << LOW_PRIORITY)))
;
//Only do this after we've initialized all channel data so the saftey works
PROTOCOL_InitModules();
GUI_DrawScreen();
#ifdef HAS_EVENT_LOOP
start_event_loop();
#else
while(1) {
if(priority_ready) {
EventLoop();
}
//This does not appear to have any impact on power
//and has been disabled in common/devo/power.c
//but it helps a huge amount for the emulator
PWR_Sleep();
}
#endif
}
int main() {
Init();
#ifndef MODULAR
//Banner();
#endif
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
LCD_Clear(0x0000);
#ifdef TEST_ADC
ADC_ScanChannels(); while(1);
#endif
u32 buttons = ScanButtons();
if(CHAN_ButtonIsPressed(buttons, BUT_ENTER) || !FS_Mount(NULL, NULL)) {
LCD_DrawUSBLogo(LCD_WIDTH, LCD_HEIGHT);
USB_Connect();
LCD_Clear(0x0000);
FS_Mount(NULL, NULL);
}
CONFIG_LoadTx();
SPI_ProtoInit();
CONFIG_ReadDisplay();
CONFIG_ReadModel(CONFIG_GetCurrentModel());
CONFIG_ReadLang(Transmitter.language);
BACKLIGHT_Brightness(Transmitter.brightness);
LCD_Contrast(Transmitter.contrast);
LCD_SetFont(DEFAULT_FONT.font);
LCD_SetFontColor(DEFAULT_FONT.font_color);
MUSIC_Play(MUSIC_STARTUP);
GUI_HandleButtons(1);
MIXER_Init();
PAGE_Init();
CLOCK_StartWatchdog();
#if DATALOG_ENABLED
DATALOG_Init();
#endif
priority_ready = 0;
CLOCK_SetMsecCallback(LOW_PRIORITY, LOW_PRIORITY_MSEC);
CLOCK_SetMsecCallback(MEDIUM_PRIORITY, MEDIUM_PRIORITY_MSEC);
// We need to wait until we've actually measured the ADC before proceeding
while(! (priority_ready & (1 << LOW_PRIORITY)))
;
//Only do this after we've initialized all channel data so the saftey works
PROTOCOL_Init(0);
GUI_DrawScreen();
#ifdef HAS_EVENT_LOOP
start_event_loop();
#else
while(1) {
if(priority_ready) {
EventLoop();
}
//PWR_Sleep(); //This does not appear to have any impact on power
}
#endif
}
int main() {
Init();
#ifndef ENABLE_MODULAR
//Banner();
#endif
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
LCD_Clear(0x0000);
#ifdef TEST_ADC
ADC_ScanChannels(); while(1);
#endif
u32 buttons = ScanButtons();
if (CHAN_ButtonIsPressed(buttons, BUT_ENTER) || !FS_Init()) {
LCD_DrawUSBLogo(LCD_WIDTH, LCD_HEIGHT);
USB_Connect();
LCD_Clear(0x0000);
FS_Init();
}
CONFIG_LoadTx();
SPI_ProtoInit();
CONFIG_ReadDisplay();
CONFIG_ReadModel(CONFIG_GetCurrentModel());
CONFIG_ReadLang(Transmitter.language);
BACKLIGHT_Brightness(Transmitter.backlight);
LCD_Contrast(Transmitter.contrast);
LCD_SetFont(DEFAULT_FONT.font);
LCD_SetFontColor(DEFAULT_FONT.font_color);
GUI_HandleButtons(1);
MIXER_Init();
PAGE_Init();
CLOCK_StartWatchdog();
#if HAS_DATALOG
DATALOG_Init();
#endif
priority_ready = 0;
CLOCK_SetMsecCallback(LOW_PRIORITY, LOW_PRIORITY_MSEC);
CLOCK_SetMsecCallback(MEDIUM_PRIORITY, MEDIUM_PRIORITY_MSEC);
// We need to wait until we've actually measured the ADC before proceeding
while(! (priority_ready & (1 << LOW_PRIORITY)))
PWR_Sleep();
//Only do this after we've initialized all channel data so the saftey works
PROTOCOL_InitModules();
GUI_DrawScreen();
// Add startup delay to make sure audio player is initialized
// AUDIO_Init() has already been called by CONFIG_ReadModel()
#if HAS_EXTENDED_AUDIO
audio_queue_time = CLOCK_getms() + 1500;
num_audio=1;
next_audio=1;
#if (LCD_WIDTH == 480) || (LCD_WIDTH == 320)
if(Display.background.drawn_background)
while(CLOCK_getms() < audio_queue_time - 1200);
#endif
AUDIO_SetVolume(); // Initial setting of voice volume
#endif
MUSIC_Play(MUSIC_STARTUP);
#ifdef HAS_EVENT_LOOP
start_event_loop();
#else
while(1) {
if(priority_ready) {
EventLoop();
}
//This does not appear to have any impact on power
//and has been disabled in common/devo/power.c
//but it helps a huge amount for the emulator
PWR_Sleep();
}
#endif
}
void EventLoop()
{
CLOCK_ResetWatchdog();
#ifdef HEAP_DEBUG
static int heap = 0;
int h = _sbrk_r(NULL, 0);
if(h > heap) {
printf("heap: %x\n", h);
heap = h;
}
#endif
#ifdef TIMING_DEBUG
debug_timing(0, 0);
#endif
priority_ready &= ~(1 << MEDIUM_PRIORITY);
#if !HAS_HARD_POWER_OFF
if(PWR_CheckPowerSwitch()) {
if(! (BATTERY_Check() & BATTERY_CRITICAL)) {
PAGE_Test();
CONFIG_SaveModelIfNeeded();
CONFIG_SaveTxIfNeeded();
}
if(Transmitter.music_shutdown) {
#if HAS_EXTENDED_AUDIO
if(AUDIO_VoiceAvailable()) {
MUSIC_Play(MUSIC_SHUTDOWN);
while (CLOCK_getms() < audio_queue_time) {
// Wait for voice to finished
CLOCK_ResetWatchdog();
}
} else {
#else
{
// We wait ~1sec for shutdown buzzer music finished
unsigned int time;
MUSIC_Play(MUSIC_SHUTDOWN);
time = CLOCK_getms()+700;
while (CLOCK_getms() < time) {
CLOCK_ResetWatchdog();
}
#endif
}
}
PWR_Shutdown();
}
#endif
BUTTON_Handler();
TOUCH_Handler();
INPUT_CheckChanges();
if (priority_ready & (1 << LOW_PRIORITY)) {
priority_ready &= ~(1 << LOW_PRIORITY);
PAGE_Event();
PROTOCOL_CheckDialogs();
TIMER_Update();
TELEMETRY_Alarm();
BATTERY_Check();
AUTODIMMER_Update();
#if HAS_DATALOG
DATALOG_Update();
#endif
#if HAS_VIDEO
VIDEO_Update();
#endif
#if HAS_EXTENDED_AUDIO
AUDIO_CheckQueue();
#endif
GUI_RefreshScreen();
#if HAS_HARD_POWER_OFF
if (PAGE_ModelDoneEditing())
CONFIG_SaveModelIfNeeded();
CONFIG_SaveTxIfNeeded();
#endif
}
#ifdef TIMING_DEBUG
debug_timing(0, 1);
#endif
}
void TOUCH_Handler() {
if(! HAS_TOUCH)
return;
u32 pen_down=0;
static u32 pen_down_last=0;
static u32 pen_down_long_at=0;
struct touch t;
if(SPITouch_IRQ()) {
pen_down=1;
t=SPITouch_GetCoords();
if (! pen_down_last)
pen_down_long_at=CLOCK_getms()+500;
} else {
pen_down=0;
}
if(pen_down && (!pen_down_last)) {
AUTODIMMER_Check();
GUI_CheckTouch(&t, 0);
}
if(!pen_down && pen_down_last) {
GUI_TouchRelease();
}
if(pen_down && pen_down_last) {
if(CLOCK_getms()>pen_down_long_at) {
GUI_CheckTouch(&t, 1);
pen_down_long_at += 100;
}
}
pen_down_last=pen_down;
}
#if HAS_VIDEO
void VIDEO_Update()
{
static u8 video_enable = 0;
static u32 check_standard_ms = 0;
// Check if Video is turn on
int enabled = MIXER_SourceAsBoolean(Model.videosrc);
if (enabled != video_enable) {
VIDEO_Enable(enabled);
video_enable = enabled;
if (enabled) {
VIDEO_SetChannel(Model.videoch);
VIDEO_Contrast(Model.video_contrast);
VIDEO_Brightness(Model.video_brightness);
check_standard_ms = CLOCK_getms() + 3000;
}
else
check_standard_ms = 0;
}
if(video_enable &&
check_standard_ms > 0
&& check_standard_ms < CLOCK_getms()) {
u8 video_standard_current = VIDEO_GetStandard();
if((video_standard_current > 0) &&
(video_standard_current < 8)) {
VIDEO_SetStandard(video_standard_current);
check_standard_ms = 0;
}
else {
check_standard_ms = CLOCK_getms() + 3000;
}
}
if(video_enable)
AUTODIMMER_Check();
}
#endif //HAS_VIDEO
#ifdef TIMING_DEBUG
void debug_timing(u32 type, int startend)
{
static u32 last_time[2][100];
static u32 loop_time[4][101];
static u32 loop_pos[4] = {-1, -1, -1, -1};
static u32 max_last[2];
static u32 max_loop[4];
static int save_priority;
if (type == 0) {
if (! startend)
save_priority = priority_ready;
if (save_priority & (1 << MEDIUM_PRIORITY))
debug_timing(2, startend);
if (save_priority & (1 << LOW_PRIORITY))
debug_timing(1, startend);
return;
}
type--;
if (! startend) {
u32 t = CLOCK_getms();
loop_pos[type] = (loop_pos[type] + 1) % 100;
if (type < 2) {
last_time[type][loop_pos[type]] = t;
if (t - last_time[type][(loop_pos[type] + 99) % 100] > max_last[type])
max_last[type] = t - last_time[type][(loop_pos[type] + 99) % 100];
}
loop_time[type][100] = t;
} else {
loop_time[type][loop_pos[type]] = CLOCK_getms() - loop_time[type][100];
if (loop_time[type][loop_pos[type]] > max_loop[type])
max_loop[type] = loop_time[type][loop_pos[type]];
if (type == 0 && loop_pos[0] == 99) {
unsigned avg_loop[4] = {0, 0, 0, 0};
unsigned avg_last[2] = {0, 0};
for(int i = 0; i < 99; i++) {
for(int t = 0; t < 2; t++) {
u32 delay = last_time[t][(i + loop_pos[t] + 2) % 100] - last_time[t][(i + loop_pos[t] + 1) % 100];
avg_last[t] += delay;
}
for(int t = 0; t < 4; t++)
avg_loop[t] += loop_time[t][i];
}
for(int t = 0; t < 4; t++)
avg_loop[t] /= 99;
avg_last[0] /= 99;
avg_last[1] /= 99;
printf("Avg: radio: %d mix: %d med: %d/%d low: %d/%d\n", avg_loop[3], avg_loop[2], avg_loop[1], avg_last[1], avg_loop[0], avg_last[0]);
printf("Max: radio: %d mix: %d med: %d/%d low: %d/%d\n", max_loop[3], max_loop[2], max_loop[1], max_last[1], max_loop[0], max_last[0]);
memset(max_loop, 0, sizeof(max_loop));
max_last[0] = 0;
max_last[1] = 0;
}
}
}
#endif
void debug_switches()
{
s32 data[INP_LAST];
for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) {
data[i] = CHAN_ReadRawInput(i);
}
while(1) {
u32 changed = 0;
for(int i = INP_HAS_CALIBRATION+1; i < INP_LAST; i++) {
s32 val = CHAN_ReadRawInput(i);
if (val != data[i]) {
printf("%s=%d ", INPUT_SourceName(tempstring, i), val);
data[i] = val;
changed = 1;
}
}
if (changed) { printf("\n"); }
if(PWR_CheckPowerSwitch()) PWR_Shutdown();
}
}
