307 lines
7.6 KiB
C++
307 lines
7.6 KiB
C++
/*
|
|
* Authors (alphabetical order)
|
|
* - Andre Bernet <bernet.andre@gmail.com>
|
|
* - Andreas Weitl
|
|
* - Bertrand Songis <bsongis@gmail.com>
|
|
* - Bryan J. Rentoul (Gruvin) <gruvin@gmail.com>
|
|
* - Cameron Weeks <th9xer@gmail.com>
|
|
* - Erez Raviv
|
|
* - Gabriel Birkus
|
|
* - Jean-Pierre Parisy
|
|
* - Karl Szmutny
|
|
* - Michael Blandford
|
|
* - Michal Hlavinka
|
|
* - Pat Mackenzie
|
|
* - Philip Moss
|
|
* - Rob Thomson
|
|
* - Romolo Manfredini <romolo.manfredini@gmail.com>
|
|
* - Thomas Husterer
|
|
*
|
|
* opentx is based on code named
|
|
* gruvin9x by Bryan J. Rentoul: http://code.google.com/p/gruvin9x/,
|
|
* er9x by Erez Raviv: http://code.google.com/p/er9x/,
|
|
* and the original (and ongoing) project by
|
|
* Thomas Husterer, th9x: http://code.google.com/p/th9x/
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
*/
|
|
|
|
#include "opentx.h"
|
|
|
|
uint8_t currentSpeakerVolume = 255;
|
|
uint8_t requiredSpeakerVolume = 255;
|
|
uint8_t requestScreenshot = false;
|
|
|
|
void handleUsbConnection()
|
|
{
|
|
#if defined(PCBTARANIS) && !defined(SIMU)
|
|
static bool usbStarted = false;
|
|
|
|
if (!usbStarted && usbPlugged()) {
|
|
usbStarted = true;
|
|
|
|
/*
|
|
We used to initialize USB peripheral and driver here.
|
|
According to my tests this is way too late. The USB peripheral
|
|
therefore does not have enough information to start responding to
|
|
USB host request, which causes very slow USB device recognition,
|
|
multiple USB device resets, etc...
|
|
|
|
If we want to change the USB profile, the procedure is simple:
|
|
* USB cable must be disconnected
|
|
* call usbDeInit();
|
|
* call usbUnit(); which initializes USB with the new profile.
|
|
Obviously the usbInit() should be modified to have a runtime
|
|
selection of the USB profile.
|
|
*/
|
|
|
|
#if defined(USB_MASS_STORAGE)
|
|
opentxClose();
|
|
usbPluggedIn();
|
|
#endif
|
|
}
|
|
if (usbStarted && !usbPlugged()) {
|
|
usbStarted = false;
|
|
}
|
|
|
|
#if defined(USB_JOYSTICK)
|
|
if (usbStarted ) {
|
|
usbJoystickUpdate();
|
|
}
|
|
#endif
|
|
|
|
#endif //#if defined(PCBTARANIS) && !defined(SIMU)
|
|
}
|
|
|
|
void checkSpeakerVolume()
|
|
{
|
|
if (currentSpeakerVolume != requiredSpeakerVolume) {
|
|
currentSpeakerVolume = requiredSpeakerVolume;
|
|
setVolume(currentSpeakerVolume);
|
|
}
|
|
}
|
|
|
|
#if defined(EEPROM)
|
|
void checkEeprom()
|
|
{
|
|
if (!usbPlugged()) {
|
|
if (eepromIsWriting())
|
|
eepromWriteProcess();
|
|
else if (TIME_TO_WRITE())
|
|
storageCheck(false);
|
|
}
|
|
}
|
|
#else
|
|
void checkEeprom()
|
|
{
|
|
if (TIME_TO_WRITE())
|
|
storageCheck(false);
|
|
}
|
|
#endif
|
|
|
|
#if defined(PCBFLAMENCO)
|
|
void guiMain(evt_t evt)
|
|
{
|
|
lcd_clear();
|
|
|
|
#if defined(LUA)
|
|
uint32_t t0 = get_tmr10ms();
|
|
static uint32_t lastLuaTime = 0;
|
|
uint16_t interval = (lastLuaTime == 0 ? 0 : (t0 - lastLuaTime));
|
|
lastLuaTime = t0;
|
|
if (interval > maxLuaInterval) {
|
|
maxLuaInterval = interval;
|
|
}
|
|
|
|
// run Lua scripts that don't use LCD (to use CPU time while LCD DMA is running)
|
|
luaTask(0, RUN_MIX_SCRIPT | RUN_FUNC_SCRIPT | RUN_TELEM_BG_SCRIPT, false);
|
|
|
|
// wait for LCD DMA to finish before continuing, because code from this point
|
|
// is allowed to change the contents of LCD buffer
|
|
//
|
|
// WARNING: make sure no code above this line does any change to the LCD display buffer!
|
|
//
|
|
|
|
bool scriptWasRun = luaTask(evt, RUN_STNDAL_SCRIPT, true);
|
|
|
|
t0 = get_tmr10ms() - t0;
|
|
if (t0 > maxLuaDuration) {
|
|
maxLuaDuration = t0;
|
|
}
|
|
|
|
if (!scriptWasRun)
|
|
#endif
|
|
|
|
{
|
|
// normal GUI from menus
|
|
const char *warn = s_warning;
|
|
uint8_t menu = s_menu_count;
|
|
// lcd_clear();
|
|
if (menuEvent) {
|
|
m_posVert = menuEvent == EVT_ENTRY_UP ? g_menuPos[g_menuStackPtr] : 0;
|
|
m_posHorz = 0;
|
|
evt = menuEvent;
|
|
menuEvent = 0;
|
|
AUDIO_MENUS();
|
|
}
|
|
g_menuStack[g_menuStackPtr]((warn || menu) ? 0 : evt);
|
|
if (warn) DISPLAY_WARNING(evt);
|
|
if (menu) {
|
|
const char * result = displayMenu(evt);
|
|
if (result) {
|
|
menuHandler(result);
|
|
putEvent(EVT_MENU_UP);
|
|
}
|
|
}
|
|
drawStatusLine();
|
|
}
|
|
|
|
lcdRefresh();
|
|
}
|
|
#else
|
|
void guiMain(evt_t evt)
|
|
{
|
|
#if defined(LUA)
|
|
uint32_t t0 = get_tmr10ms();
|
|
static uint32_t lastLuaTime = 0;
|
|
uint16_t interval = (lastLuaTime == 0 ? 0 : (t0 - lastLuaTime));
|
|
lastLuaTime = t0;
|
|
if (interval > maxLuaInterval) {
|
|
maxLuaInterval = interval;
|
|
}
|
|
|
|
// run Lua scripts that don't use LCD (to use CPU time while LCD DMA is running)
|
|
luaTask(0, RUN_MIX_SCRIPT | RUN_FUNC_SCRIPT | RUN_TELEM_BG_SCRIPT, false);
|
|
|
|
// wait for LCD DMA to finish before continuing, because code from this point
|
|
// is allowed to change the contents of LCD buffer
|
|
//
|
|
// WARNING: make sure no code above this line does any change to the LCD display buffer!
|
|
//
|
|
lcdRefreshWait();
|
|
|
|
// draw LCD from menus or from Lua script
|
|
// run Lua scripts that use LCD
|
|
|
|
bool standaloneScriptWasRun = luaTask(evt, RUN_STNDAL_SCRIPT, true);
|
|
bool refreshScreen = true;
|
|
if (!standaloneScriptWasRun) {
|
|
refreshScreen = !luaTask(evt, RUN_TELEM_FG_SCRIPT, true);
|
|
}
|
|
|
|
t0 = get_tmr10ms() - t0;
|
|
if (t0 > maxLuaDuration) {
|
|
maxLuaDuration = t0;
|
|
}
|
|
|
|
if (!standaloneScriptWasRun)
|
|
#else
|
|
lcdRefreshWait(); // WARNING: make sure no code above this line does any change to the LCD display buffer!
|
|
const bool refreshScreen = true;
|
|
#endif
|
|
{
|
|
#if defined(PCBHORUS)
|
|
for (int i=0; i<2; i++) {
|
|
#endif
|
|
// normal GUI from menus
|
|
const char *warn = s_warning;
|
|
uint8_t menu = s_menu_count;
|
|
#if !defined(COLORLCD)
|
|
if (refreshScreen) {
|
|
lcd_clear();
|
|
}
|
|
#endif
|
|
if (menuEvent) {
|
|
m_posVert = menuEvent == EVT_ENTRY_UP ? g_menuPos[g_menuStackPtr] : -1;
|
|
m_posHorz = 0;
|
|
evt = menuEvent;
|
|
menuEvent = 0;
|
|
AUDIO_MENUS();
|
|
}
|
|
g_menuStack[g_menuStackPtr]((warn || menu) ? 0 : evt);
|
|
if (warn) DISPLAY_WARNING(evt);
|
|
if (menu) {
|
|
const char * result = displayMenu(evt);
|
|
if (result) {
|
|
menuHandler(result);
|
|
putEvent(EVT_MENU_UP);
|
|
}
|
|
}
|
|
drawStatusLine();
|
|
#if defined(PCBHORUS)
|
|
if (menuEvent != EVT_ENTRY || menuEvent != EVT_ENTRY_UP)
|
|
break;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
lcdRefresh();
|
|
}
|
|
#endif
|
|
|
|
void perMain()
|
|
{
|
|
#if defined(PCBSKY9X) && !defined(REVA)
|
|
calcConsumption();
|
|
#endif
|
|
checkSpeakerVolume();
|
|
checkEeprom();
|
|
sdMountPoll();
|
|
writeLogs();
|
|
handleUsbConnection();
|
|
checkTrainerSettings();
|
|
checkBattery();
|
|
|
|
evt_t evt = getEvent(false);
|
|
if (evt && (g_eeGeneral.backlightMode & e_backlight_mode_keys)) backlightOn(); // on keypress turn the light on
|
|
doLoopCommonActions();
|
|
#if defined(NAVIGATION_STICKS)
|
|
uint8_t sticks_evt = getSticksNavigationEvent();
|
|
if (sticks_evt) evt = sticks_evt;
|
|
#endif
|
|
|
|
#if defined(USB_MASS_STORAGE)
|
|
if (usbPlugged()) {
|
|
// disable access to menus
|
|
lcd_clear();
|
|
menuMainView(0);
|
|
lcdRefresh();
|
|
return;
|
|
}
|
|
#endif
|
|
|
|
#if defined(GUI)
|
|
guiMain(evt);
|
|
#endif
|
|
|
|
#if defined(PCBTARANIS)
|
|
if (requestScreenshot) {
|
|
requestScreenshot = false;
|
|
writeScreenshot();
|
|
}
|
|
#endif
|
|
|
|
#if defined(PCBTARANIS) && defined(REV9E) && !defined(SIMU)
|
|
topLcdRefreshStart();
|
|
setTopFirstTimer(getValue(MIXSRC_FIRST_TIMER+g_model.topLcdTimer));
|
|
setTopSecondTimer(g_eeGeneral.globalTimer + sessionTimer);
|
|
setTopRssi(TELEMETRY_RSSI());
|
|
setTopBatteryValue(g_vbat100mV);
|
|
setTopBatteryState(GET_TXBATT_BARS(), IS_TXBATT_WARNING());
|
|
topLcdRefreshEnd();
|
|
#endif
|
|
|
|
#if defined(PCBTARANIS) && defined(REV9E) && !defined(SIMU)
|
|
bluetoothWakeup();
|
|
#endif
|
|
|
|
}
|