Mirror/inav
1
0
Fork 0
mirror of https://github.com/iNavFlight/inav.git synced 2025-07-16 12:55:16 +03:00
Code Issues Wiki Activity

Added some more logic

Browse source 
Added delay, almost equal, and timer. Not yet tested.
This commit is contained in:
Darren Lines 2022-12-01 13:41:21 +00:00
parent 1ca3527f92
commit 026e40c297
2 changed files with 48 additions and 6 deletions
Download patch file Download diff file Expand all files Collapse all files

44
src/main/programming/logic_condition.c
View file

@ -105,6 +105,11 @@ static int logicConditionCompute(
return operandA == operandB;
break;
case LOGIC_CONDITION_APPROX_EQUAL:
uint16_t offest = operandA / 100;
return ((operandB >= (operandA - offest)) && (operandB <= (operandA + offest)));
break;
case LOGIC_CONDITION_GREATER_THAN:
return operandA > operandB;
break;
@ -164,13 +169,13 @@ static int logicConditionCompute(
break;
case LOGIC_CONDITION_EDGE:
if (operandA && logicConditionStates[lcIndex].timeout == 0 && !(logicConditionStates[lcIndex].flags & LOGIC_CONDITION_FLAG_EDGE_SATISFIED)) {
if (operandA && logicConditionStates[lcIndex].timeout == 0 && !(logicConditionStates[lcIndex].flags & LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED)) {
if (operandB < 100) {
logicConditionStates[lcIndex].timeout = millis() + 100;
} else {
logicConditionStates[lcIndex].timeout = millis() + operandB;
}
logicConditionStates[lcIndex].flags |= LOGIC_CONDITION_FLAG_EDGE_SATISFIED;
logicConditionStates[lcIndex].flags |= LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED;
return true;
} else if (logicConditionStates[lcIndex].timeout > 0) {
if (logicConditionStates[lcIndex].timeout < millis()) {
@ -181,11 +186,44 @@ static int logicConditionCompute(
}
if (!operandA) {
logicConditionStates[lcIndex].flags &= ~LOGIC_CONDITION_FLAG_EDGE_SATISFIED;
logicConditionStates[lcIndex].flags &= ~LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED;
}
return false;
break;
case LOGIC_CONDITION_DELAY:
if (operandA) {
if (logicConditionStates[lcIndex].flags & LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED) {
return true;
} else if (logicConditionStates[lcIndex].timeout > millis()) {
logicConditionStates[lcIndex].flags |= LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED;
return true;
} else if (logicConditionStates[lcIndex].timeout == 0) {
logicConditionStates[lcIndex].timeout = millis() + operandB;
}
} else {
logicConditionStates[lcIndex].timeout = 0;
logicConditionStates[lcIndex].flags &= ~LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED;
}
return false;
break;
case LOGIC_CONDITION_TIMER:
if (logicConditionStates[lcIndex].timeout > millis() && currentVaue) {
logicConditionStates[lcIndex].timeout millis() + operandB;
return false;
} else if ((logicConditionStates[lcIndex].timeout == 0) || (logicConditionStates[lcIndex].timeout > millis() && currentVaue)) {
logicConditionStates[lcIndex].timeout millis() + operandA;
return true;
}
return currentVaue;
break;
case LOGIC_CONDITION_DELTA:
return false;
break;
case LOGIC_CONDITION_GVAR_SET:
gvSet(operandA, operandB);
return operandB;

8
src/main/programming/logic_condition.h
View file

@ -77,7 +77,11 @@ typedef enum {
LOGIC_CONDITION_FLIGHT_AXIS_ANGLE_OVERRIDE = 45,
LOGIC_CONDITION_FLIGHT_AXIS_RATE_OVERRIDE = 46,
LOGIC_CONDITION_EDGE = 47,
LOGIC_CONDITION_LAST = 48,
LOGIC_CONDITION_DELAY = 48,
LOGIC_CONDITION_TIMER = 49,
LOGIC_CONDITION_DELTA = 50,
LOGIC_CONDITION_APPROX_EQUAL = 51,
LOGIC_CONDITION_LAST = 52,
} logicOperation_e;
typedef enum logicOperandType_s {
@ -168,7 +172,7 @@ typedef enum {
typedef enum {
LOGIC_CONDITION_FLAG_LATCH = 1 << 0,
LOGIC_CONDITION_FLAG_EDGE_SATISFIED = 1 << 1,
LOGIC_CONDITION_FLAG_TIMEOUT_SATISFIED = 1 << 1,
} logicConditionFlags_e;
typedef struct logicOperand_s {