460 lines
11 KiB
C
460 lines
11 KiB
C
|
|
#ifdef HAVE_CONFIG_H
|
|
# include <config.h>
|
|
#endif
|
|
|
|
#include "aqhome/msg/msg_ping.h"
|
|
#include "aqhome/msg/endpointmgr.h"
|
|
#include "aqhome/msg/endpoint_node.h"
|
|
#include "aqhome/msg/endpoint_log.h"
|
|
#include "aqhome/msg/endpoint_tty.h"
|
|
#include "aqhome/ipc/endpoint_node_ipc_tcpd.h"
|
|
#include "aqhome/ipc/endpoint_ipc_tcpc.h"
|
|
#include "aqhome/ipc/msg_ipc_ping.h"
|
|
#include "aqhome/ipc/msg_ipc_forward.h"
|
|
#include "aqhome/ipc/msg_ipc_setaccmsggrps.h"
|
|
#include "aqhome/mqtt/endpoint_mqttc.h"
|
|
#include "aqhome/mqtt/msg_mqtt_connect.h"
|
|
#include "aqhome/mqtt/msg_mqtt_connack.h"
|
|
#include "aqhome/mqtt/msg_mqtt_publish.h"
|
|
#include "aqhome/mqtt/msg_mqtt_pubresponse.h"
|
|
#include "aqhome/msgmanager.h"
|
|
#include "aqhome/hexfile/hexfile.h"
|
|
#include "aqhome/hexfile/flashrecord.h"
|
|
|
|
#include "aqhome/aqhome.h"
|
|
|
|
#include <gwenhywfar/debug.h>
|
|
#include <gwenhywfar/text.h>
|
|
#include <gwenhywfar/gwentime.h>
|
|
#include <gwenhywfar/buffer.h>
|
|
#include <gwenhywfar/endpoint_tcpd_ipc.h>
|
|
#include <gwenhywfar/endpoint_tcpc.h>
|
|
|
|
#include <unistd.h>
|
|
#include <time.h>
|
|
|
|
|
|
|
|
GWEN_MSG *createPingMsg(uint8_t destAddr, uint8_t srcAddr)
|
|
{
|
|
GWEN_MSG *msg;
|
|
int rv;
|
|
|
|
msg=GWEN_Msg_new(AQH_MAXMSGSIZE);
|
|
rv=GWEN_Msg_AddByte(msg, destAddr);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR1: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, 6); /* msglen */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR2: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, AQH_MSG_TYPE_PING); /* ping */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR3: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, srcAddr); /* src addr */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR4: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
rv=GWEN_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR5: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR6: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR7: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=GWEN_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR8: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
|
|
rv=AQH_NodeMsg_AddChecksum(msg);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR9: %d\n", rv);
|
|
GWEN_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
return msg;
|
|
}
|
|
|
|
|
|
|
|
int testEndpoints()
|
|
{
|
|
int rv;
|
|
GWEN_MSG_ENDPOINT_MGR *emgr;
|
|
GWEN_MSG_ENDPOINT *epTty;
|
|
GWEN_MSG_ENDPOINT *epLog;
|
|
GWEN_MSG_ENDPOINT *epTcp;
|
|
|
|
rv=AQH_Init();
|
|
if (rv<0) {
|
|
}
|
|
|
|
emgr=AQH_MsgManager_new(0xc0);
|
|
epTty=AQH_TtyNodeEndpoint_new("/dev/ttyUSB0", AQH_MSGMGR_ENDPOINTGROUP_NODE);
|
|
if (epTty==NULL) {
|
|
DBG_ERROR(NULL, "Error creating endpoint TTY");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpointMgr_AddEndpoint(emgr, epTty);
|
|
|
|
epLog=AQH_LogEndpoint_new("endpoints.log", AQH_MSGMGR_ENDPOINTGROUP_NODE);
|
|
if (epLog==NULL) {
|
|
DBG_ERROR(AQH_LOGDOMAIN, "Error creating endpoint LOG");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpointMgr_AddEndpoint(emgr, epLog);
|
|
|
|
epTcp=AQH_TcpdIpcNodeEndpoint_new("127.0.0.1", 45454, NULL, AQH_MSGMGR_ENDPOINTGROUP_IPC);
|
|
if (epTcp==NULL) {
|
|
DBG_ERROR(AQH_LOGDOMAIN, "Error creating endpoint TCP");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpointMgr_AddEndpoint(emgr, epTcp);
|
|
|
|
for (;;) {
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "Next loop");
|
|
AQH_MsgManager_LoopOnce(emgr);
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testMsgMqttConnect()
|
|
{
|
|
GWEN_MSG *msg;
|
|
GWEN_BUFFER *dbuf;
|
|
|
|
msg=GWEN_ConnectMqttMsg_new("MQTT", 4,
|
|
AQH_MQTTMSG_CONNECT_FLAGS_USERNAME | AQH_MQTTMSG_CONNECT_FLAGS_PASSWD,
|
|
512,
|
|
"CLIENTID123",
|
|
"USER123",
|
|
"PASSWD123");
|
|
if (msg==NULL) {
|
|
DBG_ERROR(NULL, "Error creating message");
|
|
return 2;
|
|
}
|
|
dbuf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
AQH_ConnectMqttMsg_DumpToBuffer(msg, dbuf, "created");
|
|
fprintf(stdout, "%s\n", GWEN_Buffer_GetStart(dbuf));
|
|
GWEN_Buffer_free(dbuf);
|
|
|
|
GWEN_Text_DumpString((const char*) GWEN_Msg_GetConstBuffer(msg), GWEN_Msg_GetBytesInBuffer(msg), 2);
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testMqttConnection()
|
|
{
|
|
int rv;
|
|
GWEN_MSG_ENDPOINT_MGR *emgr;
|
|
GWEN_MSG_ENDPOINT *epTcp;
|
|
GWEN_MSG *msgOut;
|
|
|
|
rv=AQH_Init();
|
|
if (rv<0) {
|
|
}
|
|
|
|
//emgr=AQH_MsgManager_new(0xc0);
|
|
emgr=GWEN_MsgEndpointMgr_new();
|
|
|
|
epTcp=AQH_MqttClientEndpoint_new("127.0.0.1", 1883, "MQTTClient", 0);
|
|
if (epTcp==NULL) {
|
|
DBG_ERROR(NULL, "Error creating endpoint TCPc");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpointMgr_AddEndpoint(emgr, epTcp);
|
|
|
|
fprintf(stdout, "Sending CONNECT\n");
|
|
msgOut=GWEN_ConnectMqttMsg_new("MQTT", 4, 0, 10, "CLIENTID123", NULL, NULL);
|
|
if (msgOut==NULL) {
|
|
DBG_ERROR(NULL, "Error creating message");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpoint_AddSendMessage(epTcp, msgOut);
|
|
|
|
fprintf(stdout, "Waiting for response\n");
|
|
for (;;) {
|
|
GWEN_MSG *msg;
|
|
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "Next loop");
|
|
//GWEN_MsgManager_LoopOnce(emgr);
|
|
GWEN_MsgEndpointMgr_IoLoopOnce(emgr);
|
|
msg=GWEN_MsgEndpoint_TakeFirstReceivedMessage(epTcp);
|
|
if (msg) {
|
|
if (AQH_MqttMsg_GetMsgTypeAndFlags(msg)==AQH_MQTTMSG_MSGTYPE_CONNACK) {
|
|
GWEN_BUFFER *buf;
|
|
|
|
buf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
AQH_ConnAckMqttMsg_DumpToBuffer(msg, buf, "received");
|
|
fprintf(stdout, "%s\n", GWEN_Buffer_GetStart(buf));
|
|
GWEN_Buffer_free(buf);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Received this message:");
|
|
GWEN_Text_DumpString((const char*) GWEN_Msg_GetConstBuffer(msg), GWEN_Msg_GetBytesInBuffer(msg), 2);
|
|
}
|
|
GWEN_Msg_free(msg);
|
|
break;
|
|
}
|
|
}
|
|
|
|
fprintf(stdout, "Sending PUBLISH\n");
|
|
//msgOut=GWEN_PublishMqttMsg_new(AQH_MQTTMSG_FLAGS_QOS1, 1, "test/subject1", (const uint8_t*) "29.9", 4);
|
|
msgOut=GWEN_PublishMqttMsg_new(0, 0, "test/subject1", (const uint8_t*) "29.9", 4);
|
|
if (msgOut==NULL) {
|
|
DBG_ERROR(NULL, "Error creating message");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpoint_AddSendMessage(epTcp, msgOut);
|
|
|
|
fprintf(stdout, "Waiting for response\n");
|
|
for (;;) {
|
|
GWEN_MSG *msg;
|
|
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "Next loop");
|
|
//GWEN_MsgManager_LoopOnce(emgr);
|
|
GWEN_MsgEndpointMgr_IoLoopOnce(emgr);
|
|
msg=GWEN_MsgEndpoint_TakeFirstReceivedMessage(epTcp);
|
|
if (msg) {
|
|
if (AQH_MqttMsg_GetMsgTypeAndFlags(msg)==AQH_MQTTMSG_MSGTYPE_PUBACK) {
|
|
GWEN_BUFFER *buf;
|
|
|
|
buf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
AQH_PubResponseMqttMsg_DumpToBuffer(msg, buf, "received");
|
|
fprintf(stdout, "%s\n", GWEN_Buffer_GetStart(buf));
|
|
GWEN_Buffer_free(buf);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "Received this message:");
|
|
GWEN_Text_DumpString((const char*) GWEN_Msg_GetConstBuffer(msg), GWEN_Msg_GetBytesInBuffer(msg), 2);
|
|
}
|
|
GWEN_Msg_free(msg);
|
|
break;
|
|
}
|
|
}
|
|
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testIpcConnection()
|
|
{
|
|
int rv;
|
|
GWEN_MSG_ENDPOINT_MGR *emgr;
|
|
GWEN_MSG_ENDPOINT *epTcp;
|
|
GWEN_MSG *msgOut;
|
|
|
|
rv=AQH_Init();
|
|
if (rv<0) {
|
|
}
|
|
|
|
//emgr=AQH_MsgManager_new(0xc0);
|
|
emgr=GWEN_MsgEndpointMgr_new();
|
|
|
|
epTcp=AQH_IpcTcpClientEndpoint_new("127.0.0.1", 45454, "IPCClient", 0);
|
|
if (epTcp==NULL) {
|
|
DBG_ERROR(NULL, "Error creating endpoint TCPc");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpointMgr_AddEndpoint(emgr, epTcp);
|
|
|
|
fprintf(stdout, "Sending SET_ACCEPTABLE_MSG_GROUPS\n");
|
|
msgOut=AQH_SetAcceptedMsgGroupsIpcMsg_new(AQH_MSGTYPE_IPC_SETACCMSGGRPS, AQH_MSG_TYPEGROUP_ALL);
|
|
if (msgOut==NULL) {
|
|
DBG_ERROR(NULL, "Error creating message");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpoint_AddSendMessage(epTcp, msgOut);
|
|
|
|
|
|
fprintf(stdout, "Sending PING\n");
|
|
msgOut=AQH_PingIpcMsg_new(AQH_MSGTYPE_IPC_PING, 2);
|
|
if (msgOut==NULL) {
|
|
DBG_ERROR(NULL, "Error creating message");
|
|
return 2;
|
|
}
|
|
GWEN_MsgEndpoint_AddSendMessage(epTcp, msgOut);
|
|
|
|
fprintf(stdout, "Waiting for response\n");
|
|
for (;;) {
|
|
GWEN_MSG *msg;
|
|
|
|
DBG_DEBUG(AQH_LOGDOMAIN, "Next loop");
|
|
//GWEN_MsgManager_LoopOnce(emgr);
|
|
GWEN_MsgEndpointMgr_RunAllEndpoints(emgr);
|
|
GWEN_MsgEndpointMgr_IoLoopOnce(emgr);
|
|
msg=GWEN_MsgEndpoint_TakeFirstReceivedMessage(epTcp);
|
|
if (msg) {
|
|
DBG_ERROR(NULL, "Received this message:");
|
|
GWEN_Text_DumpString((const char*) GWEN_Msg_GetConstBuffer(msg), GWEN_Msg_GetBytesInBuffer(msg), 2);
|
|
if (GWEN_IpcMsg_GetCode(msg)==AQH_MSGTYPE_IPC_FORWARD) {
|
|
GWEN_MSG *nodeMsg;
|
|
|
|
DBG_ERROR(AQH_LOGDOMAIN, "Received FORWARD msg");
|
|
nodeMsg=AQH_ForwardIpcMsg_GetCopyOfNodeMsg(msg);
|
|
if (nodeMsg) {
|
|
DBG_ERROR(AQH_LOGDOMAIN, "Received node msg (%d)", AQH_NodeMsg_GetMsgType(nodeMsg));
|
|
if (AQH_NodeMsg_GetMsgType(nodeMsg)==AQH_MSG_TYPE_PONG) {
|
|
DBG_ERROR(AQH_LOGDOMAIN, "Received PONG");
|
|
GWEN_Msg_free(msg);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
GWEN_Msg_free(msg);
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testHexfile(int argc, char **argv)
|
|
{
|
|
const char *inFilename;
|
|
const char *outFilename;
|
|
AQH_HEXFILE *h;
|
|
int rv;
|
|
|
|
if (argc<3) {
|
|
fprintf(stderr, "Missing filenames (in, out)\n");
|
|
return 1;
|
|
}
|
|
|
|
rv=AQH_Init();
|
|
if (rv<0) {
|
|
}
|
|
|
|
inFilename=argv[1];
|
|
outFilename=argv[2];
|
|
h=AQH_Hexfile_fromFile(inFilename);
|
|
if (h==NULL) {
|
|
fprintf(stderr, "Error reading hexfile \"%s\".\n", inFilename);
|
|
return 2;
|
|
}
|
|
else {
|
|
AQH_HEXFILERECORD_LIST *recordList;
|
|
GWEN_BUFFER *buffer;
|
|
|
|
recordList=AQH_Hexfile_GetRecordList(h);
|
|
fprintf(stdout, "INTEL Hexfile read with %d records\n", AQH_HexfileRecord_List_GetCount(recordList));
|
|
|
|
buffer=GWEN_Buffer_new(0, 1024, 0, 1);
|
|
AQH_Hexfile_toBuffer(h, buffer);
|
|
rv=GWEN_SyncIo_Helper_WriteFile(outFilename, (const uint8_t*) GWEN_Buffer_GetStart(buffer), GWEN_Buffer_GetUsedBytes(buffer));
|
|
GWEN_Buffer_free(buffer);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR writing outfile \"%s\": %d", outFilename, rv);
|
|
AQH_Hexfile_free(h);
|
|
return 3;
|
|
}
|
|
AQH_Hexfile_free(h);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testFlashRecords(int argc, char **argv)
|
|
{
|
|
const char *inFilename;
|
|
AQH_HEXFILE *h;
|
|
int rv;
|
|
|
|
if (argc<2) {
|
|
fprintf(stderr, "Missing filename\n");
|
|
return 1;
|
|
}
|
|
|
|
rv=AQH_Init();
|
|
if (rv<0) {
|
|
}
|
|
|
|
inFilename=argv[1];
|
|
h=AQH_Hexfile_fromFile(inFilename);
|
|
if (h==NULL) {
|
|
fprintf(stderr, "Error reading hexfile \"%s\".\n", inFilename);
|
|
return 2;
|
|
}
|
|
else {
|
|
AQH_HEXFILERECORD_LIST *recordList;
|
|
AQH_FLASHRECORD_LIST *flashRecordList;
|
|
|
|
recordList=AQH_Hexfile_GetRecordList(h);
|
|
fprintf(stdout, "INTEL Hexfile read with %d records\n", AQH_HexfileRecord_List_GetCount(recordList));
|
|
|
|
flashRecordList=AQH_FlashRecord_fromHexfileRecords(recordList);
|
|
if (flashRecordList==NULL) {
|
|
fprintf(stderr, "ERROR creating flash record list\n");
|
|
AQH_Hexfile_free(h);
|
|
return 3;
|
|
}
|
|
else {
|
|
AQH_FLASHRECORD *fr;
|
|
|
|
fprintf(stdout, "Flash record list created with %d records\n", AQH_FlashRecord_List_GetCount(flashRecordList));
|
|
fr=AQH_FlashRecord_List_First(flashRecordList);
|
|
while(fr) {
|
|
fprintf(stdout, "- %08x (%d bytes)\n", AQH_FlashRecord_GetAddress(fr), AQH_FlashRecord_GetDataLength(fr));
|
|
fr=AQH_FlashRecord_List_Next(fr);
|
|
}
|
|
}
|
|
|
|
AQH_Hexfile_free(h);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
|
|
int main(int argc, char **argv)
|
|
{
|
|
//return testEndpoints();
|
|
//return testMsgMqttConnect();
|
|
//return testMqttConnection();
|
|
|
|
//return testIpcConnection();
|
|
//return testHexfile(argc, argv);
|
|
return testFlashRecords(argc, argv);
|
|
}
|
|
|
|
|