352 lines
10 KiB
C++
352 lines
10 KiB
C++
/*
|
|
* Author - Bertrand Songis <bsongis@gmail.com>
|
|
*
|
|
* Based on 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 "opentxTaranisSimulator.h"
|
|
#include "opentxinterface.h"
|
|
#include "appdata.h"
|
|
|
|
#define SIMU
|
|
#define SIMU_EXCEPTIONS
|
|
#define PCBTARANIS
|
|
#define CPUARM
|
|
#define CPUSTM32
|
|
#define GUI
|
|
#define HELI
|
|
#define SPLASH
|
|
#define FLIGHT_MODES
|
|
#define FRSKY
|
|
#define FRSKY_HUB
|
|
#define FRSKY_SPORT
|
|
#define GPS
|
|
#define VARIO
|
|
#define GAUGES
|
|
#define PPM_UNIT_PERCENT_PREC1
|
|
#define AUDIO
|
|
#define VOICE
|
|
#define PXX
|
|
#define DSM2
|
|
#define DSM2_PPM
|
|
#define DBLKEYS
|
|
#define AUTOSWITCH
|
|
#define GRAPHICS
|
|
#define SDCARD
|
|
#define RTCLOCK
|
|
#define VIRTUALINPUTS
|
|
#define CURVES
|
|
#define XCURVES
|
|
#define GVARS
|
|
#define BOLD_FONT
|
|
#define PPM_CENTER_ADJUSTABLE
|
|
#define PPM_LIMITS_SYMETRICAL
|
|
#define FAI_CHOICE
|
|
#define LUA
|
|
#define LUA_MODEL_SCRIPTS
|
|
#define HAPTIC
|
|
#define REVPLUS
|
|
#define OVERRIDE_CHANNEL_FUNCTION
|
|
#define TIMERS 3
|
|
#define THRTRACE
|
|
|
|
#define EEPROM_VARIANT 3
|
|
#define FLAVOUR "taranis-plus"
|
|
|
|
#undef min
|
|
#undef max
|
|
|
|
#include <exception>
|
|
|
|
namespace Open9xX9D {
|
|
|
|
int taranisSimulatorBoard = 0;
|
|
inline int geteepromsize() {
|
|
return 32*1024;
|
|
}
|
|
#define EESIZE geteepromsize()
|
|
|
|
#include "radio/src/targets/taranis/board_taranis.cpp"
|
|
#include "radio/src/pulses/ppm_arm.cpp"
|
|
#include "radio/src/pulses/pxx_arm.cpp"
|
|
#include "radio/src/pulses/dsm2_arm.cpp"
|
|
#include "radio/src/eeprom_common.cpp"
|
|
#include "radio/src/eeprom_conversions.cpp"
|
|
#include "radio/src/eeprom_rlc.cpp"
|
|
#include "radio/src/opentx.cpp"
|
|
#include "radio/src/debug.cpp"
|
|
#include "radio/src/main_arm.cpp"
|
|
#include "radio/src/strhelpers.cpp"
|
|
#include "radio/src/switches.cpp"
|
|
#include "radio/src/functions.cpp"
|
|
#include "radio/src/curves.cpp"
|
|
#include "radio/src/mixer.cpp"
|
|
#include "radio/src/sdcard.cpp"
|
|
#include "radio/src/timers.cpp"
|
|
#include "radio/src/targets/taranis/pulses_driver.cpp"
|
|
#include "radio/src/targets/taranis/rtc_driver.cpp"
|
|
#include "radio/src/targets/taranis/trainer_driver.cpp"
|
|
#include "radio/src/targets/taranis/uart3_driver.cpp"
|
|
#include "radio/src/pulses/pulses_arm.cpp"
|
|
#include "radio/src/tasks_arm.cpp"
|
|
#include "radio/src/stamp.cpp"
|
|
#include "radio/src/maths.cpp"
|
|
#include "radio/src/vario.cpp"
|
|
#include "radio/src/gui/Taranis/widgets.cpp"
|
|
#include "radio/src/gui/Taranis/navigation.cpp"
|
|
#include "radio/src/gui/Taranis/popups.cpp"
|
|
#include "radio/src/gui/Taranis/helpers.cpp"
|
|
#include "radio/src/gui/Taranis/menus.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_select.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_setup.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_heli.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_flightmodes.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_inputs_mixes.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_curves.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_logical_switches.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_custom_functions.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_custom_scripts.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_gvars.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_limits.cpp"
|
|
#include "radio/src/gui/Taranis/menu_model_telemetry.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_setup.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_sdmanager.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_trainer.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_version.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_diagkeys.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_diaganas.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_hardware.cpp"
|
|
#include "radio/src/gui/Taranis/menu_general_calib.cpp"
|
|
#include "radio/src/gui/Taranis/view_main.cpp"
|
|
#include "radio/src/gui/Taranis/view_statistics.cpp"
|
|
#include "radio/src/gui/Taranis/view_channels.cpp"
|
|
#include "radio/src/gui/Taranis/view_telemetry.cpp"
|
|
#include "radio/src/gui/Taranis/view_text.cpp"
|
|
#include "radio/src/gui/Taranis/view_about.cpp"
|
|
#include "radio/src/gui/Taranis/lcd.cpp"
|
|
#include "radio/src/gui/Taranis/splash.cpp"
|
|
#include "radio/src/logs.cpp"
|
|
#include "radio/src/rtc.cpp"
|
|
#include "radio/src/targets/taranis/keys_driver.cpp"
|
|
#include "radio/src/keys.cpp"
|
|
#include "radio/src/bmp.cpp"
|
|
#include "radio/src/haptic.cpp"
|
|
#include "radio/src/sbus.cpp"
|
|
#include "radio/src/targets/taranis/haptic_driver.cpp"
|
|
// TODO Because FatFS in not C++ there cannot be namespaces there and the functions are defined several times!
|
|
#undef SDCARD
|
|
#include "radio/src/targets/simu/simpgmspace.cpp"
|
|
#define SDCARD
|
|
#include "radio/src/translations.cpp"
|
|
#include "radio/src/gui/Taranis/fonts.cpp"
|
|
#include "radio/src/telemetry/telemetry.cpp"
|
|
#include "radio/src/telemetry/frsky.cpp"
|
|
#include "radio/src/telemetry/frsky_sport.cpp"
|
|
#include "radio/src/telemetry/frsky_d.cpp"
|
|
#include "radio/src/targets/taranis/audio_driver.cpp"
|
|
#include "radio/src/targets/taranis/telemetry_driver.cpp"
|
|
#include "radio/src/audio_arm.cpp"
|
|
#include "radio/src/translations/tts_cz.cpp"
|
|
#include "radio/src/translations/tts_de.cpp"
|
|
#include "radio/src/translations/tts_en.cpp"
|
|
#include "radio/src/translations/tts_es.cpp"
|
|
#include "radio/src/translations/tts_se.cpp"
|
|
#include "radio/src/translations/tts_it.cpp"
|
|
#include "radio/src/translations/tts_fr.cpp"
|
|
#include "radio/src/translations/tts_pt.cpp"
|
|
#include "radio/src/translations/tts_sk.cpp"
|
|
#include "radio/src/translations/tts_pl.cpp"
|
|
#include "radio/src/translations/tts_hu.cpp"
|
|
#include "radio/src/lua_api.cpp"
|
|
#include "radio/src/lua/src/lapi.c"
|
|
#include "radio/src/lua/src/lcode.c"
|
|
#include "radio/src/lua/src/lctype.c"
|
|
#include "radio/src/lua/src/ldebug.c"
|
|
#include "radio/src/lua/src/ldo.c"
|
|
#include "radio/src/lua/src/ldump.c"
|
|
#include "radio/src/lua/src/lfunc.c"
|
|
#include "radio/src/lua/src/lgc.c"
|
|
#include "radio/src/lua/src/llex.c"
|
|
#include "radio/src/lua/src/lmem.c"
|
|
#include "radio/src/lua/src/lobject.c"
|
|
#include "radio/src/lua/src/lopcodes.c"
|
|
#include "radio/src/lua/src/lparser.c"
|
|
#include "radio/src/lua/src/lstate.c"
|
|
#include "radio/src/lua/src/lstring.c"
|
|
#include "radio/src/lua/src/ltable.c"
|
|
#include "radio/src/lua/src/lrotable.c"
|
|
#include "radio/src/lua/src/ltm.c"
|
|
#include "radio/src/lua/src/lundump.c"
|
|
#include "radio/src/lua/src/lvm.c"
|
|
#include "radio/src/lua/src/lzio.c"
|
|
#include "radio/src/lua/src/lbaselib.c"
|
|
#include "radio/src/lua/src/linit.c"
|
|
#include "radio/src/lua/src/lmathlib.c"
|
|
#include "radio/src/lua/src/lbitlib.c"
|
|
#include "radio/src/lua/src/loadlib.c"
|
|
#include "radio/src/lua/src/lauxlib.c"
|
|
#include "radio/src/lua/src/ltablib.c"
|
|
#include "radio/src/lua/src/lcorolib.c"
|
|
|
|
|
|
int16_t g_anas[NUM_STICKS+5];
|
|
|
|
uint16_t anaIn(uint8_t chan)
|
|
{
|
|
return g_anas[chan];
|
|
}
|
|
|
|
bool hasExtendedTrims()
|
|
{
|
|
return g_model.extendedTrims;
|
|
}
|
|
|
|
uint8_t getStickMode()
|
|
{
|
|
return limit<uint8_t>(0, g_eeGeneral.stickMode, 3);
|
|
}
|
|
|
|
void resetTrims()
|
|
{
|
|
GPIOE->IDR |= PIN_TRIM_LH_L | PIN_TRIM_LH_R | PIN_TRIM_LV_DN | PIN_TRIM_LV_UP;
|
|
GPIOC->IDR |= PIN_TRIM_RV_DN | PIN_TRIM_RV_UP | PIN_TRIM_RH_L | PIN_TRIM_RH_R;
|
|
}
|
|
|
|
}
|
|
|
|
using namespace Open9xX9D;
|
|
|
|
OpentxTaranisSimulator::OpentxTaranisSimulator()
|
|
{
|
|
taranisSimulatorBoard = GetEepromInterface()->getBoard();
|
|
QString path = g.profile[g.id()].sdPath()+"/";
|
|
int i=0;
|
|
for (i=0; i< std::min(path.length(),1022); i++) {
|
|
simuSdDirectory[i]=path.at(i).toAscii();
|
|
}
|
|
simuSdDirectory[i]=0;
|
|
}
|
|
|
|
bool OpentxTaranisSimulator::timer10ms()
|
|
{
|
|
#define TIMER10MS_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
uint8_t * OpentxTaranisSimulator::getLcd()
|
|
{
|
|
#define GETLCD_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
bool OpentxTaranisSimulator::lcdChanged(bool & lightEnable)
|
|
{
|
|
#define LCDCHANGED_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
void OpentxTaranisSimulator::start(QByteArray & eeprom, bool tests)
|
|
{
|
|
memcpy(Open9xX9D::eeprom, eeprom.data(), std::min<int>(sizeof(Open9xX9D::eeprom), eeprom.size()));
|
|
StartEepromThread(NULL);
|
|
StartMainThread(tests);
|
|
}
|
|
|
|
void OpentxTaranisSimulator::start(const char * filename, bool tests)
|
|
{
|
|
StartEepromThread(filename);
|
|
StartMainThread(tests);
|
|
}
|
|
|
|
void OpentxTaranisSimulator::stop()
|
|
{
|
|
StopMainThread();
|
|
StopEepromThread();
|
|
}
|
|
|
|
void OpentxTaranisSimulator::getValues(TxOutputs &outputs)
|
|
{
|
|
#define GETVALUES_IMPORT
|
|
#define g_chans512 channelOutputs
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
void OpentxTaranisSimulator::setValues(TxInputs &inputs)
|
|
{
|
|
#define SETVALUES_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
void OpentxTaranisSimulator::setTrim(unsigned int idx, int value)
|
|
{
|
|
idx = Open9xX9D::modn12x3[4*getStickMode() + idx];
|
|
uint8_t phase = getTrimFlightPhase(getFlightMode(), idx);
|
|
setTrimValue(phase, idx, value);
|
|
}
|
|
|
|
void OpentxTaranisSimulator::getTrims(Trims & trims)
|
|
{
|
|
uint8_t phase = getFlightMode();
|
|
trims.extended = hasExtendedTrims();
|
|
for (uint8_t idx=0; idx<4; idx++) {
|
|
trims.values[idx] = getTrimValue(getTrimFlightPhase(phase, idx), idx);
|
|
}
|
|
|
|
for (int i=0; i<2; i++) {
|
|
uint8_t idx = Open9xX9D::modn12x3[4*getStickMode() + i];
|
|
int16_t tmp = trims.values[i];
|
|
trims.values[i] = trims.values[idx];
|
|
trims.values[idx] = tmp;
|
|
}
|
|
}
|
|
|
|
void OpentxTaranisSimulator::wheelEvent(uint8_t steps)
|
|
{
|
|
// g_rotenc[0] += steps*4;
|
|
}
|
|
|
|
unsigned int OpentxTaranisSimulator::getPhase()
|
|
{
|
|
return getFlightMode();
|
|
}
|
|
|
|
const char * OpentxTaranisSimulator::getPhaseName(unsigned int phase)
|
|
{
|
|
static char buff[sizeof(g_model.flightModeData[0].name)+1];
|
|
zchar2str(buff, g_model.flightModeData[phase].name, sizeof(g_model.flightModeData[0].name));
|
|
return buff;
|
|
}
|
|
|
|
const char * OpentxTaranisSimulator::getError()
|
|
{
|
|
#define GETERROR_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
void OpentxTaranisSimulator::sendTelemetry(uint8_t * data, unsigned int len)
|
|
{
|
|
processSportPacket(data);
|
|
}
|
|
|
|
void OpentxTaranisSimulator::setTrainerInput(unsigned int inputNumber, int16_t value)
|
|
{
|
|
#define SETTRAINER_IMPORT
|
|
#include "simulatorimport.h"
|
|
}
|
|
|
|
void OpentxTaranisSimulator::installTraceHook(void (*callback)(const char *)) {
|
|
::traceCallback = callback;
|
|
}
|