aqhome: More work on endpoint system. Basically works.

This commit is contained in:
Martin Preuss
2023-02-22 17:54:17 +01:00
parent da1ea9c268
commit 7a1968e962
12 changed files with 242 additions and 61 deletions

View File

@@ -45,6 +45,7 @@
<headers dist="true" > <headers dist="true" >
api.h api.h
aqhome.h
serial.h serial.h
serial_p.h serial_p.h
msg.h msg.h
@@ -72,6 +73,7 @@
<sources> <sources>
$(local/typefiles) $(local/typefiles)
aqhome.c
serial.c serial.c
msg.c msg.c
msg_value.c msg_value.c

View File

@@ -10,6 +10,9 @@
#define AQH_API_H #define AQH_API_H
#define AQH_LOGDOMAIN "aqhome"
# ifdef BUILDING_AQHOME # ifdef BUILDING_AQHOME
# /* building AqHome */ # /* building AqHome */
@@ -45,6 +48,5 @@
#endif #endif

61
aqhome/aqhome.c Normal file
View File

@@ -0,0 +1,61 @@
/****************************************************************************
* 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/aqhome.h"
#include <gwenhywfar/gwenhywfar.h>
#include <gwenhywfar/logger.h>
#include <gwenhywfar/debug.h>
#include <stdlib.h>
int AQH_Init()
{
int rv;
const char *s;
rv=GWEN_Init();
if (rv) {
DBG_ERROR_ERR(AQH_LOGDOMAIN, rv);
return rv;
}
if (!GWEN_Logger_IsOpen(AQH_LOGDOMAIN))
GWEN_Logger_Open(AQH_LOGDOMAIN, "aqhome", 0, GWEN_LoggerType_Console, GWEN_LoggerFacility_User);
s=getenv("AQHOME_LOGLEVEL");
if (s && *s) {
GWEN_LOGGER_LEVEL ll;
ll=GWEN_Logger_Name2Level(s);
GWEN_Logger_SetLevel(AQH_LOGDOMAIN, ll);
}
else
GWEN_Logger_SetLevel(AQH_LOGDOMAIN, GWEN_LoggerLevel_Notice);
return 0;
}
int AQH_Fini()
{
GWEN_Logger_Close(AQH_LOGDOMAIN);
GWEN_Fini();
return 0;
}

23
aqhome/aqhome.h Normal file
View File

@@ -0,0 +1,23 @@
/****************************************************************************
* 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.
****************************************************************************/
#ifndef AQH_AQHOME_H
#define AQH_AQHOME_H
#include <aqhome/api.h>
AQHOME_API int AQH_Init();
AQHOME_API int AQH_Fini();
#endif

View File

@@ -13,6 +13,11 @@
#include "aqhome/msg_haveaddr.h" #include "aqhome/msg_haveaddr.h"
#include "aqhome/msg_denyaddr.h" #include "aqhome/msg_denyaddr.h"
#include "aqhome/aqhome.h"
#include "aqhome/msgendpointmanager.h"
#include "aqhome/msgendpointtty.h"
#include "aqhome/msgendpointlog.h"
#include <gwenhywfar/debug.h> #include <gwenhywfar/debug.h>
#include <gwenhywfar/text.h> #include <gwenhywfar/text.h>
#include <gwenhywfar/gwentime.h> #include <gwenhywfar/gwentime.h>
@@ -372,6 +377,42 @@ int testReadLoop()
int testEndpoints()
{
int rv;
AQH_MSG_ENDPOINT_MGR *emgr;
AQH_MSG_ENDPOINT *epTty;
AQH_MSG_ENDPOINT *epLog;
rv=AQH_Init();
if (rv<0) {
}
emgr=AQH_MsgEndpointMgr_new(0xc0);
epTty=AQH_MsgEndpointTty_new("/dev/ttyUSB0");
if (epTty==NULL) {
DBG_ERROR(NULL, "Error creating endpoint TTY");
return 2;
}
AQH_MsgEndpointMgr_AddEndpoint(emgr, epTty);
epLog=AQH_MsgEndpointLog_new("endpoints.log");
if (epLog==NULL) {
DBG_ERROR(AQH_LOGDOMAIN, "Error creating endpoint LOG");
return 2;
}
AQH_MsgEndpointMgr_AddEndpoint(emgr, epLog);
for (;;) {
DBG_INFO(AQH_LOGDOMAIN, "Next loop");
AQH_MsgEndpointMgr_LoopOnce(emgr);
}
return 0;
}
int main(int argc, char **argv) int main(int argc, char **argv)
@@ -389,6 +430,9 @@ int main(int argc, char **argv)
else if (strcasecmp(cmd, "rwtest")==0) { else if (strcasecmp(cmd, "rwtest")==0) {
return testLoop(); return testLoop();
} }
else if (strcasecmp(cmd, "endpoint")==0) {
return testEndpoints();
}
//return testRecv(); //return testRecv();
//return testSend(); //return testSend();
return testLoop(); return testLoop();

View File

