/**************************************************************************** * 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 #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 /* ------------------------------------------------------------------------------------------------ * 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); 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); /* ------------------------------------------------------------------------------------------------ * implementations * ------------------------------------------------------------------------------------------------ */ void AqHomeNodes_HandleSetData(AQHOMED *aqh, GWEN_MSG_ENDPOINT *ep, GWEN_MSG *recvdMsg) { uint32_t msgId; DBG_ERROR(AQH_LOGDOMAIN, "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_ERROR(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(AQH_LOGDOMAIN, "Bad data \"%s\"", data); AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_BADDATA); } } else { DBG_ERROR(AQH_LOGDOMAIN, "Invalid value name \"%s\"", varName); AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID); } } else { DBG_ERROR(AQH_LOGDOMAIN, "Unknown node \"%s\"", devName); AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID); } } else { DBG_ERROR(AQH_LOGDOMAIN, "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(AQH_LOGDOMAIN, "No matching nodeinfo"); AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_INVALID); } free(data); } else { DBG_ERROR(AQH_LOGDOMAIN, "No data"); AQH_IpcEndpoint_SendResponseResult(ep, msgId, AQH_MSGTYPE_IPC_DATA_RESULT, AQH_MSG_IPC_ERROR_NODATA); } } else { DBG_ERROR(AQH_LOGDOMAIN, "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(AQH_LOGDOMAIN, "Could not read value from message"); } } else { DBG_ERROR(AQH_LOGDOMAIN, "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_ERROR(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) { 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, GWEN_MSG_REQUEST_REASON_ABORTED); } /* ------------------------------------------------------------------------------------------------ * 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_ERROR(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_ERROR(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_ERROR(NULL, " Non-matching message id"); } } else { DBG_ERROR(NULL, " Non-matching message code"); } } return GWEN_MSG_REQUEST_RESULT_NOT_HANDLED; } void _subRqAbort(GWEN_MSG_REQUEST *rq) { GWEN_MSG_REQUEST *rqParent; DBG_ERROR(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, GWEN_MSG_REQUEST_REASON_ABORTED); } 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_INFO(AQH_LOGDOMAIN, "Node \"%08lx\" not found", uid); return NULL; } return ni; } return NULL; }