在 C++ 中从串行读取和解释数据

如何解决在 C++ 中从串行读取和解释数据

我正在编写一个 C++ 应用程序，它需要从串行端口读取数据（由板上集成的 Arduino Leonardo 发送），解释并保存它。我在串行端口上有 2 个后续消息：一个来自 GPS 设备（通过串行直通），另一个来自某些传感器的数据。

我已经可以读取数据，但我无法解释它。来自 GPS 的数据以二进制打包在 SBP 协议中。 Protocol structure.

我可以使用 Python 结构轻松读取和保存它，如下所示：

if ser.read().hex() == "55":
  if ser.read(2).hex() == "0102":
     ser.read(7)  # unnecessary information
     lat = struct.unpack('d',ser.read(8))[0]
     lon = struct.unpack('d',ser.read(8))[0]
     alt = struct.unpack('d',ser.read(8))[0]
     ser.read(4)  # unnecessary information                                         
     n_sats = struct.unpack('B',ser.read(1))[0]
     flag = (struct.unpack('B',ser.read(1))[0]) % 4

但是我正在努力用 C++ 制作它（我需要用 C++ 制作它）。我正在将数据读取到这样的缓冲区

#include "Serial.h"
#include "SerialReader.h"
#include <iostream>

#ifdef _WIN32
const char *port = "COM3";
#else
const char *port = "/dev/ttyUSB0";
#endif

using namespace std;

const uint16_t sizeBuf = 512;   
    
int main()
{   
    CSerial serial;  //Serial object 
    
    uint8_t *buf = new uint8_t[sizeBuf];

    //Tries to open connection to COM port
    while (tryCont < 10) {
        if (serial.Open(port,38400)) {
            cout << "Port opened successfully" << endl;
            break;
        }
        else {
            cout << "Failed to open port! Trying again..." << endl;
            tryCont++;
            Sleep(5000);
        }

        if (tryCont >= 10) {
            cout << "Impossible to open port" << endl;
            return 0;
        }
    }

    while (true) {                  

        serial.ReadData(buf,sizeBuf); //Reads data from serial and stores in buffer
   }
}

阅读本文时，我希望在数组的每个位置都有一个字节，并且它们像在 Python 代码中一样进行比较和处理，但事实并非如此。消息的第一个字节是十六进制 0x55，但我在缓冲区中的内容是例如 buf(0) = 0x05 和 buf(1) = 0x05。我尝试了很多方法，但我无法使其更具可读性。除了这个问题，我还需要从多个字节的值中读取信息，我也遇到了这个问题。我真的是个菜鸟，很抱歉，如果有什么明显的。

下面是打印缓冲区时读取的数据示例（我在数组的每个成员之间放置了一个空格以显示我在说什么）。我希望有 55，然后是 01，等等。而不是 5、5、0、1。

5 5 0 1 E D 9 B F B 6 4 0 6 A A F 0 0 0 0 5 5 6 A 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 5 1 5 5 D 7 5 5 5 5 5 5 B D 5 5 5 5 5 5 0 5 5 F F 5 5 E D 5 5 0 5 5 E 5 5 5 1 8 5 5 7 0 5 5 0 5 5 F D 5 5 5 5 5 5 5 5 5 5 0 9 0 3 C 4 E 5 5 5 2 E D 9 1 6 8 5 9 B 2 0 2 4 F 3 F F F F A 1 F 6 F F F F 0 0 0 0 0 0 0 0 9 0 8 8 6 C 5 5 4 2 E D 9 1 4 8 5 9 B 2 0 E D F 3 F F F F 6 7 F E F F F F C 3 F 5 F F F F 0 0 9 0 1 8 6 D 5 5 2 2 E D 9 1 4 8 5 9 B 2 0 E 2 3 E F F F F F 3 1 D 1 0 1 B B 7 0 0 0 0 9 1 2 C 7 F 5 5 3 2 E D 9 1 6 8 5 9 B 2 0 3 E 6 0 0 4 6 C 4 F E F F 0 0 0 0 0 0 0 0 9 1 F 1 2 5 5 1 2 E D 9 2 2 8 5 9 B 2 0 7 D 1 6 3 B 7 6 1 9 B 7 4 2 4 0 2 8 A E C 7 3 E 2 3 8 B 5 E C 0 9 D 2 0 C F 8 6 4 1 8 C 5 1 4 0 0 0 0 0 9 1 C F C 9 5 5 0 2 E D 9 2 0 8 5 9 B 2 0 3 B 6 A 1 A 4 5 2 0 9 A 4 4 C 1 7 8 D 8 6 8 4 C C C 5 F 5 0 C 1 B 6 8 6 9 1 9 B 3 C 6 A 4 D 4 1 0 0 9 1 A E 8 A

我使用这个 library 来完成串行连接部分。

在 C++ 中从串行读取和解释数据

如何解决在 C++ 中从串行读取和解释数据

相关推荐