/* * Author - Bertrand Songis * * 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 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(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(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; }