C++输出的信息与Python不同(读取串口数据)

3

摘要

我有两个程序;一个用Python3编写,另一个用C++编写。它们都执行相同的任务;从串口读取数据,过滤掉两个头部浮点数,并打印剩余消息。Python脚本正常工作(请参见下面的正确数字输出);使用serial库的C++程序不起作用,而且我无法找出原因。(运行于Raspberry Pi 4上,Raspbian Buster系统)。

为了避免任何人阅读整个内容;如果我决定使用此库进行串行读取是错误的,那么我应该如何正确地从C ++读取串口?

我尝试过的

我非常新于C++,所以也许我正在寻找所有错误的地方,但是我找不到一个普遍接受的用于从串口读取的库,因此我选择了在github上星星最多的那个库(serial)

这个答案提供了一个针对Windows的示例并链接到了几个库,但是它们要么用于Windows,要么使用C而不是C++。

这个使用另一个库。

这个是用C编写的(我的代码将与基于Simulink的C ++类一起编译,因此我认为我需要坚持使用C++(?))

我的代码

Python

以下是完全功能的Python代码:

import serial
import struct
import time

PORT_NUMBER = '/dev/ttyACM0'
BAUDRATE = 115200
MESSAGE_LENGTH = 8 
HEADER_NUMBER = float(112)

header_1_received = False       # Has the first header byte been received
header_2_received = False       # Has the second header byte been received
dat = []                        # The actual message

# Open serial port
ser = serial.Serial(
        port=PORT_NUMBER,
        baudrate=BAUDRATE,
        parity=serial.PARITY_NONE,
        stopbits=serial.STOPBITS_ONE,
        timeout=0.001)

ser.isOpen()
readings = 0

print('Receive data from Pixhawk using 2 header floats and {} message floats (32-bit) \nIf you wish to close the program, hit \"Ctrl+C\" on your keyboard and it (should) shut down gracefully.'.format(MESSAGE_LENGTH))
start_time = time.time()        # Start time for the program

try:
    # Main loop
    while (True):
        # Read 4 bytes (32-bits) to get a full float number
        buffer = ser.read(4)
        # Only proceed if the buffer is not empty (an empty buffer is b'')
        if buffer != b'':
            # Since struct.unpack() returns a tuple, we only grab the first element
            try:
                new_dat = struct.unpack("f",buffer)[0]
                if header_1_received==True and header_2_received==True:
                    dat.append(new_dat)
                elif new_dat == HEADER_NUMBER:
                    # We found a header single; treat it
                    if header_1_received == False:
                        header_1_received = True
                    elif header_2_received == False:
                        header_2_received = True
                    else:
                        # Since below, we reset headers once the full message is received, kind of pointless else
                        pass
                else:
                    # If a non-header character is received, but we haven't identified the headers yet, then we're starting in the middle of a message or have lost the rest of our previous message
                    dat = []
                    header_1_received = False
                    header_2_received = False
            except:
                # struct.unpack likely failed; throw away the message and start again
                header_1_received = False
                header_2_received = False
                dat = []
            if(len(dat) == MESSAGE_LENGTH):
                # Reset flags
                #print(dat)
                header_1_received = False
                header_2_received = False
                dat = []
                readings += 1
except KeyboardInterrupt:
    ser.close()
    elapsed_time = time.time() - start_time
    if readings > 0:
        print("Number of readings: {}\nRun time: {}s\nAverage time per reading: {}s ({}ms)".format(readings,elapsed_time,elapsed_time/readings,(elapsed_time/readings)*1000))

C++

以下是一些有问题的 C++ 代码:

#include <string>
#include <iostream>
#include <cstdio>
#include <unistd.h>
#include "serial/serial.h"

using std::string;
using std::exception;
using std::cout;
using std::cerr;
using std::endl;
using std::vector;

