247 lines
7 KiB
C++
247 lines
7 KiB
C++
/*
|
|
; Project: Open Vehicle Monitor System
|
|
; Module: CAN logging framework
|
|
; Date: 18th January 2018
|
|
;
|
|
; (C) 2018 Michael Balzer
|
|
;
|
|
; Permission is hereby granted, free of charge, to any person obtaining a copy
|
|
; of this software and associated documentation files (the "Software"), to deal
|
|
; in the Software without restriction, including without limitation the rights
|
|
; to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
|
; copies of the Software, and to permit persons to whom the Software is
|
|
; furnished to do so, subject to the following conditions:
|
|
;
|
|
; The above copyright notice and this permission notice shall be included in
|
|
; all copies or substantial portions of the Software.
|
|
;
|
|
; THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
|
; IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
|
; FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
|
|
; AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
|
; LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
|
; OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
|
; THE SOFTWARE.
|
|
*/
|
|
|
|
#include <sdkconfig.h>
|
|
#ifdef CONFIG_OVMS_SC_GPL_MONGOOSE
|
|
|
|
#include "ovms_log.h"
|
|
static const char *TAG = "canlog-udpclient";
|
|
|
|
#include "can.h"
|
|
#include "canformat.h"
|
|
#include "canlog_udpclient.h"
|
|
#include "ovms_config.h"
|
|
#include "ovms_peripherals.h"
|
|
|
|
canlog_udpclient* MyCanLogUdpClient = NULL;
|
|
|
|
void can_log_udpclient_start(int verbosity, OvmsWriter* writer, OvmsCommand* cmd, int argc, const char* const* argv)
|
|
{
|
|
std::string format(cmd->GetName());
|
|
std::string mode(cmd->GetParent()->GetName());
|
|
canlog_udpclient* logger = new canlog_udpclient(argv[0],format,GetFormatModeType(mode));
|
|
logger->Open();
|
|
|
|
if (logger->IsOpen())
|
|
{
|
|
if (argc>1)
|
|
{ MyCan.AddLogger(logger, argc-1, &argv[1]); }
|
|
else
|
|
{ MyCan.AddLogger(logger); }
|
|
writer->printf("CAN logging as UDP client: %s\n", logger->GetInfo().c_str());
|
|
}
|
|
else
|
|
{
|
|
writer->printf("Error: Could not start CAN logging as UDP client: %s\n",logger->GetInfo().c_str());
|
|
delete logger;
|
|
}
|
|
}
|
|
|
|
class OvmsCanLogUdpClientInit
|
|
{
|
|
public:
|
|
OvmsCanLogUdpClientInit();
|
|
void NetManInit(std::string event, void* data);
|
|
void NetManStop(std::string event, void* data);
|
|
} MyOvmsCanLogUdpClientInit __attribute__ ((init_priority (4560)));
|
|
|
|
OvmsCanLogUdpClientInit::OvmsCanLogUdpClientInit()
|
|
{
|
|
ESP_LOGI(TAG, "Initialising CAN logging as UDP client (4560)");
|
|
|
|
OvmsCommand* cmd_can = MyCommandApp.FindCommand("can");
|
|
if (cmd_can)
|
|
{
|
|
OvmsCommand* cmd_can_log = cmd_can->FindCommand("log");
|
|
if (cmd_can_log)
|
|
{
|
|
OvmsCommand* cmd_can_log_start = cmd_can_log->FindCommand("start");
|
|
if (cmd_can_log_start)
|
|
{
|
|
// We have a place to put our command tree..
|
|
OvmsCommand* start = cmd_can_log_start->RegisterCommand("udpclient", "CAN logging as UDP client");
|
|
MyCanFormatFactory.RegisterCommandSet(start, "Start CAN logging as UDP client",
|
|
can_log_udpclient_start,
|
|
"<host:port> [filter1] ... [filterN]\n"
|
|
"Filter: <bus> | <id>[-<id>] | <bus>:<id>[-<id>]\n"
|
|
"Example: 2:2a0-37f",
|
|
1, 9);
|
|
}
|
|
}
|
|
}
|
|
using std::placeholders::_1;
|
|
using std::placeholders::_2;
|
|
MyEvents.RegisterEvent(TAG, "network.mgr.init", std::bind(&OvmsCanLogUdpClientInit::NetManInit, this, _1, _2));
|
|
MyEvents.RegisterEvent(TAG, "network.mgr.stop", std::bind(&OvmsCanLogUdpClientInit::NetManStop, this, _1, _2));
|
|
}
|
|
|
|
void OvmsCanLogUdpClientInit::NetManInit(std::string event, void* data)
|
|
{
|
|
if (MyCanLogUdpClient) MyCanLogUdpClient->Open();
|
|
}
|
|
|
|
void OvmsCanLogUdpClientInit::NetManStop(std::string event, void* data)
|
|
{
|
|
if (MyCanLogUdpClient) MyCanLogUdpClient->Close();
|
|
}
|
|
|
|
static void tcMongooseHandler(struct mg_connection *nc, int ev, void *p)
|
|
{
|
|
if (MyCanLogUdpClient)
|
|
MyCanLogUdpClient->MongooseHandler(nc, ev, p);
|
|
}
|
|
|
|
canlog_udpclient::canlog_udpclient(std::string path, std::string format, canformat::canformat_serve_mode_t mode)
|
|
: canlog("udpclient", format, mode)
|
|
{
|
|
MyCanLogUdpClient = this;
|
|
m_isopen = false;
|
|
m_path = path;
|
|
}
|
|
|
|
canlog_udpclient::~canlog_udpclient()
|
|
{
|
|
Close();
|
|
MyCanLogUdpClient = NULL;
|
|
}
|
|
|
|
bool canlog_udpclient::Open()
|
|
{
|
|
if (m_isopen) return true;
|
|
|
|
struct mg_mgr* mgr = MyNetManager.GetMongooseMgr();
|
|
if (mgr != NULL)
|
|
{
|
|
if (MyNetManager.m_network_any)
|
|
{
|
|
ESP_LOGI(TAG, "Launching UDP client to %s",m_path.c_str());
|
|
struct mg_connect_opts opts;
|
|
const char* err;
|
|
std::string dest("udp://");
|
|
dest.append(m_path);
|
|
memset(&opts, 0, sizeof(opts));
|
|
opts.error_string = &err;
|
|
mg_connection* nc;
|
|
if ((nc = mg_connect_opt(mgr, dest.c_str(), tcMongooseHandler, opts)) != NULL)
|
|
{
|
|
canlogconnection* clc = new canlogconnection(this, m_format, m_mode);
|
|
clc->m_nc = nc;
|
|
clc->m_peer = m_path;
|
|
m_connmap[nc] = clc;
|
|
m_isopen = true;
|
|
return true;
|
|
}
|
|
else
|
|
{
|
|
ESP_LOGE(TAG,"Could not connect to %s",m_path.c_str());
|
|
return false;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
ESP_LOGI(TAG,"Delay UDP client (as network manager not up)");
|
|
return true;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
ESP_LOGE(TAG,"Network manager is not available");
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void canlog_udpclient::Close()
|
|
{
|
|
if (m_isopen)
|
|
{
|
|
ESP_LOGI(TAG, "Closed UDP client log: %s", GetStats().c_str());
|
|
if (m_connmap.size() > 0)
|
|
{
|
|
OvmsRecMutexLock lock(&m_cmmutex);
|
|
for (conn_map_t::iterator it=m_connmap.begin(); it!=m_connmap.end(); ++it)
|
|
{
|
|
it->first->flags |= MG_F_CLOSE_IMMEDIATELY;
|
|
delete it->second;
|
|
}
|
|
m_connmap.clear();
|
|
}
|
|
m_isopen = false;
|
|
|
|
}
|
|
}
|
|
|
|
std::string canlog_udpclient::GetInfo()
|
|
{
|
|
std::string result = canlog::GetInfo();
|
|
result.append(" Path:");
|
|
result.append(m_path);
|
|
return result;
|
|
}
|
|
|
|
void canlog_udpclient::MongooseHandler(struct mg_connection *nc, int ev, void *p)
|
|
{
|
|
switch (ev)
|
|
{
|
|
case MG_EV_CLOSE:
|
|
ESP_LOGV(TAG, "MongooseHandler(MG_EV_CLOSE)");
|
|
if (m_isopen)
|
|
{
|
|
OvmsRecMutexLock lock(&m_cmmutex);
|
|
ESP_LOGE(TAG,"Disconnected from %s",m_path.c_str());
|
|
m_isopen = false;
|
|
auto k = m_connmap.find(nc);
|
|
if (k != m_connmap.end())
|
|
{
|
|
delete k->second;
|
|
m_connmap.erase(k);
|
|
}
|
|
}
|
|
break;
|
|
case MG_EV_RECV:
|
|
{
|
|
ESP_LOGV(TAG, "MongooseHandler(MG_EV_RECV)");
|
|
size_t used = nc->recv_mbuf.len;
|
|
if (m_formatter != NULL)
|
|
{
|
|
OvmsRecMutexLock lock(&m_cmmutex);
|
|
canlogconnection* clc = NULL;
|
|
auto k = m_connmap.find(nc);
|
|
if (k != m_connmap.end()) clc = k->second;
|
|
used = m_formatter->Serve((uint8_t*)nc->recv_mbuf.buf, used, clc);
|
|
}
|
|
if (used > 0)
|
|
{
|
|
mbuf_remove(&nc->recv_mbuf, used);
|
|
}
|
|
break;
|
|
}
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
#endif // CONFIG_OVMS_SC_GPL_MONGOOSE
|