Compare commits
2 Commits
45a14b5d19
...
478421ee07
Author | SHA1 | Date | |
---|---|---|---|
478421ee07 | |||
1417770918 |
@ -1,8 +1,10 @@
|
|||||||
#ifndef SERIAL_H
|
#ifndef SERIAL_H
|
||||||
#define SERIAL_H
|
#define SERIAL_H
|
||||||
|
|
||||||
|
#include <algorithm>
|
||||||
#include <chrono>
|
#include <chrono>
|
||||||
#include <cstring>
|
#include <cstring>
|
||||||
|
#include <expected>
|
||||||
#include <format>
|
#include <format>
|
||||||
#include <functional>
|
#include <functional>
|
||||||
#include <iostream>
|
#include <iostream>
|
||||||
@ -12,7 +14,6 @@
|
|||||||
#include <thread>
|
#include <thread>
|
||||||
#include <type_traits>
|
#include <type_traits>
|
||||||
#include <vector>
|
#include <vector>
|
||||||
#include <expected>
|
|
||||||
|
|
||||||
#include "serialib.h"
|
#include "serialib.h"
|
||||||
|
|
||||||
@ -90,10 +91,12 @@ class Serial {
|
|||||||
}
|
}
|
||||||
|
|
||||||
template <SupportString T>
|
template <SupportString T>
|
||||||
bool OpenDevice(T portName, unsigned int bauds = 115200) {
|
bool OpenDevice(T portName, unsigned int bauds = 115200,
|
||||||
|
int delayTime = 0) {
|
||||||
std::string reallyPortName;
|
std::string reallyPortName;
|
||||||
std::format_to(std::back_inserter(reallyPortName), "\\\\.\\{}",
|
std::format_to(std::back_inserter(reallyPortName), "\\\\.\\{}",
|
||||||
portName);
|
portName);
|
||||||
|
std::this_thread::sleep_for(std::chrono::milliseconds(delayTime));
|
||||||
if (ser.isDeviceOpen())
|
if (ser.isDeviceOpen())
|
||||||
return true;
|
return true;
|
||||||
int code = ser.openDevice(reallyPortName.c_str(), bauds);
|
int code = ser.openDevice(reallyPortName.c_str(), bauds);
|
||||||
@ -122,14 +125,15 @@ class Serial {
|
|||||||
}
|
}
|
||||||
|
|
||||||
template <SupportString T>
|
template <SupportString T>
|
||||||
std::expected<std::string, SerialErrorCode> DelayGetResponse(int delayTime, T command,
|
std::expected<std::string, SerialErrorCode>
|
||||||
int timeout = 50) {
|
DelayGetResponse(int delayTime, T command, int timeout = 50) {
|
||||||
std::this_thread::sleep_for(std::chrono::milliseconds(delayTime));
|
std::this_thread::sleep_for(std::chrono::milliseconds(delayTime));
|
||||||
return GetAtResponse(command, timeout);
|
return GetAtResponse(command, timeout);
|
||||||
}
|
}
|
||||||
|
|
||||||
template <SupportString T>
|
template <SupportString T>
|
||||||
std::expected<std::string, SerialErrorCode> GetAtResponse(T command, int timeout = 50) {
|
std::expected<std::string, SerialErrorCode>
|
||||||
|
GetAtResponse(T command, int timeout = 50) {
|
||||||
ser.flushReceiver();
|
ser.flushReceiver();
|
||||||
std::string reallyCommand;
|
std::string reallyCommand;
|
||||||
if constexpr (std::is_same_v<T, std::string>) {
|
if constexpr (std::is_same_v<T, std::string>) {
|
||||||
@ -141,20 +145,18 @@ class Serial {
|
|||||||
Log("Send: " + reallyCommand);
|
Log("Send: " + reallyCommand);
|
||||||
std::this_thread::sleep_for(10ms);
|
std::this_thread::sleep_for(10ms);
|
||||||
auto availableSize = ser.available();
|
auto availableSize = ser.available();
|
||||||
char *buffer = new char[availableSize + 1];
|
auto buffer = std::make_unique<char[]>(availableSize + 1);
|
||||||
std::memset(buffer, 0, availableSize);
|
std::memset(buffer.get(), 0, availableSize);
|
||||||
auto size = ser.readBytes(buffer, availableSize, timeout);
|
auto size = ser.readBytes(buffer.get(), availableSize, timeout);
|
||||||
|
|
||||||
if (size > 0) {
|
if (size > 0) {
|
||||||
buffer[size] = '\0';
|
buffer[size] = '\0';
|
||||||
std::string response = std::string(buffer);
|
std::string response = std::string(buffer);
|
||||||
Log("Receive: " + response);
|
Log("Receive: " + response);
|
||||||
delete[] buffer;
|
|
||||||
if (removeEcho)
|
if (removeEcho)
|
||||||
response.replace(0, reallyCommand.length(), "");
|
response.replace(0, reallyCommand.length(), "");
|
||||||
return response;
|
return response;
|
||||||
}
|
}
|
||||||
delete[] buffer;
|
|
||||||
return std::unexpected(SerialErrorCode::TIMEOUT);
|
return std::unexpected(SerialErrorCode::TIMEOUT);
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -166,8 +168,8 @@ class Serial {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
template <SupportString T>
|
template <int timeout = 200, SupportString T, SupportString... Args>
|
||||||
bool GetAtUntil(T command, T expect = "OK", int timeout = 200) {
|
bool GetAtUntil(T command, Args... expect) {
|
||||||
auto endTime = std::chrono::system_clock::now() +
|
auto endTime = std::chrono::system_clock::now() +
|
||||||
std::chrono::milliseconds(timeout);
|
std::chrono::milliseconds(timeout);
|
||||||
ser.flushReceiver();
|
ser.flushReceiver();
|
||||||
@ -182,14 +184,13 @@ class Serial {
|
|||||||
while (std::chrono::system_clock::now() < endTime) {
|
while (std::chrono::system_clock::now() < endTime) {
|
||||||
std::this_thread::sleep_for(10ms);
|
std::this_thread::sleep_for(10ms);
|
||||||
auto availableSize = ser.available();
|
auto availableSize = ser.available();
|
||||||
auto buffer = new char[availableSize + 1];
|
auto buffer = std::make_unique<char[]>(availableSize + 1);
|
||||||
auto size = ser.readBytes(buffer, availableSize, timeout);
|
auto size = ser.readBytes(buffer.get(), availableSize, timeout);
|
||||||
buffer[size] = '\0';
|
buffer[size] = '\0';
|
||||||
auto str = std::string(buffer);
|
auto str = std::string(buffer.get());
|
||||||
delete[] buffer;
|
|
||||||
if (size > 0)
|
if (size > 0)
|
||||||
Log("Receive: " + str);
|
Log("Receive: " + str);
|
||||||
if (str.find(expect) != std::string::npos) {
|
if (((str.find(expect) != std::string::npos) && ...)) {
|
||||||
return true;
|
return true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user