367 lines
10 KiB
C
367 lines
10 KiB
C
/****************************************************************************
|
|
* This file is part of the project AqHome.
|
|
* AqHome (c) by 2024 Martin Preuss, all rights reserved.
|
|
*
|
|
* The license for this file can be found in the file COPYING which you
|
|
* should have received along with this file.
|
|
****************************************************************************/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
# include <config.h>
|
|
#endif
|
|
|
|
#include "./u_logical.h"
|
|
|
|
#include <gwenhywfar/debug.h>
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* defines
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
#define AQHOMEREACT_UNIT_LOGICAL_INSLOT_INPUT 100
|
|
#define AQHOMEREACT_UNIT_LOGICAL_INSLOT_AUTOINPUT 101
|
|
|
|
#define AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT 0
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* forward declarations
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static AQHREACT_UNIT *_unitLogical_new(AQH_OBJECT *aqh);
|
|
static int _outputResult(AQHREACT_UNIT *unit, AQHREACT_PORT *port, int result);
|
|
static int _cbProcessOr(AQHREACT_UNIT *unit);
|
|
static int _cbProcessAnd(AQHREACT_UNIT *unit);
|
|
static int _cbProcessXor(AQHREACT_UNIT *unit);
|
|
static int _cbProcessInvert(AQHREACT_UNIT *unit);
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* implementations
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitOr_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "or");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical OR inputs");
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessOr);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitNor_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "or");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical NOR inputs");
|
|
AQHREACT_Unit_AddFlags(unit, AQHREACT_UNIT_FLAGS_INVERT);
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessOr);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitAnd_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "and");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical AND inputs");
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessAnd);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitNand_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "and");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical NAND inputs");
|
|
AQHREACT_Unit_AddFlags(unit, AQHREACT_UNIT_FLAGS_INVERT);
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessAnd);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitXor_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "xor");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical XOR inputs");
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessXor);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
AQHREACT_UNIT *AqHomeReact_UnitInvert_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
|
|
unit=_unitLogical_new(aqh);
|
|
AQHREACT_Unit_SetTypeName(unit, "invert");
|
|
AQHREACT_Unit_SetDescription(unit, "Logical invert input");
|
|
AQHREACT_Unit_SetProcessFn(unit, _cbProcessInvert);
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
|
|
AQHREACT_UNIT *_unitLogical_new(AQH_OBJECT *aqh)
|
|
{
|
|
AQHREACT_UNIT *unit;
|
|
AQHREACT_PORT *port;
|
|
|
|
unit=AQHREACT_Unit_new(aqh);
|
|
|
|
AQHREACT_Unit_SetGpInt(unit, -1);
|
|
AQHREACT_Unit_SetNextInputPortId(unit, AQHOMEREACT_UNIT_LOGICAL_INSLOT_AUTOINPUT); /* for auto-gen multi-slots */
|
|
|
|
port=AQHREACT_Port_new();
|
|
AQHREACT_Port_SetName(port, "output");
|
|
AQHREACT_Port_SetIdForUnit(port, AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT);
|
|
AQHREACT_Port_SetDataType(port, AQHREACT_DATAOBJECTTYPE_DOUBLE);
|
|
AQHREACT_Unit_AddOutputPort(unit, port);
|
|
|
|
port=AQHREACT_Port_new();
|
|
AQHREACT_Port_SetName(port, "input");
|
|
AQHREACT_Port_SetIdForUnit(port, AQHOMEREACT_UNIT_LOGICAL_INSLOT_INPUT);
|
|
AQHREACT_Port_SetDataType(port, AQHREACT_DATAOBJECTTYPE_DOUBLE);
|
|
AQHREACT_Port_AddFlags(port, AQHREACT_UNIT_FLAGS_MULTI);
|
|
AQHREACT_Unit_AddInputPort(unit, port);
|
|
|
|
return unit;
|
|
}
|
|
|
|
|
|
|
|
int _outputResult(AQHREACT_UNIT *unit, AQHREACT_PORT *port, int result)
|
|
{
|
|
int currentState;
|
|
|
|
currentState=AQHREACT_Unit_GetGpInt(unit);
|
|
if (AQHREACT_Unit_GetFlags(unit) & AQHREACT_UNIT_FLAGS_INVERT)
|
|
result^=1;
|
|
if (currentState!=result) {
|
|
DBG_INFO(NULL, "%s: Changing result to %d", AQHREACT_Unit_GetId(unit), result);
|
|
AQHREACT_Unit_OutputDoubleData(unit, port, result?1.0:0.0);
|
|
AQHREACT_Unit_SetGpInt(unit, result);
|
|
return 1; /* we changed something */
|
|
}
|
|
return 0; /* nothing changed */
|
|
}
|
|
|
|
|
|
|
|
int _cbProcessOr(AQHREACT_UNIT *unit)
|
|
{
|
|
if (unit && AQHREACT_Unit_InputHasChanged(unit)) {
|
|
AQHREACT_PORT *outputPort;
|
|
|
|
outputPort=AQHREACT_Unit_GetOutputPortByIdForUnit(unit, AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT);
|
|
if (outputPort) {
|
|
const AQHREACT_PORT *port;
|
|
int result=0;
|
|
int numHandledInputs=0;
|
|
|
|
port=AQHREACT_Port_List_First(AQHREACT_Unit_GetInputPortList(unit));
|
|
while(port) {
|
|
const char *portName;
|
|
const AQHREACT_DATAOBJECT *dataObject;
|
|
|
|
portName=AQHREACT_Port_GetName(port);
|
|
dataObject=AQHREACT_Port_GetCurrentDataObject(port);
|
|
if (dataObject) {
|
|
if (AQHREACT_DataObject_GetDataType(dataObject)==AQHREACT_DATAOBJECTTYPE_DOUBLE) {
|
|
double d;
|
|
|
|
d=AQHREACT_DataObject_GetDoubleData(dataObject);
|
|
if (d>0.0)
|
|
result|=1;
|
|
numHandledInputs++;
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" isn't DOUBLE, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" has not current data, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
port=AQHREACT_Port_List_Next(port);
|
|
}
|
|
|
|
AQHREACT_Unit_ClearChangeFlagsInUnitAndInputPorts(unit);
|
|
if (numHandledInputs)
|
|
return _outputResult(unit, outputPort, result);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int _cbProcessAnd(AQHREACT_UNIT *unit)
|
|
{
|
|
if (unit && AQHREACT_Unit_InputHasChanged(unit)) {
|
|
AQHREACT_PORT *outputPort;
|
|
|
|
outputPort=AQHREACT_Unit_GetOutputPortByIdForUnit(unit, AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT);
|
|
if (outputPort) {
|
|
AQHREACT_PORT *port;
|
|
int result=1;
|
|
int numHandledInputs=0;
|
|
|
|
port=AQHREACT_Port_List_First(AQHREACT_Unit_GetInputPortList(unit));
|
|
while(port) {
|
|
const char *portName;
|
|
const AQHREACT_DATAOBJECT *dataObject;
|
|
|
|
portName=AQHREACT_Port_GetName(port);
|
|
dataObject=AQHREACT_Port_GetCurrentDataObject(port);
|
|
if (dataObject) {
|
|
if (AQHREACT_DataObject_GetDataType(dataObject)==AQHREACT_DATAOBJECTTYPE_DOUBLE) {
|
|
double d;
|
|
|
|
d=AQHREACT_DataObject_GetDoubleData(dataObject);
|
|
if (!(d>0.0))
|
|
result=0;
|
|
numHandledInputs++;
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" isn't DOUBLE, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" (%d) has no current data, assuming 0",
|
|
portName?portName:"<unnamed>", AQHREACT_Port_GetIdForUnit(port));
|
|
result=0;
|
|
}
|
|
port=AQHREACT_Port_List_Next(port);
|
|
}
|
|
|
|
AQHREACT_Unit_ClearChangeFlagsInUnitAndInputPorts(unit);
|
|
if (numHandledInputs)
|
|
return _outputResult(unit, outputPort, result);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int _cbProcessXor(AQHREACT_UNIT *unit)
|
|
{
|
|
if (unit && AQHREACT_Unit_InputHasChanged(unit)) {
|
|
AQHREACT_PORT *outputPort;
|
|
|
|
outputPort=AQHREACT_Unit_GetOutputPortByIdForUnit(unit, AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT);
|
|
if (outputPort) {
|
|
AQHREACT_PORT *port;
|
|
int result=0;
|
|
int numHandledInputs=0;
|
|
|
|
port=AQHREACT_Port_List_First(AQHREACT_Unit_GetInputPortList(unit));
|
|
while(port) {
|
|
const char *portName;
|
|
const AQHREACT_DATAOBJECT *dataObject;
|
|
|
|
portName=AQHREACT_Port_GetName(port);
|
|
dataObject=AQHREACT_Port_GetCurrentDataObject(port);
|
|
if (dataObject) {
|
|
if (AQHREACT_DataObject_GetDataType(dataObject)==AQHREACT_DATAOBJECTTYPE_DOUBLE) {
|
|
double d;
|
|
|
|
d=AQHREACT_DataObject_GetDoubleData(dataObject);
|
|
if (d>0.0)
|
|
result^=1; /*only xor when >0.0, otherwise no change (x XOR 0 is still x) */
|
|
numHandledInputs++;
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" isn't DOUBLE, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" has not current data, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
port=AQHREACT_Port_List_Next(port);
|
|
}
|
|
|
|
AQHREACT_Unit_ClearChangeFlagsInUnitAndInputPorts(unit);
|
|
if (numHandledInputs)
|
|
return _outputResult(unit, outputPort, result);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int _cbProcessInvert(AQHREACT_UNIT *unit)
|
|
{
|
|
if (unit && AQHREACT_Unit_InputHasChanged(unit)) {
|
|
AQHREACT_PORT *outputPort;
|
|
|
|
outputPort=AQHREACT_Unit_GetOutputPortByIdForUnit(unit, AQHOMEREACT_UNIT_LOGICAL_OUTSLOT_RESULT);
|
|
if (outputPort) {
|
|
AQHREACT_PORT *port;
|
|
int result=1;
|
|
|
|
port=AQHREACT_Port_List_First(AQHREACT_Unit_GetInputPortList(unit));
|
|
if(port) {
|
|
const char *portName;
|
|
const AQHREACT_DATAOBJECT *dataObject;
|
|
|
|
portName=AQHREACT_Port_GetName(port);
|
|
dataObject=AQHREACT_Port_GetCurrentDataObject(port);
|
|
if (dataObject) {
|
|
if (AQHREACT_DataObject_GetDataType(dataObject)==AQHREACT_DATAOBJECTTYPE_DOUBLE) {
|
|
double d;
|
|
|
|
d=AQHREACT_DataObject_GetDoubleData(dataObject);
|
|
if (d>0.0)
|
|
result=0; /* invert */
|
|
AQHREACT_Unit_ClearChangeFlagsInUnitAndInputPorts(unit);
|
|
return _outputResult(unit, outputPort, result);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" isn't DOUBLE, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Data at input slot \"%s\" has not current data, ignoring", portName?portName:"<unnamed>");
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|