161 lines
4.1 KiB
C
161 lines
4.1 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 "aqhome/msg/endpointmgr_p.h"
|
|
#include "aqhome/msg/msg_node.h"
|
|
#include "aqhome/msg/endpoint_node.h"
|
|
|
|
#include <gwenhywfar/misc.h>
|
|
#include <gwenhywfar/debug.h>
|
|
|
|
|
|
|
|
|
|
GWEN_INHERIT(GWEN_MSG_ENDPOINT_MGR, AQH_MSG_ENDPOINT_MGR);
|
|
|
|
|
|
|
|
static void GWENHYWFAR_CB _freeData(void *bp, void *p);
|
|
|
|
static void _handleEndpoint(GWEN_MSG_ENDPOINT_MGR *emgr, GWEN_MSG_ENDPOINT *ep);
|
|
static void _handleNodeEndpoint(GWEN_MSG_ENDPOINT_MGR *emgr, GWEN_MSG_ENDPOINT *ep);
|
|
static void _distributeMsgFromNodeEndpoint(GWEN_MSG_ENDPOINT_MGR *emgr, GWEN_MSG_ENDPOINT *srcEp, const GWEN_MSG *msg);
|
|
|
|
|
|
|
|
|
|
|
|
|
|
GWEN_MSG_ENDPOINT_MGR *AQH_MsgEndpointMgr_new(uint8_t busAddr)
|
|
{
|
|
GWEN_MSG_ENDPOINT_MGR *mgr;
|
|
AQH_MSG_ENDPOINT_MGR *xmgr;
|
|
|
|
mgr=GWEN_MsgEndpointMgr_new();
|
|
GWEN_NEW_OBJECT(AQH_MSG_ENDPOINT_MGR, xmgr);
|
|
GWEN_INHERIT_SETDATA(GWEN_MSG_ENDPOINT_MGR, AQH_MSG_ENDPOINT_MGR, mgr, xmgr, _freeData);
|
|
|
|
xmgr->busAddr=busAddr;
|
|
|
|
return mgr;
|
|
}
|
|
|
|
|
|
|
|
void _freeData(void *bp, void *p)
|
|
{
|
|
AQH_MSG_ENDPOINT_MGR *xmgr;
|
|
|
|
xmgr=(AQH_MSG_ENDPOINT_MGR*) p;
|
|
GWEN_FREE_OBJECT(xmgr);
|
|
}
|
|
|
|
|
|
|
|
int AQH_MsgEndpointMgr_LoopOnce(GWEN_MSG_ENDPOINT_MGR *emgr, int groupId)
|
|
{
|
|
int rv;
|
|
|
|
rv=GWEN_MsgEndpointMgr_IoLoopOnce(emgr);
|
|
AQH_MsgEndpointMgr_LoopOnceOverNodeEndpoints(emgr, groupId);
|
|
GWEN_MsgEndpointMgr_RunAllEndpoints(emgr);
|
|
return rv;
|
|
}
|
|
|
|
|
|
|
|
void AQH_MsgEndpointMgr_LoopOnceOverNodeEndpoints(GWEN_MSG_ENDPOINT_MGR *emgr, int groupId)
|
|
{
|
|
GWEN_MSG_ENDPOINT_LIST *endpointList;
|
|
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "Handle endpoint messages");
|
|
endpointList=GWEN_MsgEndpointMgr_GetEndpointList(emgr);
|
|
if (endpointList) {
|
|
GWEN_MSG_ENDPOINT *ep;
|
|
|
|
ep=GWEN_MsgEndpoint_List_First(endpointList);
|
|
while(ep) {
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "- endpoint(%s)", GWEN_MsgEndpoint_GetName(ep));
|
|
if (GWEN_MsgEndpoint_GetGroupId(ep)==groupId)
|
|
_handleNodeEndpoint(emgr, ep);
|
|
ep=GWEN_MsgEndpoint_List_Next(ep);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void _handleNodeEndpoint(GWEN_MSG_ENDPOINT_MGR *emgr, GWEN_MSG_ENDPOINT *ep)
|
|
{
|
|
GWEN_MSG *msg;
|
|
|
|
while( (msg=GWEN_MsgEndpoint_TakeFirstReceivedMessage(ep)) ) {
|
|
DBG_INFO(AQH_LOGDOMAIN,
|
|
" - msg %d from %d to %d",
|
|
AQH_NodeMsg_GetMsgType(msg), AQH_NodeMsg_GetSourceAddress(msg), AQH_NodeMsg_GetDestAddress(msg));
|
|
_distributeMsgFromNodeEndpoint(emgr, ep, msg);
|
|
GWEN_Msg_free(msg);
|
|
}
|
|
}
|
|
|
|
|
|
|
|
void _distributeMsgFromNodeEndpoint(GWEN_MSG_ENDPOINT_MGR *emgr, GWEN_MSG_ENDPOINT *srcEp, const GWEN_MSG *msg)
|
|
{
|
|
GWEN_MSG_ENDPOINT_LIST *endpointList;
|
|
|
|
endpointList=GWEN_MsgEndpointMgr_GetEndpointList(emgr);
|
|
if (endpointList) {
|
|
GWEN_MSG_ENDPOINT *ep;
|
|
int srcGroupId;
|
|
uint32_t msgGroup;
|
|
|
|
msgGroup=AQH_NodeMsg_GetMsgGroup(AQH_NodeMsg_GetMsgType(msg));
|
|
srcGroupId=GWEN_MsgEndpoint_GetGroupId(srcEp);
|
|
|
|
ep=GWEN_MsgEndpoint_List_First(endpointList);
|
|
while(ep) {
|
|
if (ep!=srcEp) {
|
|
uint32_t acceptedMsgGroups;
|
|
|
|
acceptedMsgGroups=AQH_NodeEndpoint_GetAcceptedMsgGroups(ep);
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "- checking endpoint %s (msgGroup=%08x, accept: %08x, flags: %08x)",
|
|
GWEN_MsgEndpoint_GetName(ep),
|
|
msgGroup, acceptedMsgGroups,
|
|
GWEN_MsgEndpoint_GetFlags(ep));
|
|
|
|
if (
|
|
!(GWEN_MsgEndpoint_GetFlags(ep) & AQH_MSGEP_NODE_FLAGS_NOMESSAGES) &&
|
|
(msgGroup & acceptedMsgGroups)
|
|
) {
|
|
/* endpoint accepts this message */
|
|
DBG_DEBUG(AQH_LOGDOMAIN, " - endpoint %s accepts message", GWEN_MsgEndpoint_GetName(ep));
|
|
GWEN_MsgEndpoint_ProcessOutMessage(ep, GWEN_Msg_dup(msg));
|
|
}
|
|
else {
|
|
DBG_DEBUG(AQH_LOGDOMAIN, " - endpoint %s does not accept message", GWEN_MsgEndpoint_GetName(ep));
|
|
}
|
|
}
|
|
ep=GWEN_MsgEndpoint_List_Next(ep);
|
|
}
|
|
}
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|