@@ -53,7 +53,7 @@ static int _setSocketNonBlocking(int fd);
AQH_MSG_ENDPOINT *AQH_MsgEndpoint_new(int fd, int groupId) AQH_MSG_ENDPOINT *AQH_MsgEndpoint_new(int fd, int groupId, const char *name)
{ {
AQH_MSG_ENDPOINT *ep; AQH_MSG_ENDPOINT *ep;
@@ -64,6 +64,7 @@ AQH_MSG_ENDPOINT *AQH_MsgEndpoint_new(int fd, int groupId)
ep->groupId=groupId; ep->groupId=groupId;
ep->receivedMessageList=AQH_Msg_List_new(); ep->receivedMessageList=AQH_Msg_List_new();
ep->sendMessageList=AQH_Msg_List_new(); ep->sendMessageList=AQH_Msg_List_new();
ep->name=name?strdup(name):"<unnamed>";
return ep; return ep;
} }
@@ -99,6 +100,14 @@ void AQH_MsgEndpoint_SetFd(AQH_MSG_ENDPOINT *ep, int fd)
} }
const char *AQH_MsgEndpoint_GetName(const AQH_MSG_ENDPOINT *ep)
{
return ep->name;
}
uint32_t AQH_MsgEndpoint_GetGroupId(const AQH_MSG_ENDPOINT *ep) uint32_t AQH_MsgEndpoint_GetGroupId(const AQH_MSG_ENDPOINT *ep)
{ {
return ep->groupId; return ep->groupId;
@@ -424,12 +433,14 @@ int AQH_MsgEndpoint_DiscardInput(AQH_MSG_ENDPOINT *ep)
rv=read(ep->fd, buffer, sizeof(buffer)); rv=read(ep->fd, buffer, sizeof(buffer));
} while( (rv>0 || (rv<0) && errno==EINTR)); } while( (rv>0 || (rv<0) && errno==EINTR));
if (rv<0 && errno!=EAGAIN && errno!=EWOULDBLOCK) { if (rv<0 && errno!=EAGAIN && errno!=EWOULDBLOCK) {
DBG_ERROR(NULL, "Error on read(): %s (%d)", strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on read(): %s (%d)", strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
else if (rv==0) { else if (rv==0) {
DBG_ERROR(NULL, "EOF met on read()"); DBG_ERROR(AQH_LOGDOMAIN, "EOF met on read()");
#if 0
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
#endif
} }
return 0; return 0;
} }
@@ -443,17 +454,18 @@ int _internalHandleReadable(AQH_MSG_ENDPOINT *ep)
int len; int len;
int i; int i;
DBG_INFO(AQH_LOGDOMAIN, "Reading from endpoint %s", AQH_MsgEndpoint_GetName(ep));
do { do {
rv=read(ep->fd, buffer, sizeof(buffer)); rv=read(ep->fd, buffer, sizeof(buffer));
} while( (rv<0) && errno==EINTR); } while( (rv<0) && errno==EINTR);
if (rv<0) { if (rv<0) {
if (errno==EAGAIN || errno==EWOULDBLOCK) if (errno==EAGAIN || errno==EWOULDBLOCK)
return GWEN_ERROR_TRY_AGAIN; return GWEN_ERROR_TRY_AGAIN;
DBG_ERROR(NULL, "Error on read(): %s (%d)", strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on read(): %s (%d)", strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
else if (rv==0) { else if (rv==0) {
DBG_ERROR(NULL, "EOF met on read()"); DBG_ERROR(AQH_LOGDOMAIN, "EOF met on read()");
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
len=rv; len=rv;
@@ -463,30 +475,30 @@ int _internalHandleReadable(AQH_MSG_ENDPOINT *ep)
ep->currentlyReceivedMsg=AQH_Msg_new(); ep->currentlyReceivedMsg=AQH_Msg_new();
rv=AQH_Msg_AddByte(ep->currentlyReceivedMsg, buffer[i]); rv=AQH_Msg_AddByte(ep->currentlyReceivedMsg, buffer[i]);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
rv=AQH_Msg_IsMsgComplete(ep->currentlyReceivedMsg); rv=AQH_Msg_IsMsgComplete(ep->currentlyReceivedMsg);
if (rv<0) { if (rv<0) {
/* invalid message */ /* invalid message */
DBG_ERROR(NULL, "Invalid message, discarding"); DBG_ERROR(AQH_LOGDOMAIN, "Invalid message, discarding");
AQH_Msg_free(ep->currentlyReceivedMsg); AQH_Msg_free(ep->currentlyReceivedMsg);
ep->currentlyReceivedMsg=NULL; ep->currentlyReceivedMsg=NULL;
rv=AQH_MsgEndpoint_DiscardInput(ep); rv=AQH_MsgEndpoint_DiscardInput(ep);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
} }
else if (rv>0) { else if (rv>0) {
if (!AQH_Msg_IsChecksumValid(ep->currentlyReceivedMsg)) { if (!AQH_Msg_IsChecksumValid(ep->currentlyReceivedMsg)) {
DBG_ERROR(NULL, "Invalid checksum, discarding message"); DBG_ERROR(AQH_LOGDOMAIN, "Invalid checksum, discarding message");
GWEN_Text_DumpString(AQH_Msg_GetBuffer(ep->currentlyReceivedMsg), AQH_Msg_GetBytesInBuffer(ep->currentlyReceivedMsg), 6); GWEN_Text_DumpString(AQH_Msg_GetBuffer(ep->currentlyReceivedMsg), AQH_Msg_GetBytesInBuffer(ep->currentlyReceivedMsg), 6);
AQH_Msg_free(ep->currentlyReceivedMsg); AQH_Msg_free(ep->currentlyReceivedMsg);
ep->currentlyReceivedMsg=NULL; ep->currentlyReceivedMsg=NULL;
rv=AQH_MsgEndpoint_DiscardInput(ep); rv=AQH_MsgEndpoint_DiscardInput(ep);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
} }
@@ -507,6 +519,7 @@ int _internalHandleWritable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
{ {
AQH_MSG *msg; AQH_MSG *msg;
DBG_INFO(AQH_LOGDOMAIN, "Writing to endpoint %s", AQH_MsgEndpoint_GetName(ep));
msg=AQH_Msg_List_First(ep->sendMessageList); msg=AQH_Msg_List_First(ep->sendMessageList);
if (msg) { if (msg) {
uint8_t pos; uint8_t pos;
@@ -516,7 +529,7 @@ int _internalHandleWritable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
rv=AQH_MsgEndpoint_CheckMsg(ep); rv=AQH_MsgEndpoint_CheckMsg(ep);
if (rv<0 || rv==1) { if (rv<0 || rv==1) {
DBG_ERROR(NULL, "Line busy, not sending"); DBG_ERROR(AQH_LOGDOMAIN, "Line busy, not sending");
usleep(100); usleep(100);
return 0; return 0;
} }
@@ -527,7 +540,7 @@ int _internalHandleWritable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
rv=AQH_MsgEndpoint_StartMsg(ep); rv=AQH_MsgEndpoint_StartMsg(ep);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
@@ -538,7 +551,7 @@ int _internalHandleWritable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
if (rv<0) { if (rv<0) {
if (errno==EAGAIN || errno==EWOULDBLOCK) if (errno==EAGAIN || errno==EWOULDBLOCK)
return GWEN_ERROR_TRY_AGAIN; return GWEN_ERROR_TRY_AGAIN;
DBG_ERROR(NULL, "Error on write(): %s (%d)", strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on write(): %s (%d)", strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
AQH_Msg_IncCurrentPos(msg, rv); AQH_Msg_IncCurrentPos(msg, rv);
@@ -548,7 +561,7 @@ int _internalHandleWritable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
AQH_Msg_List_Del(msg); AQH_Msg_List_Del(msg);
AQH_Msg_free(msg); AQH_Msg_free(msg);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
} }

View File

@@ -58,12 +58,14 @@ typedef int (*AQH_MSG_ENDPOINT_CHECKMSG_FN)(AQH_MSG_ENDPOINT *ep);
AQHOME_API AQH_MSG_ENDPOINT *AQH_MsgEndpoint_new(int fd, int groupId); AQHOME_API AQH_MSG_ENDPOINT *AQH_MsgEndpoint_new(int fd, int groupId, const char *name);
AQHOME_API void AQH_MsgEndpoint_free(AQH_MSG_ENDPOINT *ep); AQHOME_API void AQH_MsgEndpoint_free(AQH_MSG_ENDPOINT *ep);
AQHOME_API int AQH_MsgEndpoint_GetFd(const AQH_MSG_ENDPOINT *ep); AQHOME_API int AQH_MsgEndpoint_GetFd(const AQH_MSG_ENDPOINT *ep);
AQHOME_API void AQH_MsgEndpoint_SetFd(AQH_MSG_ENDPOINT *ep, int fd); AQHOME_API void AQH_MsgEndpoint_SetFd(AQH_MSG_ENDPOINT *ep, int fd);
AQHOME_API const char *AQH_MsgEndpoint_GetName(const AQH_MSG_ENDPOINT *ep);
AQHOME_API uint32_t AQH_MsgEndpoint_GetGroupId(const AQH_MSG_ENDPOINT *ep); AQHOME_API uint32_t AQH_MsgEndpoint_GetGroupId(const AQH_MSG_ENDPOINT *ep);
AQHOME_API uint32_t AQH_MsgEndpoint_GetAcceptedMsgGroups(const AQH_MSG_ENDPOINT *ep); AQHOME_API uint32_t AQH_MsgEndpoint_GetAcceptedMsgGroups(const AQH_MSG_ENDPOINT *ep);

View File

@@ -23,6 +23,8 @@ struct AQH_MSG_ENDPOINT {
GWEN_LIST_ELEMENT(AQH_MSG_ENDPOINT) GWEN_LIST_ELEMENT(AQH_MSG_ENDPOINT)
int fd; int fd;
char *name;
AQH_MSG_LIST *receivedMessageList; AQH_MSG_LIST *receivedMessageList;
AQH_MSG_LIST *sendMessageList; AQH_MSG_LIST *sendMessageList;
AQH_MSG *currentlyReceivedMsg; AQH_MSG *currentlyReceivedMsg;

View File

@@ -47,7 +47,7 @@ AQH_MSG_ENDPOINT *AQH_MsgEndpointLog_new(const char *filename)
AQH_MSG_ENDPOINT *ep; AQH_MSG_ENDPOINT *ep;
AQH_MSG_ENDPOINT_LOG *xep; AQH_MSG_ENDPOINT_LOG *xep;
ep=AQH_MsgEndpoint_new(-1, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET); ep=AQH_MsgEndpoint_new(-1, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET, "LOG");
GWEN_NEW_OBJECT(AQH_MSG_ENDPOINT_LOG, xep); GWEN_NEW_OBJECT(AQH_MSG_ENDPOINT_LOG, xep);
xep->filename=strdup(filename); xep->filename=strdup(filename);
GWEN_INHERIT_SETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_LOG, ep, xep, _freeData); GWEN_INHERIT_SETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_LOG, ep, xep, _freeData);
@@ -143,7 +143,7 @@ void _writeToLogFile(const char *filename, const char *txt)
f=fopen(filename, "a+"); f=fopen(filename, "a+");
if (f) { if (f) {
if (1!=fwrite(txt, strlen(txt), 1, f)) { if (1!=fwrite(txt, strlen(txt), 1, f)) {
DBG_ERROR(NULL, "Error logging."); DBG_ERROR(AQH_LOGDOMAIN, "Error logging.");
} }
fclose(f); fclose(f);
} }

View File

@@ -110,42 +110,57 @@ int _ioLoopOnce(AQH_MSG_ENDPOINT_MGR *emgr)
tv.tv_sec=2; tv.tv_sec=2;
tv.tv_usec=0; tv.tv_usec=0;
DBG_INFO(AQH_LOGDOMAIN, "Sampling sockets");
ep=AQH_MsgEndpoint_List_First(emgr->endpointList); ep=AQH_MsgEndpoint_List_First(emgr->endpointList);
if (ep==NULL) {
DBG_ERROR(AQH_LOGDOMAIN, "No endpoints.");
return GWEN_ERROR_GENERIC;
}
while(ep) { while(ep) {
DBG_INFO(AQH_LOGDOMAIN, "- checking endpoint %s", AQH_MsgEndpoint_GetName(ep));
if (!(AQH_MsgEndpoint_GetFlags(ep) & AQH_MSG_ENDPOINT_FLAGS_NOIO)) { if (!(AQH_MsgEndpoint_GetFlags(ep) & AQH_MSG_ENDPOINT_FLAGS_NOIO)) {
int fd; int fd;
fd=AQH_MsgEndpoint_GetReadFd(ep); fd=AQH_MsgEndpoint_GetReadFd(ep);
if (fd!=-1) { if (fd>=0) {
DBG_INFO(AQH_LOGDOMAIN, " - adding socket %d for read", fd);
FD_SET(fd, &readSet); FD_SET(fd, &readSet);
highestRdFd=(fd>highestRdFd)?fd:highestRdFd; highestRdFd=(fd>highestRdFd)?fd:highestRdFd;
} }
fd=AQH_MsgEndpoint_GetWriteFd(ep); fd=AQH_MsgEndpoint_GetWriteFd(ep);
if (fd!=-1) { if (fd>=0) {
DBG_INFO(AQH_LOGDOMAIN, " - adding socket %d for write", fd);
FD_SET(fd, &writeSet); FD_SET(fd, &writeSet);
highestWrFd=(fd>highestWrFd)?fd:highestWrFd; highestWrFd=(fd>highestWrFd)?fd:highestWrFd;
} }
} }
else {
DBG_INFO(AQH_LOGDOMAIN, " - endpoint %s does not support IO", AQH_MsgEndpoint_GetName(ep));
}
ep=AQH_MsgEndpoint_List_Next(ep); ep=AQH_MsgEndpoint_List_Next(ep);
} }
DBG_INFO(AQH_LOGDOMAIN, "Calling select (highest read socket: %d, highest write socket: %d)", highestRdFd, highestWrFd);
rv=select(((highestRdFd>highestWrFd)?highestRdFd:highestWrFd)+1, rv=select(((highestRdFd>highestWrFd)?highestRdFd:highestWrFd)+1,
(highestRdFd<0)?NULL:&readSet, (highestRdFd<0)?NULL:&readSet,
(highestWrFd<0)?NULL:&writeSet, (highestWrFd<0)?NULL:&writeSet,
NULL, NULL,
&tv); &tv);
DBG_INFO(AQH_LOGDOMAIN, "Return from select (%d, %d=%s)", rv, (rv<0)?errno:0, (rv<0)?strerror(errno):"no error");
if (rv<0) { if (rv<0) {
if (errno!=EINTR) { if (errno!=EINTR) {
DBG_ERROR(NULL, "Error on select"); DBG_ERROR(AQH_LOGDOMAIN, "Error on select");
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
} }
else if (rv==0) { else if (rv==0) {
/* timeout */ /* timeout */
DBG_INFO(AQH_LOGDOMAIN, "timeout");
return GWEN_ERROR_TRY_AGAIN; return GWEN_ERROR_TRY_AGAIN;
} }
else if (rv) { else if (rv) {
DBG_INFO(AQH_LOGDOMAIN, "Letting all endpoints handle IO");
ep=AQH_MsgEndpoint_List_First(emgr->endpointList); ep=AQH_MsgEndpoint_List_First(emgr->endpointList);
while(ep) { while(ep) {
AQH_MSG_ENDPOINT *epNext; AQH_MSG_ENDPOINT *epNext;
@@ -155,15 +170,19 @@ int _ioLoopOnce(AQH_MSG_ENDPOINT_MGR *emgr)
epNext=AQH_MsgEndpoint_List_Next(ep); epNext=AQH_MsgEndpoint_List_Next(ep);
fd=AQH_MsgEndpoint_GetFd(ep); fd=AQH_MsgEndpoint_GetFd(ep);
if (fd!=-1 && FD_ISSET(fd, &readSet)) { if (fd!=-1 && FD_ISSET(fd, &readSet)) {
DBG_INFO(AQH_LOGDOMAIN, "- endpoint(%s): read", AQH_MsgEndpoint_GetName(ep));
rv=AQH_MsgEndpoint_HandleReadable(ep, emgr); rv=AQH_MsgEndpoint_HandleReadable(ep, emgr);
if (rv<0 && rv!=GWEN_ERROR_TRY_AGAIN) { if (rv<0 && rv!=GWEN_ERROR_TRY_AGAIN) {
DBG_INFO(AQH_LOGDOMAIN, "error, removing endpoint %s", AQH_MsgEndpoint_GetName(ep));
fd=-1; fd=-1;
AQH_MsgEndpointMgr_DelEndpoint(emgr, ep); AQH_MsgEndpointMgr_DelEndpoint(emgr, ep);
} }
} }
if (fd!=-1 && FD_ISSET(fd, &writeSet)) { if (fd!=-1 && FD_ISSET(fd, &writeSet)) {
DBG_INFO(AQH_LOGDOMAIN, "- endpoint(%s): write", AQH_MsgEndpoint_GetName(ep));
rv=AQH_MsgEndpoint_HandleWritable(ep, emgr); rv=AQH_MsgEndpoint_HandleWritable(ep, emgr);
if (rv<0 && rv!=GWEN_ERROR_TRY_AGAIN) { if (rv<0 && rv!=GWEN_ERROR_TRY_AGAIN) {
DBG_INFO(AQH_LOGDOMAIN, "error, removing endpoint %s", AQH_MsgEndpoint_GetName(ep));
fd=-1; fd=-1;
AQH_MsgEndpointMgr_DelEndpoint(emgr, ep); AQH_MsgEndpointMgr_DelEndpoint(emgr, ep);
} }
@@ -181,21 +200,30 @@ void _msgLoopOnce(AQH_MSG_ENDPOINT_MGR *emgr)
{ {
AQH_MSG_ENDPOINT *ep; AQH_MSG_ENDPOINT *ep;
DBG_INFO(AQH_LOGDOMAIN, "Handle endpoint messages");
ep=AQH_MsgEndpoint_List_First(emgr->endpointList); ep=AQH_MsgEndpoint_List_First(emgr->endpointList);
while(ep) { while(ep) {
AQH_MSG *msg; AQH_MSG *msg;
DBG_INFO(AQH_LOGDOMAIN, "- endpoint(%s)", AQH_MsgEndpoint_GetName(ep));
while( (msg=AQH_MsgEndpoint_TakeFirstReceivedMessage(ep)) ) { while( (msg=AQH_MsgEndpoint_TakeFirstReceivedMessage(ep)) ) {
uint32_t msgGroup; uint32_t msgGroup;
DBG_INFO(AQH_LOGDOMAIN,
" - msg %d from %d to %d",
AQH_Msg_GetMsgType(msg), AQH_Msg_GetSourceAddress(msg), AQH_Msg_GetDestAddress(msg));
msgGroup=_getMsgGroup(AQH_Msg_GetMsgType(msg)); msgGroup=_getMsgGroup(AQH_Msg_GetMsgType(msg));
if (msgGroup & AQH_MSG_ENDPOINT_MSGGROUP_ADMIN) { if (msgGroup & AQH_MSG_ENDPOINT_MSGGROUP_ADMIN) {
if (!(AQH_MsgEndpoint_GetGroupId(ep) & AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS)) if (!(AQH_MsgEndpoint_GetGroupId(ep) & AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS)) {
/* only handle admin messages not from nodes */ /* only handle admin messages not from nodes */
DBG_INFO(AQH_LOGDOMAIN, " - handling admin message");
_handleAdminMsg(emgr, ep, msg); _handleAdminMsg(emgr, ep, msg);
}
} }
else else {
DBG_INFO(AQH_LOGDOMAIN, " - distributing message");
_distributeMsg(emgr, ep, msg); _distributeMsg(emgr, ep, msg);
}
AQH_Msg_free(msg); AQH_Msg_free(msg);
} }
@@ -209,11 +237,13 @@ void _runAllEndpoints(AQH_MSG_ENDPOINT_MGR *emgr)
{ {
AQH_MSG_ENDPOINT *ep; AQH_MSG_ENDPOINT *ep;
DBG_INFO(AQH_LOGDOMAIN, "Running all endpoints");
ep=AQH_MsgEndpoint_List_First(emgr->endpointList); ep=AQH_MsgEndpoint_List_First(emgr->endpointList);
while(ep) { while(ep) {
AQH_MSG_ENDPOINT *next; AQH_MSG_ENDPOINT *next;
next=AQH_MsgEndpoint_List_Next(ep); next=AQH_MsgEndpoint_List_Next(ep);
DBG_INFO(AQH_LOGDOMAIN, "- running endpoint %s", AQH_MsgEndpoint_GetName(ep));
AQH_MsgEndpoint_Run(ep); AQH_MsgEndpoint_Run(ep);
ep=next; ep=next;
} }
@@ -236,6 +266,7 @@ void _distributeMsg(AQH_MSG_ENDPOINT_MGR *emgr, AQH_MSG_ENDPOINT *srcEp, const A
uint32_t acceptedGroupIds; uint32_t acceptedGroupIds;
uint32_t acceptedMsgGroups; uint32_t acceptedMsgGroups;
DBG_INFO(AQH_LOGDOMAIN, "- checking endpoint %s", AQH_MsgEndpoint_GetName(ep));
acceptedGroupIds=AQH_MsgEndpoint_GetAcceptedMsgGroups(ep); acceptedGroupIds=AQH_MsgEndpoint_GetAcceptedMsgGroups(ep);
acceptedMsgGroups=AQH_MsgEndpoint_GetAcceptedMsgGroups(ep); acceptedMsgGroups=AQH_MsgEndpoint_GetAcceptedMsgGroups(ep);
@@ -245,8 +276,12 @@ void _distributeMsg(AQH_MSG_ENDPOINT_MGR *emgr, AQH_MSG_ENDPOINT *srcEp, const A
(acceptedGroupIds & srcGroupId) (acceptedGroupIds & srcGroupId)
) { ) {
/* endpoint accepts this message */ /* endpoint accepts this message */
DBG_INFO(AQH_LOGDOMAIN, " - endpoint %s accepts message", AQH_MsgEndpoint_GetName(ep));
AQH_MsgEndpoint_AddSendMessage(ep, AQH_Msg_dup(msg)); AQH_MsgEndpoint_AddSendMessage(ep, AQH_Msg_dup(msg));
} }
else {
DBG_INFO(AQH_LOGDOMAIN, " - endpoint %s does not accept message", AQH_MsgEndpoint_GetName(ep));
}
} }
ep=AQH_MsgEndpoint_List_Next(ep); ep=AQH_MsgEndpoint_List_Next(ep);
} }

View File

@@ -56,7 +56,7 @@ AQH_MSG_ENDPOINT *AQH_MsgEndpointTcp_new(const char *host, int port)
return NULL; return NULL;
} }
ep=AQH_MsgEndpoint_new(fd, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET); ep=AQH_MsgEndpoint_new(fd, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET, "TCP Server");
AQH_MsgEndpoint_SetAcceptedEndpointGroups(ep, AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS); AQH_MsgEndpoint_SetAcceptedEndpointGroups(ep, AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS);
AQH_MsgEndpoint_AddFlags(ep, AQH_MSG_ENDPOINT_FLAGS_NOMESSAGES); AQH_MsgEndpoint_AddFlags(ep, AQH_MSG_ENDPOINT_FLAGS_NOMESSAGES);
@@ -88,13 +88,13 @@ int _setupListeningSocket(const char *host, int port)
sk=socket(AF_INET, SOCK_STREAM, 0); sk=socket(AF_INET, SOCK_STREAM, 0);
if (sk<0) { if (sk<0) {
/* socket error */ /* socket error */
DBG_ERROR(NULL, "socket(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "socket(): %s", strerror(errno));
} }
i=1; i=1;
rv=setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &i, sizeof(i)); rv=setsockopt(sk, SOL_SOCKET, SO_REUSEADDR, &i, sizeof(i));
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "setsockopt(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "setsockopt(): %s", strerror(errno));
close(sk); close(sk);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
@@ -109,14 +109,14 @@ int _setupListeningSocket(const char *host, int port)
rv=bind(sk, (struct sockaddr*) &addr, sizeof(addr)); rv=bind(sk, (struct sockaddr*) &addr, sizeof(addr));
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "bind(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "bind(): %s", strerror(errno));
close(sk); close(sk);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
rv=listen(sk, AQH_MSG_ENDPOINTTCP_BACKLOG); rv=listen(sk, AQH_MSG_ENDPOINTTCP_BACKLOG);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "listen(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "listen(): %s", strerror(errno));
close(sk); close(sk);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
@@ -134,7 +134,7 @@ int _setSocketNonBlocking(int fd)
/* get current socket flags */ /* get current socket flags */
prevFlags=fcntl(fd, F_GETFL); prevFlags=fcntl(fd, F_GETFL);
if (prevFlags==-1) { if (prevFlags==-1) {
DBG_ERROR(NULL, "fcntl(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "fcntl(): %s", strerror(errno));
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
@@ -142,7 +142,7 @@ int _setSocketNonBlocking(int fd)
newFlags=prevFlags|O_NONBLOCK; newFlags=prevFlags|O_NONBLOCK;
if (-1==fcntl(fd, F_SETFL, newFlags)) { if (-1==fcntl(fd, F_SETFL, newFlags)) {
DBG_ERROR(NULL, "fcntl(): %s", strerror(errno)); DBG_ERROR(AQH_LOGDOMAIN, "fcntl(): %s", strerror(errno));
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
@@ -184,7 +184,7 @@ int _handleReadable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
if (rv<0) { if (rv<0) {
if (errno==EAGAIN || errno==EWOULDBLOCK) if (errno==EAGAIN || errno==EWOULDBLOCK)
return GWEN_ERROR_TRY_AGAIN; return GWEN_ERROR_TRY_AGAIN;
DBG_ERROR(NULL, "Error on accept(): %s (%d)", strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on accept(): %s (%d)", strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
newSock=rv; newSock=rv;
@@ -196,7 +196,7 @@ int _handleReadable(AQH_MSG_ENDPOINT *ep, AQH_MSG_ENDPOINT_MGR *emgr)
return rv; return rv;
} }
newEp=AQH_MsgEndpoint_new(newSock, AQH_MsgEndpoint_GetGroupId(ep)); newEp=AQH_MsgEndpoint_new(newSock, AQH_MsgEndpoint_GetGroupId(ep), "TCP Client");
AQH_MsgEndpoint_SetFlags(newEp, AQH_MsgEndpoint_GetFlags(ep)); AQH_MsgEndpoint_SetFlags(newEp, AQH_MsgEndpoint_GetFlags(ep));
AQH_MsgEndpoint_SubFlags(newEp, AQH_MSG_ENDPOINT_FLAGS_NOMESSAGES); AQH_MsgEndpoint_SubFlags(newEp, AQH_MSG_ENDPOINT_FLAGS_NOMESSAGES);
AQH_MsgEndpoint_SetAcceptedMsgGroups(newEp, AQH_MsgEndpoint_GetAcceptedMsgGroups(ep)); AQH_MsgEndpoint_SetAcceptedMsgGroups(newEp, AQH_MsgEndpoint_GetAcceptedMsgGroups(ep));

View File

@@ -38,7 +38,7 @@ static int _startMsg(AQH_MSG_ENDPOINT *ep);
static int _endMsg(AQH_MSG_ENDPOINT *ep); static int _endMsg(AQH_MSG_ENDPOINT *ep);
static int _checkMsg(AQH_MSG_ENDPOINT *ep); static int _checkMsg(AQH_MSG_ENDPOINT *ep);
static int _setupDevice(AQH_MSG_ENDPOINT *ep); static int _openDevice(AQH_MSG_ENDPOINT *ep);
static int _attnLow(AQH_MSG_ENDPOINT *ep); static int _attnLow(AQH_MSG_ENDPOINT *ep);
static int _attnHigh(AQH_MSG_ENDPOINT *ep); static int _attnHigh(AQH_MSG_ENDPOINT *ep);
static int _isAttnLow(AQH_MSG_ENDPOINT *ep); static int _isAttnLow(AQH_MSG_ENDPOINT *ep);
@@ -53,32 +53,27 @@ AQH_MSG_ENDPOINT *AQH_MsgEndpointTty_new(const char *deviceName)
AQH_MSG_ENDPOINT *ep; AQH_MSG_ENDPOINT *ep;
AQH_MSG_ENDPOINT_TTY *xep; AQH_MSG_ENDPOINT_TTY *xep;
int fd; int fd;
int rv;
fd=open(deviceName, O_NOCTTY | O_NDELAY | O_RDWR); ep=AQH_MsgEndpoint_new(-1, AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS, "TTY");
if (fd<0) {
DBG_ERROR(NULL, "Error on open(%s): %s (%d)", deviceName, strerror(errno), errno);
return NULL;
}
ep=AQH_MsgEndpoint_new(fd, AQH_MSG_ENDPOINT_ENDPOINTGROUP_BUS);
AQH_MsgEndpoint_SetAcceptedEndpointGroups(ep, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET); AQH_MsgEndpoint_SetAcceptedEndpointGroups(ep, AQH_MSG_ENDPOINT_ENDPOINTGROUP_NET);
AQH_MsgEndpoint_SetAcceptedMsgGroups(ep, AQH_MSG_ENDPOINT_MSGGROUP_ALL);
GWEN_NEW_OBJECT(AQH_MSG_ENDPOINT_TTY, xep); GWEN_NEW_OBJECT(AQH_MSG_ENDPOINT_TTY, xep);
GWEN_INHERIT_SETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_TTY, ep, xep, _freeData); GWEN_INHERIT_SETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_TTY, ep, xep, _freeData);
xep->deviceName=strdup(deviceName); xep->deviceName=strdup(deviceName);
_attnHigh(ep);
AQH_MsgEndpoint_SetStartMsgFn(ep, _startMsg); AQH_MsgEndpoint_SetStartMsgFn(ep, _startMsg);
AQH_MsgEndpoint_SetEndMsgFn(ep, _endMsg); AQH_MsgEndpoint_SetEndMsgFn(ep, _endMsg);
AQH_MsgEndpoint_SetCheckMsgFn(ep, _checkMsg); AQH_MsgEndpoint_SetCheckMsgFn(ep, _checkMsg);
rv=_setupDevice(ep); fd=_openDevice(ep);
if (rv<0) { if (fd<0) {
DBG_INFO(NULL, "here (%d)", rv); DBG_INFO(NULL, "here (%d)", fd);
AQH_MsgEndpoint_free(ep); AQH_MsgEndpoint_free(ep);
return NULL; return NULL;
} }
AQH_MsgEndpoint_SetFd(ep, fd);
_attnHigh(ep);
return ep; return ep;
} }
@@ -112,7 +107,7 @@ int _startMsg(AQH_MSG_ENDPOINT *ep)
rv=_attnLow(ep); rv=_attnLow(ep);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "here (%d)", rv); DBG_ERROR(AQH_LOGDOMAIN, "here (%d)", rv);
return rv; return rv;
} }
usleep(AQH_MSG_ENDPOINT_TTY_BYTE_MICROSECS/5); usleep(AQH_MSG_ENDPOINT_TTY_BYTE_MICROSECS/5);
@@ -137,7 +132,7 @@ int _checkMsg(AQH_MSG_ENDPOINT *ep)
int _setupDevice(AQH_MSG_ENDPOINT *ep) int _openDevice(AQH_MSG_ENDPOINT *ep)
{ {
AQH_MSG_ENDPOINT_TTY *xep; AQH_MSG_ENDPOINT_TTY *xep;
int fd; int fd;
@@ -148,10 +143,14 @@ int _setupDevice(AQH_MSG_ENDPOINT *ep)
int m; int m;
xep=GWEN_INHERIT_GETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_TTY, ep); xep=GWEN_INHERIT_GETDATA(AQH_MSG_ENDPOINT, AQH_MSG_ENDPOINT_TTY, ep);
fd=AQH_MsgEndpoint_GetFd(ep); fd=open(xep->deviceName, O_NOCTTY | O_NDELAY | O_RDWR);
if (fd<0) {
DBG_ERROR(AQH_LOGDOMAIN, "Error on open(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO;
}
rv=tcgetattr(fd, &(xep->previousOptions)); rv=tcgetattr(fd, &(xep->previousOptions));
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on tcgetattr(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on tcgetattr(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
memset(&options, 0, sizeof(options)); /* preset */ memset(&options, 0, sizeof(options)); /* preset */
@@ -166,30 +165,28 @@ int _setupDevice(AQH_MSG_ENDPOINT *ep)
rv=cfsetispeed(&options, AQH_MSG_ENDPOINT_TTY_BAUDRATE); rv=cfsetispeed(&options, AQH_MSG_ENDPOINT_TTY_BAUDRATE);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on cfsetispeed(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on cfsetispeed(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
rv=cfsetospeed(&options, AQH_MSG_ENDPOINT_TTY_BAUDRATE); rv=cfsetospeed(&options, AQH_MSG_ENDPOINT_TTY_BAUDRATE);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on cfsetospeed(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on cfsetospeed(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
rv=tcflush(fd, TCIOFLUSH); rv=tcflush(fd, TCIOFLUSH);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on tcflush(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on tcflush(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
rv=tcsetattr(fd, TCSANOW, &options); rv=tcsetattr(fd, TCSANOW, &options);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on tcsetattr(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on tcsetattr(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
_attnHigh(ep); return fd;
return 0;
} }
@@ -205,13 +202,13 @@ int _attnLow(AQH_MSG_ENDPOINT *ep)
fd=AQH_MsgEndpoint_GetFd(ep); fd=AQH_MsgEndpoint_GetFd(ep);
rv=ioctl(fd, TIOCMGET, &status); /* GET the State of MODEM bits in Status */ rv=ioctl(fd, TIOCMGET, &status); /* GET the State of MODEM bits in Status */
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
status |= TIOCM_DTR | TIOCM_RTS; /* clear the DTR pin (cave: signals inverted!) */ status |= TIOCM_DTR | TIOCM_RTS; /* clear the DTR pin (cave: signals inverted!) */
rv=ioctl(fd, TIOCMSET, &status); rv=ioctl(fd, TIOCMSET, &status);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
xep->intendedAttnState=0; xep->intendedAttnState=0;
@@ -231,14 +228,14 @@ int _attnHigh(AQH_MSG_ENDPOINT *ep)
fd=AQH_MsgEndpoint_GetFd(ep); fd=AQH_MsgEndpoint_GetFd(ep);
rv=ioctl(fd, TIOCMGET, &status); rv=ioctl(fd, TIOCMGET, &status);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
status |= TIOCM_DTR; /* Set the DTR pin */ status |= TIOCM_DTR; /* Set the DTR pin */
status &= ~ (TIOCM_DTR | TIOCM_RTS); /* clear the DTR pin (cave: signals inverted!) */ status &= ~ (TIOCM_DTR | TIOCM_RTS); /* clear the DTR pin (cave: signals inverted!) */
rv=ioctl(fd, TIOCMSET, &status); rv=ioctl(fd, TIOCMSET, &status);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
@@ -259,7 +256,7 @@ int _isAttnLow(AQH_MSG_ENDPOINT *ep)
fd=AQH_MsgEndpoint_GetFd(ep); fd=AQH_MsgEndpoint_GetFd(ep);
rv=ioctl(fd, TIOCMGET, &status); rv=ioctl(fd, TIOCMGET, &status);
if (rv<0) { if (rv<0) {
DBG_ERROR(NULL, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno); DBG_ERROR(AQH_LOGDOMAIN, "Error on ioctl(%s): %s (%d)", xep->deviceName, strerror(errno), errno);
return GWEN_ERROR_IO; return GWEN_ERROR_IO;
} }
//return (status & TIOCM_CTS)?1:0; //return (status & TIOCM_CTS)?1:0;