Add extracted tools: CitrineOS, OpenOCPP, ShapeShifter
- CitrineOS core extracted (CSMS OCPP 2.0.1) - OpenOCPP extracted (firmware OCPP 1.6J/2.0.1) - ShapeShifter library installed (pip install -e) - ShapeShifter specification extracted - EVerest extracted TODO updated with progress
This commit is contained in:
177
tools/EVerest-main/modules/EVSE/EvseSlac/main/slacImpl.cpp
Normal file
177
tools/EVerest-main/modules/EVSE/EvseSlac/main/slacImpl.cpp
Normal file
@@ -0,0 +1,177 @@
|
||||
// SPDX-License-Identifier: Apache-2.0
|
||||
// Copyright 2022 - 2026 Pionix GmbH and Contributors to EVerest
|
||||
|
||||
#include "slacImpl.hpp"
|
||||
|
||||
#include <chrono>
|
||||
#include <future>
|
||||
|
||||
#include <everest/slac/io.hpp>
|
||||
#include <fmt/core.h>
|
||||
#include <slac/channel.hpp>
|
||||
#include <thread>
|
||||
|
||||
#include "fsm_controller.hpp"
|
||||
|
||||
static std::promise<void> module_ready;
|
||||
// FIXME (aw): this is ugly, but due to the design of the auto-generated module skeleton ..
|
||||
static std::unique_ptr<FSMController> fsm_ctrl{nullptr};
|
||||
|
||||
namespace module {
|
||||
namespace main {
|
||||
|
||||
static std::string mac_to_ascii(const std::string& mac_binary) {
|
||||
if (mac_binary.size() < 6)
|
||||
return "";
|
||||
return fmt::format("{:02X}:{:02X}:{:02X}:{:02X}:{:02X}:{:02X}", mac_binary[0], mac_binary[1], mac_binary[2],
|
||||
mac_binary[3], mac_binary[4], mac_binary[5]);
|
||||
}
|
||||
|
||||
void slacImpl::init() {
|
||||
// setup evse fsm thread
|
||||
std::thread(&slacImpl::run, this).detach();
|
||||
}
|
||||
|
||||
void slacImpl::ready() {
|
||||
// let the waiting run thread go
|
||||
module_ready.set_value();
|
||||
}
|
||||
|
||||
void slacImpl::run() {
|
||||
// wait until ready
|
||||
module_ready.get_future().get();
|
||||
|
||||
if (config.startup_delay_ms > 0) {
|
||||
EVLOG_info << "Delaying SLAC startup by " << config.startup_delay_ms << "ms";
|
||||
std::this_thread::sleep_for(std::chrono::milliseconds(config.startup_delay_ms));
|
||||
EVLOG_info << "Continuing with SLAC initialization";
|
||||
}
|
||||
|
||||
// initialize slac i/o
|
||||
SlacIO slac_io;
|
||||
try {
|
||||
slac_io.init(config.device);
|
||||
} catch (const std::exception& e) {
|
||||
EVLOG_error << fmt::format("Couldn't open device {} for SLAC communication. Reason: {}", config.device,
|
||||
e.what());
|
||||
raise_error(
|
||||
error_factory->create_error("generic/CommunicationFault", "", "Could not open device " + config.device));
|
||||
return;
|
||||
}
|
||||
|
||||
// setup callbacks
|
||||
slac::fsm::evse::ContextCallbacks callbacks;
|
||||
callbacks.send_raw_slac = [&slac_io](slac::messages::HomeplugMessage& msg) { slac_io.send(msg); };
|
||||
|
||||
callbacks.signal_dlink_ready = [this](bool value) { publish_dlink_ready(value); };
|
||||
|
||||
callbacks.signal_state = [this](const std::string& value) {
|
||||
try {
|
||||
publish_state(types::slac::string_to_state(value));
|
||||
} catch (const std::exception& e) {
|
||||
EVLOG_error << fmt::format("Tried to publish unknown SLAC state '{}'. Error: {}", value, e.what());
|
||||
}
|
||||
};
|
||||
|
||||
callbacks.signal_error_routine_request = [this]() { publish_request_error_routine(nullptr); };
|
||||
|
||||
callbacks.log_debug = [](const std::string& text) { EVLOG_debug << text; };
|
||||
callbacks.log_info = [](const std::string& text) { EVLOG_info << text; };
|
||||
callbacks.log_warn = [](const std::string& text) { EVLOG_warning << text; };
|
||||
callbacks.log_error = [](const std::string& text) { EVLOG_error << text; };
|
||||
|
||||
if (config.publish_mac_on_first_parm_req) {
|
||||
callbacks.signal_ev_mac_address_parm_req = [this](const std::string& mac) { publish_ev_mac_address(mac); };
|
||||
}
|
||||
|
||||
if (config.publish_mac_on_match_cnf) {
|
||||
callbacks.signal_ev_mac_address_match_cnf = [this](const std::string& mac) { publish_ev_mac_address(mac); };
|
||||
}
|
||||
|
||||
auto fsm_ctx = slac::fsm::evse::Context(callbacks);
|
||||
fsm_ctx.slac_config.set_key_timeout_ms = config.set_key_timeout_ms;
|
||||
fsm_ctx.slac_config.slac_init_timeout_ms = config.slac_init_timeout_ms;
|
||||
fsm_ctx.slac_config.ac_mode_five_percent = config.ac_mode_five_percent;
|
||||
fsm_ctx.slac_config.sounding_atten_adjustment = config.sounding_attenuation_adjustment;
|
||||
|
||||
fsm_ctx.slac_config.chip_reset.enabled = config.do_chip_reset;
|
||||
fsm_ctx.slac_config.chip_reset.delay_ms = config.chip_reset_delay_ms;
|
||||
fsm_ctx.slac_config.chip_reset.timeout_ms = config.chip_reset_timeout_ms;
|
||||
|
||||
fsm_ctx.slac_config.link_status.do_detect = config.link_status_detection;
|
||||
fsm_ctx.slac_config.link_status.retry_ms = config.link_status_retry_ms;
|
||||
fsm_ctx.slac_config.link_status.timeout_ms = config.link_status_timeout_ms;
|
||||
fsm_ctx.slac_config.link_status.debug_simulate_failed_matching = config.debug_simulate_failed_matching;
|
||||
|
||||
fsm_ctx.slac_config.reset_instead_of_fail = config.reset_instead_of_fail;
|
||||
|
||||
fsm_ctx.slac_config.regenerate_key_on_reset = !config.hack_disable_regenerate_key_on_reset;
|
||||
|
||||
fsm_ctx.slac_config.generate_nmk();
|
||||
|
||||
memcpy(fsm_ctx.evse_mac, slac_io.get_mac_addr(), ETH_ALEN);
|
||||
|
||||
fsm_ctrl = std::make_unique<FSMController>(fsm_ctx);
|
||||
|
||||
// Qualcomm PLC chip emits VS_ATTENUATION_CHARACTERISTICS (vendor MMTYPE 0xA14E) as
|
||||
// unsolicited broadcasts during sounding from a sibling MAC. FSM does not handle this
|
||||
// MMTYPE and logs "Received non-expected SLAC message of type 0xA14E" per frame, which
|
||||
// adds RX/log load. Drop it pre-FSM. Other MMTYPEs (incl. CM_SET_KEY.CNF, CM_ATTEN_PROFILE.IND)
|
||||
// pass through unchanged.
|
||||
slac_io.run([](slac::messages::HomeplugMessage& msg) {
|
||||
if (msg.get_mmtype() == slac::defs::qualcomm::MMTYPE_VS_ATTENUATION_CHARACTERISTICS) {
|
||||
return;
|
||||
}
|
||||
fsm_ctrl->signal_new_slac_message(msg);
|
||||
});
|
||||
|
||||
fsm_ctrl->run();
|
||||
}
|
||||
|
||||
void slacImpl::handle_reset(bool& enable) {
|
||||
// FIXME (aw): the enable could be used for power saving etc, but it is not implemented yet
|
||||
// CC: as power saving is not implemented, we actually don't need to reset at beginning of session (enable=true): At
|
||||
// start of everest it is being reset once and then it is enough to reset at the end of each session. This saves
|
||||
// some hundreds of msecs at the beginning of the charging session as we do not need to set up keys. Then
|
||||
// EvseManager can switch on 5% PWM basically immediately as SLAC is already ready.
|
||||
if (!enable) {
|
||||
fsm_ctrl->signal_reset();
|
||||
}
|
||||
};
|
||||
|
||||
void slacImpl::handle_enter_bcd() {
|
||||
fsm_ctrl->signal_enter_bcd();
|
||||
};
|
||||
|
||||
void slacImpl::handle_leave_bcd() {
|
||||
fsm_ctrl->signal_leave_bcd();
|
||||
};
|
||||
|
||||
void slacImpl::handle_dlink_terminate() {
|
||||
// With receiving a D-LINK_TERMINATE.request from HLE, the communication node
|
||||
// shall leave the logical network within TP_match_leave. All parameters related
|
||||
// to the current link shall be set to the default value and shall change to the status "Unmatched".
|
||||
EVLOG_info << "D-LINK_TERMINATE.request received, leaving network.";
|
||||
fsm_ctrl->signal_reset();
|
||||
};
|
||||
|
||||
void slacImpl::handle_dlink_error() {
|
||||
// The D-LINK_ERROR.request requests lower layers to terminate the data link and restart the matching
|
||||
// process by a control pilot transition through state E (on EVSE side this should be state F though)
|
||||
// CP signal is handled by EvseManager, so we just need to reset the SLAC state machine here.
|
||||
// DLINK_ERROR will be send from HLC layers when they detect that the connection is dead.
|
||||
EVLOG_warning << "D-LINK_ERROR.request received";
|
||||
fsm_ctrl->signal_reset();
|
||||
};
|
||||
|
||||
void slacImpl::handle_dlink_pause() {
|
||||
// The D-LINK_PAUSE.request requests lower layers to enter a power saving mode. While being in this
|
||||
// mode, the state will be kept to "Matched".
|
||||
// So we don't need to do anything here as we do not support low power mode to power down the PLC modem.
|
||||
// This is optional in ISO15118-3.
|
||||
EVLOG_info << "D-LINK_PAUSE.request received. Staying in MATCHED, PLC chip stays powered on (low power mode "
|
||||
"optional in -3)";
|
||||
};
|
||||
|
||||
} // namespace main
|
||||
} // namespace module
|
||||
Reference in New Issue
Block a user