ROS主控讀取stm32發送的數據

之后便可以通過

Stm32_Serial.read(Receive_Data_Pr,sizeof(Receive_Data_Pr));

read函數讀取串口接收到的字節，之后通過定義的通信協議再進行和校驗與數據解析即可stm32向ROS主控發送數據。

ROS主控向stm32發送數據

ROS主控向stm32發送數據的代碼如下：

將之前定義的發送數據的結構體 Send_Data的tx 中填入要發送的字節

Send_Data.tx[0]=FRAME_HEADER; //frame head 0x7B //幀頭0X7B
 Send_Data.tx[1] = 0; //set aside //預留位
 Send_Data.tx[2] = 0; //set aside //預留位

填好字節后，直接通過下面代碼發送即可

try
  {
    Stm32_Serial.write(Send_Data.tx,sizeof (Send_Data.tx)); //Sends data to the downloader via serial port //通過串口向下位機發送數據 
  }
  catch (serial::IOException& e)   
  {
    ROS_ERROR_STREAM("Unable to send data through serial port"); //If sending data fails, an error message is printed //如果發送數據失敗，打印錯誤信息
  }