Logical switches
This commit is contained in:
@@ -0,0 +1,186 @@
|
||||
/*
|
||||
* Copyright (C) OpenTX
|
||||
*
|
||||
* Based on code named
|
||||
* 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_logicalswitchdata.h"
|
||||
#include "yaml_rawswitch.h"
|
||||
#include "yaml_rawsource.h"
|
||||
|
||||
static const YamlLookupTable funcLut = {
|
||||
{LS_FN_OFF, "FUNC_NONE"},
|
||||
{LS_FN_VEQUAL, "FUNC_VEQUAL"},
|
||||
{LS_FN_VALMOSTEQUAL, "FUNC_VALMOSTEQUAL"},
|
||||
{LS_FN_VPOS, "FUNC_VPOS"},
|
||||
{LS_FN_VNEG, "FUNC_VNEG"},
|
||||
{LS_FN_APOS, "FUNC_APOS"},
|
||||
{LS_FN_ANEG, "FUNC_ANEG"},
|
||||
{LS_FN_AND, "FUNC_AND"},
|
||||
{LS_FN_OR, "FUNC_OR"},
|
||||
{LS_FN_XOR, "FUNC_XOR"},
|
||||
{LS_FN_EDGE, "FUNC_EDGE"},
|
||||
{LS_FN_EQUAL, "FUNC_EQUAL"},
|
||||
{LS_FN_GREATER, "FUNC_GREATER"},
|
||||
{LS_FN_LESS, "FUNC_LESS"},
|
||||
{LS_FN_DPOS, "FUNC_DIFFEGREATER"},
|
||||
{LS_FN_DAPOS, "FUNC_ADIFFEGREATER"},
|
||||
{LS_FN_TIMER, "FUNC_TIMER"},
|
||||
{LS_FN_STICKY, "FUNC_STICKY"},
|
||||
};
|
||||
|
||||
static int timerValue2lsw(uint32_t t)
|
||||
{
|
||||
if (t < 20) {
|
||||
return t - 129;
|
||||
} else if (600) {
|
||||
return t / 5 - 113;
|
||||
} else {
|
||||
return t / 10 - 53;
|
||||
}
|
||||
}
|
||||
// val = [-129,-110] => [0,19] (step 1)
|
||||
// val = [-109,6] => [20,595] (step 5)
|
||||
// val = [7,122] => [600,1750] (step 10)
|
||||
//
|
||||
static int lswTimerValue(int val)
|
||||
{
|
||||
return (val < -109 ? 129+val : (val < 7 ? (113+val)*5 : (53+val)*10));
|
||||
}
|
||||
|
||||
namespace YAML
|
||||
{
|
||||
Node convert<LogicalSwitchData>::encode(const LogicalSwitchData& rhs)
|
||||
{
|
||||
Node node;
|
||||
node["func"] = funcLut << rhs.func;
|
||||
|
||||
std::string def;
|
||||
|
||||
switch (rhs.getFunctionFamily()) {
|
||||
case LS_FAMILY_VBOOL:
|
||||
case LS_FAMILY_STICKY: {
|
||||
def += YamlRawSwitchEncode(RawSwitch(rhs.val1));
|
||||
def += ",";
|
||||
def += YamlRawSwitchEncode(RawSwitch(rhs.val2));
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_EDGE: {
|
||||
def += YamlRawSwitchEncode(RawSwitch(rhs.val1));
|
||||
def += ",";
|
||||
def += std::to_string(lswTimerValue(rhs.val2));
|
||||
def += ",";
|
||||
def += std::to_string(lswTimerValue(rhs.val3));
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_VCOMP: {
|
||||
def += YamlRawSourceEncode(RawSource(rhs.val1));
|
||||
def += ",";
|
||||
def += YamlRawSourceEncode(RawSource(rhs.val2));
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_TIMER: {
|
||||
def += std::to_string(lswTimerValue(rhs.val1));
|
||||
def += ",";
|
||||
def += std::to_string(lswTimerValue(rhs.val2));
|
||||
} break;
|
||||
|
||||
default: {
|
||||
def += YamlRawSourceEncode(RawSource(rhs.val1));
|
||||
def += ",";
|
||||
def += std::to_string(rhs.val2);
|
||||
} break;
|
||||
}
|
||||
|
||||
node["def"] = def;
|
||||
node["delay"] = rhs.delay;
|
||||
node["duration"] = rhs.duration;
|
||||
node["andsw"] = YamlRawSwitchEncode(RawSwitch(rhs.andsw));
|
||||
|
||||
return node;
|
||||
}
|
||||
|
||||
bool convert<LogicalSwitchData>::decode(const Node& node,
|
||||
LogicalSwitchData& rhs)
|
||||
{
|
||||
node["func"] >> funcLut >> rhs.func;
|
||||
|
||||
std::string def_str;
|
||||
node["def"] >> def_str;
|
||||
std::stringstream def(def_str);
|
||||
|
||||
switch (rhs.getFunctionFamily()) {
|
||||
case LS_FAMILY_VBOOL:
|
||||
case LS_FAMILY_STICKY: {
|
||||
std::string sw_str;
|
||||
getline(def, sw_str, ',');
|
||||
rhs.val1 = YamlRawSwitchDecode(sw_str).toValue();
|
||||
rhs.val2 = YamlRawSwitchDecode(def.str()).toValue();
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_EDGE: {
|
||||
std::string sw_str;
|
||||
getline(def, sw_str, ',');
|
||||
rhs.val1 = YamlRawSwitchDecode(sw_str).toValue();
|
||||
int v2=0, v3=0;
|
||||
def >> v2;
|
||||
rhs.val2 = timerValue2lsw(v2);
|
||||
def.ignore();
|
||||
if (def.peek() == '<') {
|
||||
rhs.val3 = -1;
|
||||
} else if (def.peek() == '-') {
|
||||
rhs.val3 = 0;
|
||||
} else {
|
||||
def >> v3;
|
||||
rhs.val3 = timerValue2lsw(v3);
|
||||
}
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_VCOMP: {
|
||||
std::string src_str;
|
||||
getline(def, src_str, ',');
|
||||
rhs.val1 = YamlRawSourceDecode(src_str).toValue();
|
||||
rhs.val2 = YamlRawSourceDecode(def.str()).toValue();
|
||||
} break;
|
||||
|
||||
case LS_FAMILY_TIMER: {
|
||||
int v1=0, v2=0;
|
||||
def >> v1;
|
||||
rhs.val1 = timerValue2lsw(v1);
|
||||
def.ignore();
|
||||
def >> v2;
|
||||
rhs.val2 = timerValue2lsw(v2);
|
||||
} break;
|
||||
|
||||
default: {
|
||||
std::string src_str;
|
||||
getline(def, src_str, ',');
|
||||
rhs.val1 = YamlRawSourceDecode(src_str).toValue();
|
||||
def >> rhs.val2;
|
||||
} break;
|
||||
}
|
||||
|
||||
node["delay"] >> rhs.delay;
|
||||
node["duration"] >> rhs.duration;
|
||||
|
||||
RawSwitch andsw;
|
||||
node["andsw"] >> andsw;
|
||||
rhs.andsw = andsw.toValue();
|
||||
|
||||
return true;
|
||||
}
|
||||
} // namespace YAML
|
||||
Reference in New Issue
Block a user