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:
Eric F
@@ -0,0 +1,190 @@
|
||||
// SPDX-License-Identifier: Apache-2.0
|
||||
// Copyright 2020 - 2025 Pionix GmbH and Contributors to EVerest
|
||||
|
||||
#include "serial_device.hpp"
|
||||
|
||||
#include <cstring>
|
||||
#include <endian.h>
|
||||
#include <everest/logging.hpp>
|
||||
#include <fcntl.h>
|
||||
#include <iostream>
|
||||
#include <string>
|
||||
#include <termios.h>
|
||||
#include <unistd.h>
|
||||
|
||||
#include <sys/select.h>
|
||||
#include <sys/time.h>
|
||||
|
||||
#include <fmt/core.h>
|
||||
|
||||
namespace {
|
||||
std::string hexdump(std::uint8_t* msg, int msg_len) {
|
||||
std::stringstream ss;
|
||||
for (int i = 0; i < msg_len; i++) {
|
||||
ss << std::hex << static_cast<int>(msg[i]) << " ";
|
||||
}
|
||||
return ss.str();
|
||||
}
|
||||
|
||||
std::string hexdump(std::vector<std::uint8_t> msg) {
|
||||
std::stringstream ss;
|
||||
|
||||
for (auto index : msg) {
|
||||
ss << std::hex << std::setw(2) << std::setfill('0') << static_cast<int>(index) << " ";
|
||||
}
|
||||
return ss.str();
|
||||
}
|
||||
} // namespace
|
||||
|
||||
namespace serial_device {
|
||||
|
||||
SerialDevice::~SerialDevice() {
|
||||
if (fd != 0) {
|
||||
close(fd);
|
||||
}
|
||||
}
|
||||
|
||||
bool SerialDevice::open_device(const std::string& device, int _baud, bool _ignore_echo) {
|
||||
|
||||
ignore_echo = _ignore_echo;
|
||||
|
||||
fd = open(device.c_str(), O_RDWR | O_NOCTTY | O_SYNC);
|
||||
if (fd < 0) {
|
||||
EVLOG_error << fmt::format("Serial: error {} opening {}: {}", errno, device, strerror(errno));
|
||||
return false;
|
||||
}
|
||||
|
||||
int baud;
|
||||
switch (_baud) {
|
||||
case 9600:
|
||||
baud = B9600;
|
||||
break;
|
||||
case 19200:
|
||||
baud = B19200;
|
||||
break;
|
||||
case 38400:
|
||||
baud = B38400;
|
||||
break;
|
||||
case 57600:
|
||||
baud = B57600;
|
||||
break;
|
||||
case 115200:
|
||||
baud = B115200;
|
||||
break;
|
||||
case 230400:
|
||||
baud = B230400;
|
||||
break;
|
||||
default:
|
||||
return false;
|
||||
}
|
||||
|
||||
struct termios tty;
|
||||
if (tcgetattr(fd, &tty) != 0) {
|
||||
printf("Serial: error %d from tcgetattr\n", errno);
|
||||
return false;
|
||||
}
|
||||
|
||||
cfsetospeed(&tty, baud);
|
||||
cfsetispeed(&tty, baud);
|
||||
|
||||
tty.c_cflag = (tty.c_cflag & ~CSIZE) | CS8; // 8-bit chars
|
||||
// disable IGNBRK for mismatched speed tests; otherwise receive break
|
||||
// as \000 chars
|
||||
tty.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON | IXOFF | IXANY);
|
||||
tty.c_lflag = 0; // no signaling chars, no echo,
|
||||
// no canonical processing
|
||||
tty.c_oflag = 0; // no remapping, no delays
|
||||
tty.c_cc[VMIN] = 1; // read blocks
|
||||
tty.c_cc[VTIME] = 1; // 0.1 seconds inter character read timeout after first byte was received
|
||||
|
||||
tty.c_cflag |= (CLOCAL | CREAD); // ignore modem controls,
|
||||
// enable reading
|
||||
tty.c_cflag &= ~(PARENB | PARODD); // shut off parity
|
||||
tty.c_cflag &= ~CSTOPB; // 1 Stop bit
|
||||
tty.c_cflag &= ~CRTSCTS;
|
||||
|
||||
if (tcsetattr(fd, TCSANOW, &tty) != 0) {
|
||||
EVLOG_error << "Serial: error from tcsetattr: " << errno;
|
||||
return false;
|
||||
}
|
||||
return true;
|
||||
}
|
||||
|
||||
/*
|
||||
This function receives a byte array.
|
||||
*/
|
||||
int SerialDevice::rx(std::vector<std::uint8_t>& rxbuf, std::optional<int> initial_timeout_ms,
|
||||
std::optional<int> in_msg_timeout_ms) {
|
||||
std::scoped_lock lock(serial_mutex);
|
||||
int _initial_timeout = SERIAL_RX_INITIAL_TIMEOUT_MS;
|
||||
if (initial_timeout_ms.has_value()) {
|
||||
_initial_timeout = initial_timeout_ms.value();
|
||||
}
|
||||
int _in_msg_timeout = SERIAL_RX_WITHIN_MESSAGE_TIMEOUT_MS;
|
||||
if (in_msg_timeout_ms.has_value()) {
|
||||
_in_msg_timeout = in_msg_timeout_ms.value();
|
||||
}
|
||||
struct timeval timeout;
|
||||
timeout.tv_sec = 0;
|
||||
timeout.tv_usec = _initial_timeout * 1000; // intial timeout until device responds
|
||||
fd_set set;
|
||||
FD_ZERO(&set);
|
||||
FD_SET(fd, &set);
|
||||
|
||||
int bytes_read_total = 0;
|
||||
while (true) {
|
||||
int rv = select(fd + 1, &set, NULL, NULL, &timeout);
|
||||
timeout.tv_usec = _in_msg_timeout * 1000; // reduce timeout after first chunk,
|
||||
// no uneccesary waiting at the end of the message
|
||||
if (rv == -1) { // error in select function call
|
||||
perror("rx: select:");
|
||||
break;
|
||||
} else if (rv == 0) { // no more bytes to read within timeout, so transfer is complete
|
||||
EVLOG_debug << "No more bytes to read within timeout. (rv == 0)";
|
||||
break;
|
||||
} else { // received more bytes, add them to buffer
|
||||
// do we have space in the rx buffer left?
|
||||
if (bytes_read_total >= rxbuf.capacity()) {
|
||||
// no buffer space left, but more to read.
|
||||
EVLOG_info
|
||||
<< R"(No buffer space left, but more to read. (Did you mean to set "ignore_echo" to "false"?))";
|
||||
break;
|
||||
}
|
||||
|
||||
rxbuf.resize(rxbuf.capacity());
|
||||
int bytes_read = read(fd, static_cast<std::uint8_t*>(&rxbuf[0] + bytes_read_total),
|
||||
static_cast<size_t>(rxbuf.capacity() - bytes_read_total));
|
||||
|
||||
if (bytes_read > 0) {
|
||||
bytes_read_total += bytes_read;
|
||||
rxbuf.resize(bytes_read_total);
|
||||
} else if (bytes_read < 0) {
|
||||
EVLOG_error << "Error reading from device: " << strerror(errno);
|
||||
}
|
||||
}
|
||||
}
|
||||
return bytes_read_total;
|
||||
}
|
||||
|
||||
/*
|
||||
This function transmits a byte vector.
|
||||
*/
|
||||
void SerialDevice::tx(const std::vector<std::uint8_t>& request) {
|
||||
{
|
||||
std::scoped_lock lock(serial_mutex);
|
||||
// clear input and output buffer
|
||||
tcflush(fd, TCIOFLUSH);
|
||||
|
||||
// write to serial port
|
||||
write(fd, request.data(), request.size());
|
||||
tcdrain(fd);
|
||||
}
|
||||
if (ignore_echo) {
|
||||
// read back echo of what we sent and ignore it
|
||||
std::vector<std::uint8_t> req_buf{};
|
||||
req_buf.reserve(request.size() + 1);
|
||||
rx(req_buf, std::nullopt, std::nullopt);
|
||||
}
|
||||
}
|
||||
|
||||
} // namespace serial_device
|
||||
Reference in New Issue
Block a user