258 lines
8.1 KiB
C++
258 lines
8.1 KiB
C++
#include "GwChannelList.h"
|
|
#include "GwApi.h"
|
|
#include "GwHardware.h"
|
|
#include "GwSocketServer.h"
|
|
#include "GwSerial.h"
|
|
#include "GwTcpClient.h"
|
|
class GwSerialLog : public GwLogWriter
|
|
{
|
|
static const size_t bufferSize = 4096;
|
|
char *logBuffer = NULL;
|
|
int wp = 0;
|
|
GwSerial *writer;
|
|
bool disabled = false;
|
|
|
|
public:
|
|
GwSerialLog(GwSerial *writer, bool disabled)
|
|
{
|
|
this->writer = writer;
|
|
this->disabled = disabled;
|
|
logBuffer = new char[bufferSize];
|
|
wp = 0;
|
|
}
|
|
virtual ~GwSerialLog() {}
|
|
virtual void write(const char *data)
|
|
{
|
|
if (disabled)
|
|
return;
|
|
int len = strlen(data);
|
|
if ((wp + len) >= (bufferSize - 1))
|
|
return;
|
|
strncpy(logBuffer + wp, data, len);
|
|
wp += len;
|
|
logBuffer[wp] = 0;
|
|
}
|
|
virtual void flush()
|
|
{
|
|
size_t handled = 0;
|
|
if (!disabled)
|
|
{
|
|
while (handled < wp)
|
|
{
|
|
writer->flush();
|
|
size_t rt = writer->sendToClients(logBuffer + handled, -1, true);
|
|
handled += rt;
|
|
}
|
|
}
|
|
wp = 0;
|
|
logBuffer[0] = 0;
|
|
}
|
|
};
|
|
|
|
GwChannelList::GwChannelList(GwLog *logger, GwConfigHandler *config){
|
|
this->logger=logger;
|
|
this->config=config;
|
|
}
|
|
void GwChannelList::allChannels(ChannelAction action){
|
|
for (auto it=theChannels.begin();it != theChannels.end();it++){
|
|
action(*it);
|
|
}
|
|
}
|
|
|
|
void GwChannelList::addSerial(int id,const String &mode,int rx,int tx){
|
|
if (id != SERIAL1_CHANNEL_ID && id != SERIAL2_CHANNEL_ID){
|
|
logger->logDebug(GwLog::ERROR,"trying to set up an unknown serial channel: %d",id);
|
|
return;
|
|
}
|
|
if (rx < 0 && tx < 0){
|
|
logger->logDebug(GwLog::ERROR,"useless config for serial %d: both rx/tx undefined");
|
|
return;
|
|
}
|
|
String cfgName;
|
|
bool canRead=false;
|
|
bool canWrite=false;
|
|
if (mode == "BI"){
|
|
cfgName=(id==SERIAL1_CHANNEL_ID)?config->receiveSerial:config->receiveSerial2;
|
|
canRead=config->getBool(cfgName);
|
|
cfgName=(id==SERIAL2_CHANNEL_ID)?config->sendSerial:config->sendSerial2;
|
|
canWrite=config->getBool(cfgName);
|
|
}
|
|
if (mode == "TX"){
|
|
canWrite=true;
|
|
}
|
|
if (mode == "RX"){
|
|
canRead=true;
|
|
}
|
|
if (mode == "UNI"){
|
|
cfgName=(id == SERIAL1_CHANNEL_ID)?config->serialDirection:config->serial2Dir;
|
|
String cfgMode=config->getString(cfgName);
|
|
if (cfgMode == "receive"){
|
|
canRead=true;
|
|
}
|
|
if (cfgMode == "send"){
|
|
canWrite=true;
|
|
}
|
|
}
|
|
if (rx < 0) canRead=false;
|
|
if (tx < 0) canWrite=false;
|
|
HardwareSerial *serialStream=(id == SERIAL1_CHANNEL_ID)?&Serial1:&Serial2;
|
|
LOG_DEBUG(GwLog::DEBUG,"serial set up: mode=%s,rx=%d,canRead=%d,tx=%d,canWrite=%d",
|
|
mode.c_str(),rx,(int)canRead,tx,(int)canWrite);
|
|
serialStream->begin(config->getInt(config->serialBaud,115200),SERIAL_8N1,rx,tx);
|
|
GwSerial *serial = new GwSerial(logger, serialStream, id, canRead);
|
|
LOG_DEBUG(GwLog::LOG, "starting serial %d ", id);
|
|
GwChannel *channel = new GwChannel(logger, (id == SERIAL1_CHANNEL_ID) ? "SER" : "SER2", id);
|
|
channel->setImpl(serial);
|
|
channel->begin(
|
|
canRead || canWrite,
|
|
canWrite,
|
|
canRead,
|
|
config->getString((id == SERIAL1_CHANNEL_ID) ? config->serialReadF : config->serial2ReadF),
|
|
config->getString((id == SERIAL1_CHANNEL_ID) ? config->serialWriteF : config->serial2WriteF),
|
|
false,
|
|
config->getBool((id == SERIAL1_CHANNEL_ID) ? config->serialToN2k : config->serial2ToN2k),
|
|
false,
|
|
false);
|
|
LOG_DEBUG(GwLog::LOG, "%s", channel->toString().c_str());
|
|
theChannels.push_back(channel);
|
|
}
|
|
void GwChannelList::begin(bool fallbackSerial){
|
|
LOG_DEBUG(GwLog::DEBUG,"GwChannelList::begin");
|
|
GwChannel *channel=NULL;
|
|
//usb
|
|
if (! fallbackSerial){
|
|
GwSerial *usb=new GwSerial(NULL,&USBSerial,USB_CHANNEL_ID);
|
|
USBSerial.begin(config->getInt(config->usbBaud));
|
|
logger->setWriter(new GwSerialLog(usb,config->getBool(config->usbActisense)));
|
|
logger->prefix="GWSERIAL:";
|
|
channel=new GwChannel(logger,"USB",USB_CHANNEL_ID);
|
|
channel->setImpl(usb);
|
|
channel->begin(true,
|
|
config->getBool(config->sendUsb),
|
|
config->getBool(config->receiveUsb),
|
|
config->getString(config->usbReadFilter),
|
|
config->getString(config->usbWriteFilter),
|
|
false,
|
|
config->getBool(config->usbToN2k),
|
|
config->getBool(config->usbActisense),
|
|
config->getBool(config->usbActSend)
|
|
);
|
|
theChannels.push_back(channel);
|
|
LOG_DEBUG(GwLog::LOG,"%s",channel->toString().c_str());
|
|
}
|
|
//TCP server
|
|
sockets=new GwSocketServer(config,logger,MIN_TCP_CHANNEL_ID);
|
|
sockets->begin();
|
|
channel=new GwChannel(logger,"TCP",MIN_TCP_CHANNEL_ID,MIN_TCP_CHANNEL_ID+10);
|
|
channel->setImpl(sockets);
|
|
channel->begin(
|
|
true,
|
|
config->getBool(config->sendTCP),
|
|
config->getBool(config->readTCP),
|
|
config->getString(config->tcpReadFilter),
|
|
config->getString(config->tcpWriteFilter),
|
|
config->getBool(config->sendSeasmart),
|
|
config->getBool(config->tcpToN2k),
|
|
false,
|
|
false
|
|
);
|
|
LOG_DEBUG(GwLog::LOG,"%s",channel->toString().c_str());
|
|
theChannels.push_back(channel);
|
|
|
|
//serial 1
|
|
#ifndef GWSERIAL_TX
|
|
#define GWSERIAL_TX -1
|
|
#endif
|
|
#ifndef GWSERIAL_RX
|
|
#define GWSERIAL_RX -1
|
|
#endif
|
|
#ifdef GWSERIAL_MODE
|
|
addSerial(SERIAL1_CHANNEL_ID,GWSERIAL_MODE,GWSERIAL_RX,GWSERIAL_TX);
|
|
#endif
|
|
//serial 2
|
|
#ifndef GWSERIAL2_TX
|
|
#define GWSERIAL2_TX -1
|
|
#endif
|
|
#ifndef GWSERIAL2_RX
|
|
#define GWSERIAL2_RX -1
|
|
#endif
|
|
#ifdef GWSERIAL2_MODE
|
|
addSerial(SERIAL2_CHANNEL_ID,GWSERIAL2_MODE,GWSERIAL2_RX,GWSERIAL2_TX);
|
|
#endif
|
|
//tcp client
|
|
bool tclEnabled=config->getBool(config->tclEnabled);
|
|
channel=new GwChannel(logger,"TCPClient",TCP_CLIENT_CHANNEL_ID);
|
|
if (tclEnabled){
|
|
client=new GwTcpClient(logger);
|
|
client->begin(TCP_CLIENT_CHANNEL_ID,
|
|
config->getString(config->remoteAddress),
|
|
config->getInt(config->remotePort),
|
|
config->getBool(config->readTCL)
|
|
);
|
|
channel->setImpl(client);
|
|
}
|
|
channel->begin(
|
|
tclEnabled,
|
|
config->getBool(config->sendTCL),
|
|
config->getBool(config->readTCL),
|
|
config->getString(config->tclReadFilter),
|
|
config->getString(config->tclReadFilter),
|
|
config->getBool(config->tclSeasmart),
|
|
config->getBool(config->tclToN2k),
|
|
false,
|
|
false
|
|
);
|
|
theChannels.push_back(channel);
|
|
LOG_DEBUG(GwLog::LOG,"%s",channel->toString().c_str());
|
|
logger->flush();
|
|
}
|
|
int GwChannelList::getJsonSize(){
|
|
int rt=0;
|
|
allChannels([&](GwChannel *c){
|
|
rt+=c->getJsonSize();
|
|
});
|
|
return rt+20;
|
|
}
|
|
void GwChannelList::toJson(GwJsonDocument &doc){
|
|
if (sockets) doc["numClients"]=sockets->numClients();
|
|
if (client){
|
|
doc["clientCon"]=client->isConnected();
|
|
doc["clientErr"]=client->getError();
|
|
}
|
|
else{
|
|
doc["clientCon"]=false;
|
|
doc["clientErr"]="disabled";
|
|
}
|
|
allChannels([&](GwChannel *c){
|
|
c->toJson(doc);
|
|
});
|
|
}
|
|
GwChannel *GwChannelList::getChannelById(int sourceId){
|
|
for (auto it=theChannels.begin();it != theChannels.end();it++){
|
|
if ((*it)->isOwnSource(sourceId)) return *it;
|
|
}
|
|
return NULL;
|
|
}
|
|
|
|
void GwChannelList::fillStatus(GwApi::Status &status){
|
|
GwChannel *channel=getChannelById(USB_CHANNEL_ID);
|
|
if (channel){
|
|
status.usbRx=channel->countRx();
|
|
status.usbTx=channel->countTx();
|
|
}
|
|
channel=getChannelById(SERIAL1_CHANNEL_ID);
|
|
if (channel){
|
|
status.serRx=channel->countRx();
|
|
status.serTx=channel->countTx();
|
|
}
|
|
channel=getChannelById(MIN_TCP_CHANNEL_ID);
|
|
if (channel){
|
|
status.tcpSerRx=channel->countRx();
|
|
status.tcpSerTx=channel->countTx();
|
|
}
|
|
channel=getChannelById(TCP_CLIENT_CHANNEL_ID);
|
|
if (channel){
|
|
status.tcpClRx=channel->countRx();
|
|
status.tcpClTx=channel->countTx();
|
|
}
|
|
} |