mirror of
https://github.com/davidgiven/fluxengine.git
synced 2025-10-31 11:17:01 -07:00
Split the serial port code off into its own file so we can use it for the SCP
driver.
This commit is contained in:
223
lib/usb/serial.cc
Normal file
223
lib/usb/serial.cc
Normal file
@@ -0,0 +1,223 @@
|
||||
#include "globals.h"
|
||||
#include "usb.h"
|
||||
#include "protocol.h"
|
||||
#include "fluxmap.h"
|
||||
#include "bytes.h"
|
||||
#include "fmt/format.h"
|
||||
#include "serial.h"
|
||||
#include <unistd.h>
|
||||
#include <sys/types.h>
|
||||
#include <sys/stat.h>
|
||||
#include <fcntl.h>
|
||||
|
||||
#if defined __WIN32__
|
||||
#include <windows.h>
|
||||
|
||||
class SerialPortImpl : public SerialPort
|
||||
{
|
||||
public:
|
||||
SerialPortImpl(const std::string& name)
|
||||
{
|
||||
_handle = CreateFileA(
|
||||
name.c_str(),
|
||||
/* dwDesiredAccess= */ GENERIC_READ|GENERIC_WRITE,
|
||||
/* dwShareMode= */ 0,
|
||||
/* lpSecurityAttribues= */ nullptr,
|
||||
/* dwCreationDisposition= */ OPEN_EXISTING,
|
||||
/* dwFlagsAndAttributes= */ FILE_ATTRIBUTE_NORMAL,
|
||||
/* hTemplateFile= */ nullptr);
|
||||
if (_handle == INVALID_HANDLE_VALUE)
|
||||
Error() << fmt::format("cannot open serial port '{}': {}",
|
||||
name, get_last_error_string());
|
||||
|
||||
DCB dcb =
|
||||
{
|
||||
.DCBlength = sizeof(DCB),
|
||||
.BaudRate = CBR_9600,
|
||||
.fBinary = true,
|
||||
.ByteSize = 8,
|
||||
.Parity = NOPARITY,
|
||||
.StopBits = ONESTOPBIT
|
||||
};
|
||||
SetCommState(_handle, &dcb);
|
||||
|
||||
COMMTIMEOUTS commtimeouts = {0};
|
||||
commtimeouts.ReadIntervalTimeout = 100;
|
||||
SetCommTimeouts(_handle, &commtimeouts);
|
||||
|
||||
PurgeComm(_handle, PURGE_RXABORT|PURGE_RXCLEAR|PURGE_TXABORT|PURGE_TXCLEAR);
|
||||
}
|
||||
|
||||
~SerialPortImpl() override
|
||||
{
|
||||
CloseHandle(h);
|
||||
}
|
||||
|
||||
public:
|
||||
ssize_t readImpl(uint8_t* buffer, size_t len) override
|
||||
{
|
||||
DWORD rlen;
|
||||
bool r = ReadFile(
|
||||
/* hFile= */ _handle,
|
||||
/* lpBuffer= */ buffer,
|
||||
/* nNumberOfBytesToRead= */ len,
|
||||
/* lpNumberOfBytesRead= */ &rlen,
|
||||
/* lpOverlapped= */ nullptr);
|
||||
if (!r)
|
||||
Error() << fmt::format("serial read I/O error: {}", get_last_error_string());
|
||||
return rlen;
|
||||
}
|
||||
|
||||
ssize_t write(const uint8_t* buffer, size_t len) override
|
||||
{
|
||||
DWORD wlen;
|
||||
bool r = WriteFile(
|
||||
/* hFile= */ _handle,
|
||||
/* lpBuffer= */ buffer,
|
||||
/* nNumberOfBytesToWrite= */ len,
|
||||
/* lpNumberOfBytesWritten= */ &wlen,
|
||||
/* lpOverlapped= */ nullptr);
|
||||
if (!r)
|
||||
Error() << fmt::format("serial write I/O error: {}", get_last_error_string());
|
||||
return wlen;
|
||||
}
|
||||
|
||||
private:
|
||||
static std::string get_last_error_string()
|
||||
{
|
||||
DWORD error = GetLastError();
|
||||
if (error == 0)
|
||||
return "OK";
|
||||
|
||||
LPSTR buffer = nullptr;
|
||||
size_t size = FormatMessageA(
|
||||
/* dwFlags= */ FORMAT_MESSAGE_ALLOCATE_BUFFER|FORMAT_MESSAGE_FROM_SYSTEM|FORMAT_MESSAGE_IGNORE_INSERTS,
|
||||
/* lpSource= */ nullptr,
|
||||
/* dwMessageId= */ error,
|
||||
/* dwLanguageId= */ MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT),
|
||||
/* lpBuffer= */ (LPSTR) &buffer,
|
||||
/* nSize= */ 0,
|
||||
/* Arguments= */ nullptr);
|
||||
|
||||
std::string message(buffer, size);
|
||||
LocalFree(buffer);
|
||||
return message;
|
||||
}
|
||||
|
||||
private:
|
||||
HANDLE _handle;
|
||||
};
|
||||
|
||||
#else
|
||||
#include <termios.h>
|
||||
|
||||
class SerialPortImpl : public SerialPort
|
||||
{
|
||||
public:
|
||||
SerialPortImpl(const std::string& path)
|
||||
{
|
||||
#ifdef __APPLE__
|
||||
if (name.find("/dev/tty.") != std::string::npos)
|
||||
std::cerr << "Warning: you probably want to be using a /dev/cu.* device\n";
|
||||
#endif
|
||||
|
||||
_fd = open(path.c_str(), O_RDWR);
|
||||
if (_fd == -1)
|
||||
Error() << fmt::format("cannot open serial port '{}': {}",
|
||||
path, strerror(errno));
|
||||
|
||||
struct termios t;
|
||||
tcgetattr(_fd, &t);
|
||||
t.c_iflag = 0;
|
||||
t.c_oflag = 0;
|
||||
t.c_cflag = CREAD;
|
||||
t.c_lflag = 0;
|
||||
t.c_cc[VMIN] = 1;
|
||||
cfsetspeed(&t, 9600);
|
||||
tcsetattr(_fd, TCSANOW, &t);
|
||||
}
|
||||
|
||||
~SerialPortImpl() override
|
||||
{
|
||||
close(_fd);
|
||||
}
|
||||
|
||||
public:
|
||||
ssize_t readImpl(uint8_t* buffer, size_t len) override
|
||||
{
|
||||
ssize_t rlen = ::read(_fd, buffer, len);
|
||||
if (rlen == -1)
|
||||
Error() << fmt::format("serial read I/O error: {}", strerror(errno));
|
||||
return rlen;
|
||||
}
|
||||
|
||||
ssize_t write(const uint8_t* buffer, size_t len) override
|
||||
{
|
||||
ssize_t wlen = ::write(_fd, buffer, len);
|
||||
if (wlen == -1)
|
||||
Error() << fmt::format("serial write I/O error: {}", strerror(errno));
|
||||
return wlen;
|
||||
}
|
||||
private:
|
||||
int _fd;
|
||||
};
|
||||
#endif
|
||||
|
||||
SerialPort::~SerialPort()
|
||||
{}
|
||||
|
||||
void SerialPort::read(uint8_t* buffer, size_t len)
|
||||
{
|
||||
while (len > 0)
|
||||
{
|
||||
if (_readbuffer_ptr < _readbuffer_fill)
|
||||
{
|
||||
int buffered = std::min(len, _readbuffer_fill - _readbuffer_ptr);
|
||||
memcpy(buffer, _readbuffer + _readbuffer_ptr, buffered);
|
||||
_readbuffer_ptr += buffered;
|
||||
buffer += buffered;
|
||||
len -= buffered;
|
||||
}
|
||||
|
||||
if (len == 0)
|
||||
break;
|
||||
|
||||
_readbuffer_fill = this->readImpl(_readbuffer, sizeof(_readbuffer));
|
||||
_readbuffer_ptr = 0;
|
||||
}
|
||||
}
|
||||
|
||||
void SerialPort::read(Bytes& bytes)
|
||||
{
|
||||
this->read(bytes.begin(), bytes.size());
|
||||
}
|
||||
|
||||
Bytes SerialPort::readBytes(size_t len)
|
||||
{
|
||||
Bytes b(len);
|
||||
this->read(b);
|
||||
return b;
|
||||
}
|
||||
|
||||
uint8_t SerialPort::readByte()
|
||||
{
|
||||
uint8_t b;
|
||||
this->read(&b, 1);
|
||||
return b;
|
||||
}
|
||||
|
||||
void SerialPort::write(const Bytes& bytes)
|
||||
{
|
||||
int ptr = 0;
|
||||
while (ptr < bytes.size())
|
||||
{
|
||||
ssize_t wlen = this->write(bytes.cbegin() + ptr, bytes.size() - ptr);
|
||||
ptr += wlen;
|
||||
}
|
||||
}
|
||||
|
||||
std::unique_ptr<SerialPort> SerialPort::openSerialPort(const std::string& path)
|
||||
{
|
||||
return std::make_unique<SerialPortImpl>(path);
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user