345 lines
11 KiB
C
345 lines
11 KiB
C
/****************************************************************************
|
|
* This file is part of the project AqHome.
|
|
* AqHome (c) by 2023 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 "./r_setdata.h"
|
|
#include "./aqhomed_p.h"
|
|
|
|
#include "aqhome/aqhome.h"
|
|
#include "aqhome/ipc/endpoint_ipc.h"
|
|
#include "aqhome/ipc/msg_ipc_result.h"
|
|
#include "aqhome/ipc/data/msg_data_set.h"
|
|
#include "aqhome/ipc/data/ipc_data.h"
|
|
#include "aqhome/msg/msg_value3.h"
|
|
|
|
#include <gwenhywfar/debug.h>
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* definitions
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
|
|
#define R_SETDATA_REQUEST_EXPIRE_SECS 20
|
|
#define R_SETDATA_SUBREQUEST_EXPIRE_SECS 10
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* forward declarations
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
static AQH_NODE_INFO *_getNodeInfoFromValue(AQHOMED *aqh, const AQH_VALUE *value);
|
|
|
|
static GWEN_MSG_REQUEST *_mkRequest_SetData(AQHOMED *aqh,
|
|
GWEN_MSG_ENDPOINT *ep, uint32_t requestMsgId,
|
|
int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom);
|
|
|
|
static void _rqSubRequestFinished(GWEN_MSG_REQUEST *rq, GWEN_MSG_REQUEST *subRq, int reason);
|
|
static void _rqAbort(GWEN_MSG_REQUEST *rq, int reason);
|
|
|
|
static GWEN_MSG_REQUEST *_mkSubRequest_SetData(AQHOMED *aqh, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom);
|
|
static int _subRqHandleResponse(GWEN_MSG_REQUEST *rq, GWEN_MSG *msg);
|
|
static void _subRqAbort(GWEN_MSG_REQUEST *rq, int reason);
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* implementations
|
|
* ------------------------------------------------------------------------------------------------
|
|
*/
|
|
|
|
|
|
void AqHomeNodes_HandleSetData(AQHOMED *aqh, GWEN_MSG_ENDPOINT *ep, GWEN_MSG *recvdMsg)
|
|
{
|
|
uint32_t msgId;
|
|
|
|
DBG_INFO(NULL, "Received IPC SetDataRequest message");
|
|
msgId=GWEN_IpcMsg_GetMsgId(recvdMsg);
|
|
|
|
if (aqh->ttyEndpoint && GWEN_MsgEndpoint_GetState(aqh->ttyEndpoint)==GWEN_MSG_ENDPOINT_STATE_CONNECTED) {
|
|
AQH_VALUE *value;
|
|
|
|
AQH_SetDataIpcMsg_Parse(recvdMsg, 0);
|
|
value=AQH_SetDataIpcMsg_ReadValue(recvdMsg);
|
|
if (value) {
|
|
const char *varName;
|
|
|
|
varName=AQH_Value_GetName(value);
|
|
if (varName) {
|
|
char *data;
|
|
|
|
data=AQH_SetDataIpcMsg_ReadData(recvdMsg);
|
|
if (data) {
|
|
AQH_NODE_INFO *nodeInfo;
|
|
|
|
nodeInfo=_getNodeInfoFromValue(aqh, value);
|
|
if (nodeInfo) {
|
|
const char *devName;
|
|
|
|
devName=AQH_NodeInfo_GetDeviceId(nodeInfo);
|
|
if (devName) {
|
|
const AQHNODE_DEVICE *devInfo;
|
|
|
|
devInfo=AqHomed_GetDeviceDefByName(aqh, devName);
|
|
if (devInfo) {
|
|
const AQHNODE_VALUE *devValue;
|
|
|
|
devValue=AQHNODE_Value_List_GetByName(AQHNODE_Device_GetValueList(devInfo), varName);
|
|
if (devValue) {
|
|
uint16_t dataVal=0;
|
|
uint16_t dataDenom=0;
|
|
|
|
if (AQH_ReadDataFromString(AQHNODE_Value_GetDataType(devValue), data, &dataVal, &dataDenom)==0) {
|
|
GWEN_MSG_REQUEST *rq;
|
|
int destAddr;
|
|
|
|
destAddr=AQH_NodeInfo_GetBusAddress(nodeInfo);
|
|
DBG_DEBUG(NULL, "Creating SETDATA request");
|
|
|
|
rq=_mkRequest_SetData(aqh, ep, msgId, destAddr, AQHNODE_Value_GetId(devValue), dataVal, dataDenom);
|
|
AqHomed_AddRequestToTree(aqh, rq);
|
|
/* done */
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Bad data \"%s\"", data);
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_BADDATA);
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Invalid value name \"%s\"", varName);
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID);
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Unknown node \"%s\"", devName);
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID);
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Node not yet fully identified, come back later");
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_TRYAGAIN);
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "No matching nodeinfo");
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID);
|
|
}
|
|
free(data);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "No data");
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_NODATA);
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "No var name");
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_NODATA);
|
|
}
|
|
AQH_Value_free(value);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Could not read value from message");
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "TTY endpoint not connected");
|
|
AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_IO);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* IPC Request SETDATA
|
|
*/
|
|
|
|
GWEN_MSG_REQUEST *_mkRequest_SetData(AQHOMED *aqh,
|
|
GWEN_MSG_ENDPOINT *ep, uint32_t requestMsgId,
|
|
int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom)
|
|
{
|
|
GWEN_MSG_REQUEST *rq;
|
|
GWEN_MSG_REQUEST *subRq;
|
|
|
|
rq=GWEN_MsgRequest_new();
|
|
GWEN_MsgRequest_SetPrivateData(rq, aqh);
|
|
GWEN_MsgRequest_SetEndpoint(rq, ep);
|
|
GWEN_MsgRequest_SetRequestMsgId(rq, requestMsgId);
|
|
GWEN_MsgRequest_SetSubRequestFinishedFn(rq, _rqSubRequestFinished);
|
|
GWEN_MsgRequest_SetAbortFn(rq, _rqAbort);
|
|
GWEN_MsgRequest_SetTimestamps(rq, R_SETDATA_REQUEST_EXPIRE_SECS);
|
|
|
|
subRq=_mkSubRequest_SetData(aqh, destAddr, valueId, dataVal, dataDenom);
|
|
GWEN_MsgRequest_Tree2_AddChild(rq, subRq);
|
|
|
|
return rq;
|
|
}
|
|
|
|
|
|
|
|
void _rqSubRequestFinished(GWEN_MSG_REQUEST *rq, GWEN_MSG_REQUEST *subRq, int reason)
|
|
{
|
|
GWEN_MSG_ENDPOINT *ep;
|
|
uint32_t refMsgId;
|
|
int result;
|
|
|
|
DBG_INFO(NULL, "SubRequest finished (reason: %d)", reason);
|
|
refMsgId=GWEN_MsgRequest_GetRequestMsgId(rq);
|
|
ep=GWEN_MsgRequest_GetEndpoint(rq);
|
|
result=GWEN_MsgRequest_GetResult(subRq);
|
|
|
|
if (reason==GWEN_MSG_REQUEST_REASON_ABORTED)
|
|
AQH_IpcEndpoint_SendResponseResult(ep, refMsgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_GENERIC);
|
|
else
|
|
AQH_IpcEndpoint_SendResponseResult(ep, refMsgId, AQH_MSGTYPE_IPC_DATA_RESULT, result);
|
|
|
|
GWEN_MsgRequest_SetResult(rq, result);
|
|
GWEN_MsgRequest_SetState(rq, GWEN_MSG_REQUEST_STATE_DONE);
|
|
}
|
|
|
|
|
|
|
|
void _rqAbort(GWEN_MSG_REQUEST *rq, int reason)
|
|
{
|
|
GWEN_MSG_ENDPOINT *ep;
|
|
uint32_t refMsgId;
|
|
GWEN_MSG_REQUEST *rqParent;
|
|
|
|
DBG_INFO(NULL, "Aborting request");
|
|
refMsgId=GWEN_MsgRequest_GetRequestMsgId(rq);
|
|
ep=GWEN_MsgRequest_GetEndpoint(rq);
|
|
AQH_IpcEndpoint_SendResponseResult(ep, refMsgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_GENERIC);
|
|
GWEN_MsgRequest_SetState(rq, GWEN_MSG_REQUEST_STATE_DONE);
|
|
|
|
rqParent=GWEN_MsgRequest_Tree2_GetParent(rq);
|
|
if (rqParent)
|
|
GWEN_MsgRequest_SubRequestFinished(rqParent, rq, reason);
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/* ------------------------------------------------------------------------------------------------
|
|
* TTY Request SETDATA
|
|
*/
|
|
|
|
|
|
GWEN_MSG_REQUEST *_mkSubRequest_SetData(AQHOMED *aqh, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom)
|
|
{
|
|
GWEN_MSG_REQUEST *rq;
|
|
uint16_t msgId;
|
|
GWEN_MSG *msgOut;
|
|
|
|
rq=GWEN_MsgRequest_new();
|
|
GWEN_MsgRequest_SetPrivateData(rq, aqh);
|
|
GWEN_MsgRequest_SetEndpoint(rq, aqh->ttyEndpoint);
|
|
|
|
GWEN_MsgRequest_SetHandleResponseFn(rq, _subRqHandleResponse);
|
|
GWEN_MsgRequest_SetAbortFn(rq, _subRqAbort);
|
|
|
|
msgId=GWEN_MsgEndpoint_GetNextMessageId(aqh->ttyEndpoint) & 0xffff;
|
|
GWEN_MsgRequest_SetRequestMsgId(rq, msgId);
|
|
GWEN_MsgRequest_SetTimestamps(rq, R_SETDATA_SUBREQUEST_EXPIRE_SECS);
|
|
|
|
msgOut=AQH_Value3Msg_new(aqh->nodeAddress, destAddr, AQH_MSG_TYPE_VALUE_SET, msgId, valueId, dataVal, dataDenom);
|
|
GWEN_MsgEndpoint_AddSendMessage(aqh->ttyEndpoint, msgOut);
|
|
|
|
return rq;
|
|
}
|
|
|
|
|
|
|
|
int _subRqHandleResponse(GWEN_MSG_REQUEST *rq, GWEN_MSG *msg)
|
|
{
|
|
AQHOMED *aqh;
|
|
uint8_t destAddr;
|
|
|
|
DBG_DEBUG(NULL, "Checking message from %02x", AQH_NodeMsg_GetSourceAddress(msg));
|
|
aqh=(AQHOMED*)GWEN_MsgRequest_GetPrivateData(rq);
|
|
|
|
destAddr=AQH_NodeMsg_GetDestAddress(msg);
|
|
if (destAddr==0xff || destAddr==aqh->nodeAddress) {
|
|
uint8_t msgCode;
|
|
|
|
msgCode=AQH_NodeMsg_GetMsgType(msg);
|
|
if (msgCode==AQH_MSG_TYPE_VALUE_SET_ACK || msgCode==AQH_MSG_TYPE_VALUE_SET_NACK) {
|
|
uint16_t msgId;
|
|
|
|
msgId=AQH_Value3Msg_GetMsgId(msg);
|
|
if (msgId==GWEN_MsgRequest_GetRequestMsgId(rq)) {
|
|
GWEN_MSG_REQUEST *rqParent;
|
|
|
|
DBG_INFO(NULL,
|
|
"Received response (%02x) for msg id %04x from %02x",
|
|
msgCode, msgId, AQH_NodeMsg_GetSourceAddress(msg));
|
|
GWEN_MsgRequest_SetResult(rq, (msgCode==AQH_MSG_TYPE_VALUE_SET_ACK)?AQH_MSG_IPC_SUCCESS:AQH_MSG_IPC_ERROR_GENERIC);
|
|
GWEN_MsgRequest_SetState(rq, GWEN_MSG_REQUEST_STATE_DONE);
|
|
rqParent=GWEN_MsgRequest_Tree2_GetParent(rq);
|
|
if (rqParent)
|
|
GWEN_MsgRequest_SubRequestFinished(rqParent, rq, GWEN_MSG_REQUEST_REASON_DONE);
|
|
return GWEN_MSG_REQUEST_RESULT_HANDLED;
|
|
}
|
|
else {
|
|
DBG_INFO(NULL, " Non-matching message id");
|
|
}
|
|
}
|
|
else {
|
|
DBG_INFO(NULL, " Non-matching message code");
|
|
}
|
|
}
|
|
return GWEN_MSG_REQUEST_RESULT_NOT_HANDLED;
|
|
}
|
|
|
|
|
|
|
|
void _subRqAbort(GWEN_MSG_REQUEST *rq, int reason)
|
|
{
|
|
GWEN_MSG_REQUEST *rqParent;
|
|
|
|
DBG_INFO(NULL, "Aborting request");
|
|
|
|
GWEN_MsgRequest_SetResult(rq, AQH_MSG_IPC_ERROR_GENERIC);
|
|
GWEN_MsgRequest_SetState(rq, GWEN_MSG_REQUEST_STATE_DONE);
|
|
|
|
rqParent=GWEN_MsgRequest_Tree2_GetParent(rq);
|
|
if (rqParent)
|
|
GWEN_MsgRequest_SubRequestFinished(rqParent, rq, reason);
|
|
}
|
|
|
|
|
|
|
|
AQH_NODE_INFO *_getNodeInfoFromValue(AQHOMED *aqh, const AQH_VALUE *value)
|
|
{
|
|
const char *s;
|
|
unsigned long int uid;
|
|
|
|
s=AQH_Value_GetDeviceName(value);
|
|
if (s && *s && 1==sscanf(s, "%lx", &uid)) {
|
|
AQH_NODE_INFO *ni;
|
|
|
|
ni=AQH_NodeDb_GetNodeInfoByUid(aqh->nodeDb, uid);
|
|
if (ni==NULL) {
|
|
DBG_ERROR(NULL, "Node \"%08lx\" not found", uid);
|
|
return NULL;
|
|
}
|
|
return ni;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
|