/* ; 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 #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, " [filter1] ... [filterN]\n" "Filter: | [-] | :[-]\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