/* * Copyright (C) EdgeTX * * Based on code named * opentx - https://github.com/opentx/opentx * th9x - http://code.google.com/p/th9x * er9x - http://code.google.com/p/er9x * gruvin9x - http://code.google.com/p/gruvin9x * * License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html * * 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 "yaml_mixdata.h" #include "yaml_rawswitch.h" #include "yaml_rawsource.h" #include "curvereference.h" #include "sourcenumref.h" static const YamlLookupTable mixMultiplexLut = { { MLTPX_ADD, "ADD" }, { MLTPX_MUL, "MUL" }, { MLTPX_REP, "REPL" }, }; #define GVAR_SMALL 128 #define CPN_GV1 1024 int32_t YamlSourceNumRefDecode(const YAML::Node& node) { std::string val = node.as(); if (modelSettingsVersion < SemanticVersion(QString("2.11.0"))) { if ((val.size() >= 4) && (val[0] == '-') && (val[1] == 'G') && (val[2] == 'V') && (val[3] >= '1') && (val[3] <= '9')) { std::stringstream src(val.substr(3)); int gv = 0; src >> gv; return RawSource(SOURCE_TYPE_GVAR, gv).toValue() * -1; } if ((val.size() >= 3) && (val[0] == 'G') && (val[1] == 'V') && (val[2] >= '1') && (val[2] <= '9')) { std::stringstream src(val.substr(2)); int gv = 0; src >> gv; return RawSource(SOURCE_TYPE_GVAR, gv).toValue(); } } int i = val[0] == '-' ? 1 : 0; if (val[i] >= '0' && val[i] <= '9') try { return std::stoi(val); } catch(...) { throw YAML::TypedBadConversion(node.Mark()); } else return YamlRawSourceDecode(val).toValue(); } std::string YamlSourceNumRefEncode(int32_t sval) { if (SourceNumRef(sval).isNumber()) return std::to_string(sval); else return YamlRawSourceEncode(RawSource(sval)); } uint32_t YamlReadFlightModes(const YAML::Node& node) { std::string fm_str = node.as(); uint32_t bits = 0; uint32_t mask = 1; for (uint32_t i = 0; i < fm_str.size(); i++) { if (fm_str[i] == '1') bits |= mask; mask <<= 1; } return bits; } std::string YamlWriteFlightModes(uint32_t val) { std::string fm_str; // TODO: constant for number of flight modes for (int i=0; i<9; i++) { uint32_t bit = (val >> i) & 1; fm_str += bit ? "1" : "0"; } return fm_str; } static const YamlLookupTable dummy = {}; namespace YAML { ENUM_CONVERTER(MltpxValue, mixMultiplexLut); Node convert::encode(const CurveReference& rhs) { Node node; node["type"] = (int)rhs.type; node["value"] = YamlSourceNumRefEncode(rhs.value); return node; } bool convert::decode(const Node& node, CurveReference& rhs) { // no symbolic value defined in radio int type = 0; node["type"] >> type; rhs.type = (CurveReference::CurveRefType)type; if (node["value"]) { rhs.value = YamlSourceNumRefDecode(node["value"]); } return true; } Node convert::encode(const MixData& rhs) { Node node; node["destCh"] = rhs.destCh - 1; node["srcRaw"] = rhs.srcRaw; node["weight"] = YamlSourceNumRefEncode(rhs.weight); node["swtch"] = rhs.swtch; node["curve"] = rhs.curve; node["delayPrec"] = rhs.delayPrec; node["delayUp"] = rhs.delayUp; node["delayDown"] = rhs.delayDown; node["speedPrec"] = rhs.speedPrec; node["speedUp"] = rhs.speedUp; node["speedDown"] = rhs.speedDown; node["carryTrim"] = rhs.carryTrim; node["mltpx"] = rhs.mltpx; node["mixWarn"] = rhs.mixWarn; node["flightModes"] = YamlWriteFlightModes(rhs.flightModes); node["offset"] = YamlSourceNumRefEncode(rhs.sOffset); node["name"] = rhs.name; return node; } bool convert::decode(const Node& node, MixData& rhs) { node["destCh"] >> ioffset_int((int&)rhs.destCh, -1); node["srcRaw"] >> rhs.srcRaw; if (node["weight"]) { rhs.weight = YamlSourceNumRefDecode(node["weight"]); } node["swtch"] >> rhs.swtch; node["curve"] >> rhs.curve; node["delayPrec"] >> rhs.delayPrec; node["delayUp"] >> rhs.delayUp; node["delayDown"] >> rhs.delayDown; node["speedPrec"] >> rhs.speedPrec; node["speedUp"] >> rhs.speedUp; node["speedDown"] >> rhs.speedDown; node["carryTrim"] >> rhs.carryTrim; node["mltpx"] >> rhs.mltpx; node["mixWarn"] >> rhs.mixWarn; if (node["flightModes"]) { rhs.flightModes = YamlReadFlightModes(node["flightModes"]); } if (node["offset"]) { rhs.sOffset = YamlSourceNumRefDecode(node["offset"]); } node["name"] >> rhs.name; return true; } }