/**************************************************************************** * This file is part of the project AqHome. * AqHome (c) by 2025 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 #endif #include "./r_setdata.h" #include "./server_p.h" #include "aqhome/aqhome.h" #include "aqhome/data/value.h" #include "aqhome/msg/ipc/m_ipc.h" #include "aqhome/msg/ipc/m_ipc_result.h" #include "aqhome/msg/ipc/m_ipc_tag16.h" #include "aqhome/msg/ipc/data/m_ipcd.h" #include "aqhome/msg/ipc/data/m_ipcd_setdata.h" #include "aqhome/msg/node/m_node.h" #include "aqhome/msg/node/m_value.h" #include "aqhome/ipc2/endpoint.h" #include /* ------------------------------------------------------------------------------------------------ * definitions * ------------------------------------------------------------------------------------------------ */ #define R_SETDATA_REQUEST_EXPIRE_SECS 20 #define R_SETDATA_SUBREQUEST_EXPIRE_SECS 10 /* ------------------------------------------------------------------------------------------------ * forward declarations * ------------------------------------------------------------------------------------------------ */ static AQH_NODE_INFO *_getNodeInfoFromValue(AQH_NODE_SERVER *xo, const AQH_VALUE *value); static AQH_MSG_REQUEST *_mkRequest_SetData(AQH_OBJECT *o, AQH_NODE_SERVER *xo, AQH_OBJECT *ep, uint32_t requestMsgId, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom); static void _rqSubRequestFinished(AQH_MSG_REQUEST *rq, AQH_MSG_REQUEST *subRq, int reason); static void _rqAbort(AQH_MSG_REQUEST *rq, int reason); static AQH_MSG_REQUEST *_mkSubRequest_SetData(AQH_OBJECT *o, AQH_NODE_SERVER *xo, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom); static int _subRqHandleResponse(AQH_MSG_REQUEST *rq, const AQH_MESSAGE *msg); static void _subRqAbort(AQH_MSG_REQUEST *rq, int reason); static void _sendResponseResultToBroker(AQH_OBJECT *ep, uint32_t refMsgId, int result); /* ------------------------------------------------------------------------------------------------ * implementations * ------------------------------------------------------------------------------------------------ */ void AQH_NodeServer_HandleSetData(AQH_OBJECT *o, AQH_OBJECT *ep, const AQH_MESSAGE *recvdMsg) { if (o) { AQH_NODE_SERVER *xo; xo=AQH_NodeServer_GetServerData(o); if (xo) { uint32_t msgId; DBG_INFO(NULL, "Received IPC SetDataRequest message"); msgId=AQH_IpcMessage_GetMsgId(recvdMsg); if (xo->ttyEndpoint) { GWEN_TAG16_LIST *tagList; tagList=AQH_IpcMessageTag16_ParsePayload(recvdMsg, 0); if (tagList) { AQH_VALUE *value; value=AQH_IpcdMessageSetData_ReadValue(tagList); if (value) { const char *varName; varName=AQH_Value_GetName(value); if (varName) { char *data; data=AQH_IpcdMessageSetData_ReadData(tagList); if (data) { AQH_NODE_INFO *nodeInfo; nodeInfo=_getNodeInfoFromValue(xo, value); if (nodeInfo) { const char *devName; devName=AQH_NodeInfo_GetDeviceId(nodeInfo); if (devName) { const AQHNODE_DEVICE *devInfo; devInfo=AQH_NodeServer_GetDeviceDefByName(o, 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) { AQH_MSG_REQUEST *rq; int destAddr; destAddr=AQH_NodeInfo_GetBusAddress(nodeInfo); DBG_DEBUG(NULL, "Creating SETDATA request"); rq=_mkRequest_SetData(o, xo, ep, msgId, destAddr, AQHNODE_Value_GetId(devValue), dataVal, dataDenom); AQH_NodeServer_AddRequestToTree(o, rq); /* done */ } else { DBG_ERROR(NULL, "Bad data \"%s\"", data); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_BADDATA); } } else { DBG_ERROR(NULL, "Invalid value name \"%s\"", varName); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_INVALID); } } else { DBG_ERROR(NULL, "Unknown node \"%s\"", devName); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_INVALID); } } else { DBG_ERROR(NULL, "Node not yet fully identified, come back later"); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_TRYAGAIN); } } else { DBG_ERROR(NULL, "No matching nodeinfo"); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_INVALID); } free(data); } else { DBG_ERROR(NULL, "No data"); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_NODATA); } } else { DBG_ERROR(NULL, "No var name"); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_NODATA); } AQH_Value_free(value); } else { DBG_ERROR(NULL, "Could not read value from message"); } GWEN_Tag16_List_free(tagList); } } else { DBG_ERROR(NULL, "TTY endpoint not connected"); _sendResponseResultToBroker(ep, msgId, AQH_MSGDATA_RESULT_ERROR_IO); } } } } /* ------------------------------------------------------------------------------------------------ * IPC Request SETDATA */ AQH_MSG_REQUEST *_mkRequest_SetData(AQH_OBJECT *o, AQH_NODE_SERVER *xo, AQH_OBJECT *ep, uint32_t requestMsgId, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom) { AQH_MSG_REQUEST *rq; AQH_MSG_REQUEST *subRq; rq=AQH_MsgRequest_new(); AQH_MsgRequest_SetPrivateData(rq, o); AQH_MsgRequest_SetEndpoint(rq, ep); AQH_MsgRequest_SetRequestMsgId(rq, requestMsgId); AQH_MsgRequest_SetSubRequestFinishedFn(rq, _rqSubRequestFinished); AQH_MsgRequest_SetAbortFn(rq, _rqAbort); AQH_MsgRequest_SetTimestamps(rq, R_SETDATA_REQUEST_EXPIRE_SECS); subRq=_mkSubRequest_SetData(o, xo, destAddr, valueId, dataVal, dataDenom); AQH_MsgRequest_Tree2_AddChild(rq, subRq); return rq; } void _rqSubRequestFinished(AQH_MSG_REQUEST *rq, AQH_MSG_REQUEST *subRq, int reason) { AQH_OBJECT *ep; uint32_t refMsgId; int result; DBG_INFO(NULL, "SubRequest finished (reason: %d)", reason); refMsgId=AQH_MsgRequest_GetRequestMsgId(rq); ep=AQH_MsgRequest_GetEndpoint(rq); result=AQH_MsgRequest_GetResult(subRq); if (reason==AQH_MSG_REQUEST_REASON_ABORTED) _sendResponseResultToBroker(ep, refMsgId, AQH_MSGDATA_RESULT_ERROR_GENERIC); else _sendResponseResultToBroker(ep, refMsgId, result); AQH_MsgRequest_SetResult(rq, result); AQH_MsgRequest_SetState(rq, AQH_MSG_REQUEST_STATE_DONE); } void _rqAbort(AQH_MSG_REQUEST *rq, int reason) { AQH_OBJECT *ep; uint32_t refMsgId; AQH_MSG_REQUEST *rqParent; DBG_INFO(NULL, "Aborting request"); refMsgId=AQH_MsgRequest_GetRequestMsgId(rq); ep=AQH_MsgRequest_GetEndpoint(rq); _sendResponseResultToBroker(ep, refMsgId, AQH_MSGDATA_RESULT_ERROR_GENERIC); AQH_MsgRequest_SetState(rq, AQH_MSG_REQUEST_STATE_DONE); rqParent=AQH_MsgRequest_Tree2_GetParent(rq); if (rqParent) AQH_MsgRequest_SubRequestFinished(rqParent, rq, reason); } /* ------------------------------------------------------------------------------------------------ * TTY Request SETDATA */ AQH_MSG_REQUEST *_mkSubRequest_SetData(AQH_OBJECT *o, AQH_NODE_SERVER *xo, int destAddr, int valueId, uint16_t dataVal, uint16_t dataDenom) { AQH_MSG_REQUEST *rq; uint16_t msgId; AQH_MESSAGE *msgOut; rq=AQH_MsgRequest_new(); AQH_MsgRequest_SetPrivateData(rq, o); AQH_MsgRequest_SetEndpoint(rq, xo->ttyEndpoint); AQH_MsgRequest_SetHandleResponseFn(rq, _subRqHandleResponse); AQH_MsgRequest_SetAbortFn(rq, _subRqAbort); msgId=AQH_Endpoint_GetNextMessageId(xo->ttyEndpoint) & 0xffff; AQH_MsgRequest_SetRequestMsgId(rq, msgId); AQH_MsgRequest_SetTimestamps(rq, R_SETDATA_SUBREQUEST_EXPIRE_SECS); msgOut=AQH_ValueMessage_new(xo->nodeAddress, destAddr, AQH_MSG_TYPE_VALUE_SET, msgId, valueId, dataVal, dataDenom); AQH_Endpoint_AddMsgOut(xo->ttyEndpoint, msgOut); return rq; } int _subRqHandleResponse(AQH_MSG_REQUEST *rq, const AQH_MESSAGE *msg) { AQH_OBJECT *o; DBG_DEBUG(NULL, "Checking message from %02x", AQH_NodeMessage_GetSourceAddress(msg)); o=(AQH_OBJECT*)AQH_MsgRequest_GetPrivateData(rq); if (o) { AQH_NODE_SERVER *xo; xo=AQH_NodeServer_GetServerData(o); if (xo) { uint8_t destAddr; destAddr=AQH_NodeMessage_GetDestAddress(msg); if (destAddr==0xff || destAddr==xo->nodeAddress) { uint8_t msgCode; msgCode=AQH_NodeMessage_GetMsgType(msg); if (msgCode==AQH_MSG_TYPE_VALUE_SET_ACK || msgCode==AQH_MSG_TYPE_VALUE_SET_NACK) { uint16_t msgId; msgId=AQH_ValueMessage_GetMsgId(msg); if (msgId==AQH_MsgRequest_GetRequestMsgId(rq)) { AQH_MSG_REQUEST *rqParent; DBG_INFO(NULL, "Received response (%02x) for msg id %04x from %02x", msgCode, msgId, AQH_NodeMessage_GetSourceAddress(msg)); AQH_MsgRequest_SetResult(rq, (msgCode==AQH_MSG_TYPE_VALUE_SET_ACK)?AQH_MSGDATA_RESULT_SUCCESS:AQH_MSGDATA_RESULT_ERROR_GENERIC); AQH_MsgRequest_SetState(rq, AQH_MSG_REQUEST_STATE_DONE); rqParent=AQH_MsgRequest_Tree2_GetParent(rq); if (rqParent) AQH_MsgRequest_SubRequestFinished(rqParent, rq, AQH_MSG_REQUEST_REASON_DONE); return AQH_MSG_REQUEST_RESULT_HANDLED; } else { DBG_INFO(NULL, " Non-matching message id"); } } else { DBG_INFO(NULL, " Non-matching message code"); } } } } return AQH_MSG_REQUEST_RESULT_NOT_HANDLED; } void _subRqAbort(AQH_MSG_REQUEST *rq, int reason) { AQH_MSG_REQUEST *rqParent; DBG_INFO(NULL, "Aborting request"); AQH_MsgRequest_SetResult(rq, AQH_MSGDATA_RESULT_ERROR_GENERIC); AQH_MsgRequest_SetState(rq, AQH_MSG_REQUEST_STATE_DONE); rqParent=AQH_MsgRequest_Tree2_GetParent(rq); if (rqParent) AQH_MsgRequest_SubRequestFinished(rqParent, rq, reason); } AQH_NODE_INFO *_getNodeInfoFromValue(AQH_NODE_SERVER *xo, 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(xo->nodeDb, uid); if (ni==NULL) { DBG_ERROR(NULL, "Node \"%08lx\" not found", uid); return NULL; } return ni; } return NULL; } void _sendResponseResultToBroker(AQH_OBJECT *ep, uint32_t refMsgId, int result) { AQH_MESSAGE *msg; msg=AQH_IpcMessageResult_new(AQH_IPC_PROTOCOL_DATA_ID, AQH_IPC_PROTOCOL_DATA_VERSION, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_Endpoint_GetNextMessageId(ep), refMsgId, result, NULL); AQH_Endpoint_AddMsgOut(ep, msg); }