327 lines
7.2 KiB
C
327 lines
7.2 KiB
C
|
|
#ifdef HAVE_CONFIG_H
|
|
# include <config.h>
|
|
#endif
|
|
|
|
#include "aqhome/serial.h"
|
|
#include "aqhome/msg_value.h"
|
|
#include "aqhome/msg_sendstats.h"
|
|
#include "aqhome/msg_ping.h"
|
|
#include "aqhome/msg_needaddr.h"
|
|
|
|
#include <gwenhywfar/debug.h>
|
|
#include <gwenhywfar/text.h>
|
|
#include <gwenhywfar/gwentime.h>
|
|
#include <gwenhywfar/buffer.h>
|
|
|
|
#include <unistd.h>
|
|
#include <time.h>
|
|
|
|
|
|
|
|
int testRecv()
|
|
{
|
|
AQH_SERIAL *sr;
|
|
int rv;
|
|
int i;
|
|
GWEN_BUFFER *dbuf;
|
|
|
|
fprintf(stdout, "Opening device...\n");
|
|
sr=AQH_Serial_new("/dev/ttyUSB0", 240);
|
|
rv=AQH_Serial_Open(sr);
|
|
if (rv<0) {
|
|
DBG_ERROR(NULL, "ERROR opening device (%d)", rv);
|
|
AQH_Serial_free(sr);
|
|
return 2;
|
|
}
|
|
fprintf(stdout, "Device open, waiting for packets\n");
|
|
|
|
dbuf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
for (i=0; ; i++) {
|
|
uint8_t buffer[1024];
|
|
GWEN_TIME *ti;
|
|
|
|
fprintf(stdout, "Waiting for packet...\n");
|
|
rv=AQH_Serial_Recv(sr, buffer, sizeof(buffer)-1);
|
|
if (rv<0)
|
|
break;
|
|
ti=GWEN_CurrentTime();
|
|
GWEN_Time_toString(ti, "YYYY-MM-DD hh:mm:ss", dbuf);
|
|
fprintf(stdout, "%s: Received:\n", GWEN_Buffer_GetStart(dbuf));
|
|
GWEN_Text_DumpString(buffer, rv, 2);
|
|
GWEN_Time_free(ti);
|
|
GWEN_Buffer_Reset(dbuf);
|
|
fprintf(stdout, "\n");
|
|
}
|
|
GWEN_Buffer_free(dbuf);
|
|
|
|
AQH_Serial_Close(sr);
|
|
AQH_Serial_free(sr);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
int testSend()
|
|
{
|
|
AQH_SERIAL *sr;
|
|
int rv;
|
|
int i;
|
|
GWEN_BUFFER *dbuf;
|
|
uint8_t sendBuf[5]={0x01, 0x02, 0xdb, 0x00, 0xd8 };
|
|
uint8_t sendBuf2[2]={0x02, 0xdb };
|
|
|
|
fprintf(stdout, "Opening device...\n");
|
|
sr=AQH_Serial_new("/dev/ttyUSB0", 240);
|
|
rv=AQH_Serial_Open(sr);
|
|
if (rv<0) {
|
|
DBG_ERROR(NULL, "ERROR opening device (%d)", rv);
|
|
AQH_Serial_free(sr);
|
|
return 2;
|
|
}
|
|
fprintf(stdout, "Device open, waiting for packets\n");
|
|
|
|
dbuf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
for (i=0; ; i++) {
|
|
GWEN_TIME *ti;
|
|
|
|
//rv=AQH_Serial_Send(sr, sendBuf, sizeof(sendBuf));
|
|
rv=AQH_Serial_SendPacket(sr, 1, sendBuf2, sizeof(sendBuf2));
|
|
if (rv<0)
|
|
break;
|
|
ti=GWEN_CurrentTime();
|
|
GWEN_Time_toString(ti, "YYYY-MM-DD hh:mm:ss", dbuf);
|
|
fprintf(stdout, "%s: Packet %d sent.\n", GWEN_Buffer_GetStart(dbuf), i);
|
|
GWEN_Time_free(ti);
|
|
GWEN_Buffer_Reset(dbuf);
|
|
sleep(3);
|
|
}
|
|
GWEN_Buffer_free(dbuf);
|
|
|
|
AQH_Serial_Close(sr);
|
|
AQH_Serial_free(sr);
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
void _packetReceived(AQH_SERIAL *sr, AQH_MSG *msg)
|
|
{
|
|
const uint8_t *ptr;
|
|
uint8_t len;
|
|
uint8_t msgType;
|
|
int msgIsValid;
|
|
GWEN_BUFFER *dbuf;
|
|
GWEN_TIME *ti;
|
|
|
|
dbuf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
ti=GWEN_CurrentTime();
|
|
GWEN_Time_toString(ti, "YYYY-MM-DD hh:mm:ss ", dbuf);
|
|
GWEN_Time_free(ti);
|
|
ti=NULL;
|
|
|
|
msgIsValid=(AQH_Msg_IsChecksumValid(msg) && AQH_Msg_IsMsgComplete(msg));
|
|
ptr=AQH_Msg_GetBuffer(msg);
|
|
len=AQH_Msg_GetBytesInBuffer(msg);
|
|
msgType=AQH_Msg_GetMsgType(msg);
|
|
|
|
if (msgType==AQH_MSG_TYPE_PING) {
|
|
AQH_MsgPing_DumpToBuffer(msg, dbuf, "received");
|
|
fprintf(stdout, "%s", GWEN_Buffer_GetStart(dbuf));
|
|
}
|
|
else if (msgType==AQH_MSG_TYPE_COMSENDSTATS) { /* CPRO_CMD_COMSENDSTATS */
|
|
AQH_MsgSendStats_DumpToBuffer(msg, dbuf, "received");
|
|
fprintf(stdout, "%s", GWEN_Buffer_GetStart(dbuf));
|
|
}
|
|
else if (msgType==30) { /* CPRO_CMD_I2CBUSMEMBER */
|
|
int i2cAddr;
|
|
int availability;
|
|
|
|
i2cAddr=ptr[4];
|
|
availability=ptr[5];
|
|
fprintf(stdout, "-> I2C DEVICE %02x: %s\n", i2cAddr, (availability==0)?"not available":"FOUND");
|
|
}
|
|
else if (msgType==40) { /* CPRO_CMD_DEBUG */
|
|
uint8_t param1;
|
|
uint8_t param2;
|
|
|
|
param1=ptr[4];
|
|
param2=ptr[5];
|
|
fprintf(stdout, "-> Debug param1=%02x, param2=%02x\n", param1, param2);
|
|
}
|
|
else if (msgType==AQH_MSG_TYPE_VALUE) { /* CPRO_CMD_VALUE */
|
|
AQH_MsgValue_DumpToBuffer(msg, dbuf, "received");
|
|
fprintf(stdout, "%s", GWEN_Buffer_GetStart(dbuf));
|
|
}
|
|
else if (msgType==AQH_MSG_TYPE_NEED_ADDRESS) {
|
|
AQH_MsgNeedAddr_DumpToBuffer(msg, dbuf, "received");
|
|
fprintf(stdout, "%s", GWEN_Buffer_GetStart(dbuf));
|
|
}
|
|
else {
|
|
fprintf(stdout, " %s: Received (%d):\n", GWEN_Buffer_GetStart(dbuf), msgType);
|
|
GWEN_Text_DumpString(ptr, len, 6);
|
|
}
|
|
GWEN_Buffer_free(dbuf);
|
|
|
|
AQH_Msg_free(msg);
|
|
}
|
|
|
|
|
|
|
|
AQH_MSG *createPingMsg(AQH_SERIAL *sr, uint8_t destAddr)
|
|
{
|
|
AQH_MSG *msg;
|
|
int rv;
|
|
|
|
msg=AQH_Msg_new();
|
|
rv=AQH_Msg_AddByte(msg, destAddr);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR1: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, 6); /* msglen */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR2: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, 10); /* ping */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR3: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, AQH_Serial_GetAddress(sr)); /* src addr */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR4: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
rv=AQH_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR5: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR6: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR7: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
rv=AQH_Msg_AddByte(msg, 0); /* timestamp */
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR8: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
|
|
rv=AQH_Msg_AddChecksum(msg);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR9: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return NULL;
|
|
}
|
|
|
|
return msg;
|
|
}
|
|
|
|
|
|
|
|
int testLoop()
|
|
{
|
|
AQH_SERIAL *sr;
|
|
int rv;
|
|
int i;
|
|
GWEN_BUFFER *dbuf;
|
|
time_t tLast;
|
|
|
|
fprintf(stdout, "Opening device...\n");
|
|
sr=AQH_Serial_new("/dev/ttyUSB0", 240);
|
|
rv=AQH_Serial_Open(sr);
|
|
if (rv<0) {
|
|
DBG_ERROR(NULL, "ERROR opening device (%d)", rv);
|
|
AQH_Serial_free(sr);
|
|
return 2;
|
|
}
|
|
fprintf(stdout, "Device open, waiting for packets\n");
|
|
AQH_Serial_SetPacketReceivedFn(sr, _packetReceived);
|
|
|
|
tLast=time(NULL);
|
|
for (;;) {
|
|
time_t t;
|
|
|
|
rv=AQH_Serial_Loop(sr);
|
|
if (rv<0) {
|
|
AQH_Serial_Close(sr);
|
|
AQH_Serial_free(sr);
|
|
break;
|
|
}
|
|
t=time(NULL);
|
|
if (difftime(t, tLast)>10) {
|
|
AQH_MSG *msg;
|
|
|
|
msg=createPingMsg(sr, 1);
|
|
if (msg) {
|
|
rv=AQH_Serial_AddMessageToSend(sr, msg);
|
|
if (rv<0) {
|
|
fprintf(stderr, "ERROR: %d\n", rv);
|
|
AQH_Msg_free(msg);
|
|
return rv;
|
|
}
|
|
|
|
if (rv==0) {
|
|
GWEN_BUFFER *dbuf;
|
|
GWEN_TIME *ti;
|
|
|
|
dbuf=GWEN_Buffer_new(0, 256, 0, 1);
|
|
ti=GWEN_CurrentTime();
|
|
GWEN_Time_toString(ti, "YYYY-MM-DD hh:mm:ss ", dbuf);
|
|
GWEN_Time_free(ti);
|
|
ti=NULL;
|
|
AQH_MsgPing_DumpToBuffer(msg, dbuf, "enqueued");
|
|
fprintf(stdout, "%s", GWEN_Buffer_GetStart(dbuf));
|
|
GWEN_Buffer_free(dbuf);
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "here (%d)", rv);
|
|
AQH_Serial_Close(sr);
|
|
AQH_Serial_free(sr);
|
|
return rv;
|
|
}
|
|
}
|
|
else {
|
|
DBG_ERROR(NULL, "here (%d)", rv);
|
|
AQH_Serial_Close(sr);
|
|
AQH_Serial_free(sr);
|
|
return GWEN_ERROR_INTERNAL;
|
|
}
|
|
tLast=t;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
int main(void)
|
|
{
|
|
//return testRecv();
|
|
//return testSend();
|
|
return testLoop();
|
|
}
|
|
|
|
|