int run(int argc, char **argv)
{
  // Argument 1 is the serial port or enumerate flag
  string port(argv[1]);

  // Argument 2 is the baudrate
  unsigned long baud = 0;
  sscanf(argv[2], "%lu", &baud);

  // port, baudrate, timeout in milliseconds
  serial::Serial my_serial(port, baud, serial::Timeout::simpleTimeout(0.001));

  cout << "Is the serial port open?";
  if(my_serial.isOpen())
    cout << " Yes." << endl;
  else
    cout << " No." << endl;

  /* MY CUSTOM VARIABLES */
  const float header = 112;
  const int msg_size = 8;
  int msg_index = 0;                
  float f;                  // the read float
  float msg [msg_size] = { };           // the collected floats will be placed here, auto-filled with 0s
  bool header_1_received = false;
  bool header_2_received = false;
  uint8_t *buffer = new uint8_t[sizeof(f)]; // buffer that will be converted to 32-bit float
  int count = 0;

  while (count < 1000) {

    size_t number_of_bytes_read = my_serial.read(buffer, sizeof(f));
    memcpy(&f, buffer, sizeof(f));

    // Logic for adding new element to array
    if (header_1_received and header_2_received){
      msg[msg_index] = f;
      msg_index += 1;
    } else if (f == header) {
      if (header_1_received == false){
        header_1_received = true;
      } else if (header_2_received == false){
        header_2_received = true;
      } else {
        // Do nothing
      }
    } else {
      // A non-header character was received, but headers are also not identified;
      // Throw partial message away and restart
      std::fill_n(msg, msg_size, 0);       // Fill with zeroes
      msg_index = 0;
      header_1_received = false;
      header_2_received = false;
    }

    // Check to see if message is full
    if(msg_index == msg_size){
      cout << "Msg: [";
      for (int i = 0; i < msg_size; i += 1){
        cout << msg[i] << ",";
      }
      cout << "]" << endl;
      // Reset flags
      header_1_received = false;
      header_2_received = false;
      std::fill_n(msg, msg_size, 0);
      msg_index = 0;
    }
    count += 1;
  }
  return 0;
}

int main(int argc, char **argv) {
  try {
    return run(argc, argv);
  } catch (exception &e) {
    cerr << "Unhandled Exception: " << e.what() << endl;
  }
}

C++库可以在这里找到,有关read方法的文档可以在这里找到。据我理解,他的read方法将请求的字节数(如果可用)写入缓冲区;来自其他设备的字节有一个恒定的流,因此我不认为这是问题所在。

预期结果

Python3脚本正常运行并输出以下内容:
[0.08539174497127533, 0.17273111641407013, -9.816835403442383, 0.0, 0.0, 0.0, 0.0, 0.0]
[0.08539174497127533, 0.17273111641407013, -9.816835403442383, 0.0, 0.0, 0.0, 0.0, 0.0]
[0.08539174497127533, 0.17273111641407013, -9.816835403442383, 0.0, 0.0, 0.0, 0.0, 0.0]
[0.08539174497127533, 0.17273111641407013, -9.816835403442383, 0.0, 0.0, 0.0, 0.0, 0.0]

应该是两个非常小的数字,接着大约是-9.81,然后是5个零。

实际结果

可以通过运行以下命令来构建和执行C++程序:

g++ serial_example.cc -lserial -L ../build/devel/lib -I../include -o test_serial
LD_LIBRARY_PATH=`pwd`/../build/devel/lib ./test_serial

并输出以下内容:
[112,112,112,112,112,112,112,112,]
[112,-9.82691,-9.82691,-9.82691,-9.82691,-9.82691,-9.82691,0,]
[112,112,112,112,-9.82691,-9.82691,-9.82691,-9.82691,]
[112,112,112,112,112,112,112,112,]

如果我添加以下代码行:
cout << "Float extracted from buffer: " << f << endl;

然后它会输出从读取操作中重构出的每个浮点数,导致了一个9.81、112和0的混合体。
问题:
我的C++程序出了什么问题,导致它以不同于Python程序的方式读取字节/浮点数?如果库有问题,那么在C++中读取串行消息的替代方法或库是什么?
编辑:
经过与@Barmar和@Gaspa79的一些故障排除,似乎库的read()方法读取的字节数是不一致的。我将尝试重新编写我的程序,并把新版本留为答案。

1
你不需要 buffer 变量,可以直接读入到 f 中:my_serial.read(static_cast<uint8_t*>(&f), sizeof(f)) - Barmar
1
你实际上不需要使用库来从Unix串口读取数据。请参阅https://blog.mbedded.ninja/programming/operating-systems/linux/linux-serial-ports-using-c-cpp/,了解如何使用纯C或C++进行操作。 - Barmar
@Jarod42,已经注意并更改了! @Barmar 我会尝试直接读取f,然后再尝试不使用库从头开始。谢谢! - Joshua O'Reilly
这是因为f不是无符号字符(uint8_t typedef)。 - Gaspa79
1
对于未来阅读此内容的任何人:问题在于底层库一次读取了超过4个字节 =) - Gaspa79
显示剩余17条评论
1个回答

1

在确认转换确实正确之后,我们意识到 OP 实际上从未检查 number_of_bytes_read 变量,而底层库由于某种原因读取了不同数量的字节。


网页内容由stack overflow 提供, 点击上面的
可以查看英文原文,
原文链接