Decode_0B类 参考

#include <protocol_asensing.h>

类 Decode_0B 继承关系图:

Decode_0B 的协作图:

Public 成员函数
	Decode_0B ()
virtual	~Decode_0B ()
void	subData (const uint8_t *sub_address, int &index)
void	parse0B (const uint8_t *data, int &pos)
void	parseGnss (const uint8_t *data, int &pos)
Public 成员函数 继承自 ProtocolAsensing
	ProtocolAsensing ()
virtual	~ProtocolAsensing ()
void	addData (const std::string &data)
void	clearCache ()
bool	registProtocol (const std::string &protocolFlag, int length, ProtocolAsensing *sub)
void	toQuaternion (double *rpy, double *quaterArray)
int	getLength (const std::string &flag)
uint32_t	getDataSize ()
void	changeLength (const std::string &flag, int len)
std::string	getProtocol ()

Public 属性
InsType	insdata
uint8_t	update_ins = 0
std::string	m_typeImu = "BDDB0B"
int	m_lengthImu = 63
std::string	m_typeGnss = "BDDB10"
int	m_lengthGnss = 83

详细描述

在文件 protocol_asensing.h 第 137 行定义.

构造及析构函数说明

Decode_0B()

Decode_0B::Decode_0B ( )

explicit

在文件 decode_0B.cc 第 57 行定义.

                     {
  filename2 = "BDDB10.csv";
  content2 =
      "Lon_deg,LonStd,Lat_deg,LatStd,Alt_m,AltStd,fix,RtkAge_s,Trk_deg,Vspd_"
      "mps,LatencyVel_s,BaseLineLenth_m,Heading_dg,HeadingStd,Pitch_deg,"
      "PitchStd,UtcYear,UtcMon,UtcDay,UtcHour,UtcMin,UtcSec,ItowPos,ItowVel,"
      "ItowHeading,RecMsgOutput,SvNumMst";
 
  filename0b = "BDDB0B.csv";
  content0b =
      "roll,pitch,yaw,GyroX,GyroY,GyroZ,x_acc,y_acc,z_acc,latitude,longitude,"
      "altitude,north_vel,east_vel,ground_vel,ins_status,modestatus,system_ms";
 
  // createFileAndWrite(filename2, content2);
  // createFileAndWrite(filename0b, content0b);
 
  registProtocol(m_typeImu, m_lengthImu, this);
  registProtocol(m_typeGnss, m_lengthGnss, this);
}

~Decode_0B()

Decode_0B::~Decode_0B ( )

virtual

在文件 decode_0B.cc 第 77 行定义.

{}

成员函数说明

parse0B()

void Decode_0B::parse0B	(	const uint8_t *	data,
		int &	pos
	)

在文件 decode_0B.cc 第 95 行定义.

                                                     {
  static const double deg_coefficient = 360.0 / 32768;
  static const double angular_coefficient = 300.0 / 32768;
  static const double acc_coefficient = 12.0 / 32768 * 9.7883105;
  static const double velocity_coefficient = 100.0 / 32768;
  static const double deg_to_rad = M_PI / 180.0;
 
  int sub_index = 3;
  uint8_t check_sum = 0;
  int dataLength = getLength(m_typeImu);
  /* check xor */
  for (int i = 0; i < dataLength - 1; ++i) {
    check_sum ^= data[i];
  }
 
  if (check_sum == data[dataLength - 1]) {
    /* roll pitch yaw */
    float roll = (toValue<int16_t>(data, sub_index)) * deg_coefficient;
    float pitch = (toValue<int16_t>(data, sub_index)) * deg_coefficient;
    float x = (toValue<int16_t>(data, sub_index)) * deg_coefficient;
    if (x < 0) {
      x = 360.0 + x;
    }
    float yaw = x;
 
    /* gx gy gz , ax ay az */
    double imu_msg_y_angular_velocity =
        (toValue<int16_t>(data, sub_index)) * angular_coefficient;
    double imu_msg_x_angular_velocity =
        (toValue<int16_t>(data, sub_index)) * angular_coefficient;
    double imu_msg_z_angular_velocity =
        -(toValue<int16_t>(data, sub_index)) * angular_coefficient;
    double imu_msg_y_acc =
        (toValue<int16_t>(data, sub_index)) * acc_coefficient;
    double imu_msg_x_acc =
        (toValue<int16_t>(data, sub_index)) * acc_coefficient;
    double imu_msg_z_acc =
        -(toValue<int16_t>(data, sub_index)) * acc_coefficient;
 
    double imu_msg_latitude = (toValue<int32_t>(data, sub_index)) * 0.0000001;
    double imu_msg_longitude = (toValue<int32_t>(data, sub_index)) * 0.0000001;
    double imu_msg_altitude = (toValue<int32_t>(data, sub_index)) * 0.001;
 
    float imu_msg_north_velocity =
        (toValue<int16_t>(data, sub_index)) * velocity_coefficient;
    float imu_msg_east_velocity =
        (toValue<int16_t>(data, sub_index)) * velocity_coefficient;
    float imu_msg_ground_velocity =
        (toValue<int16_t>(data, sub_index)) * velocity_coefficient;
    uint8_t imu_msg_ins_status = toValue<uint8_t>(data, sub_index);
    sub_index = 44;
    uint8_t modestatus = toValue<uint8_t>(data, sub_index);
    sub_index = 46;
    int16_t data1 = toValue<uint16_t>(data, sub_index);
    int16_t data2 = toValue<uint16_t>(data, sub_index);
    int16_t data3 = toValue<uint16_t>(data, sub_index);
 
    sub_index = 52;
    uint32_t timiddle = toValue<uint32_t>(data, sub_index);
    double t_ms = timiddle * 2.5 * 0.0001;
    uint8_t loop_type = toValue<uint8_t>(data, sub_index);
    sub_index = 58;
    uint32_t t_week = (toValue<uint32_t>(data, sub_index));
 
    gtime_t ts_time = gpst2time_sdk(t_week, t_ms - 18);
 
    int64_t system_ms = (static_cast<double>(ts_time.time) * 1000.0) +
                        (static_cast<double>(ts_time.sec) * 1000.0);
 
    pos += m_lengthImu;
 
    // 俯仰角
    insdata.Pitch_deg = pitch;
    // 横滚角
    insdata.Roll_deg = roll;
    // 航向角
    insdata.Yaw_deg = yaw;
 
    insdata.GyroX = imu_msg_x_angular_velocity * deg_to_rad; /*gx*/
    insdata.GyroY = imu_msg_y_angular_velocity * deg_to_rad;
    insdata.GyroZ = imu_msg_z_angular_velocity * deg_to_rad;
    insdata.AccX_g = imu_msg_x_acc; /* 零偏修正后加速度计 */
    insdata.AccY_g = imu_msg_y_acc;
    insdata.AccZ_g = imu_msg_z_acc;
 
    // 这个是惯导融合后的输出
    insdata.Lon_deg = imu_msg_longitude;
    insdata.Lat_deg = imu_msg_latitude;
    insdata.Alt_m = imu_msg_altitude;
 
    insdata.VelN_mps =
        imu_msg_north_velocity; /*融合后 NED north velocity (m/s) */
    insdata.VelE_mps =
        imu_msg_east_velocity; /*融合后 NED east velocity (m/s) */
    insdata.VelD_mps =
        imu_msg_ground_velocity; /*融合后 NED down velocity (m/s) */
    insdata.InsStatus = imu_msg_ins_status;
    insdata.LoopType = loop_type;
    insdata.data1 = data1;
    insdata.data2 = data2;
    insdata.data3 = data3;
    insdata.ModeStatus = modestatus;
    insdata.SysTime_ms = system_ms;
 
    // Do not write csv.
    // std::vector<std::string> data_w;
    // data_w.push_back(std::to_string(pitch));
    // data_w.push_back(std::to_string(roll));
    // data_w.push_back(std::to_string(yaw));
    // data_w.push_back(std::to_string(imu_msg_x_angular_velocity));
    // data_w.push_back(std::to_string(imu_msg_y_angular_velocity));
    // data_w.push_back(std::to_string(imu_msg_z_angular_velocity));
    // data_w.push_back(std::to_string(imu_msg_x_acc));
    // data_w.push_back(std::to_string(imu_msg_y_acc));
    // data_w.push_back(std::to_string(imu_msg_z_acc));
    // data_w.push_back(std::to_string(imu_msg_longitude));
    // data_w.push_back(std::to_string(imu_msg_latitude));
    // data_w.push_back(std::to_string(imu_msg_altitude));
    // data_w.push_back(std::to_string(imu_msg_north_velocity));
    // data_w.push_back(std::to_string(imu_msg_east_velocity));
    // data_w.push_back(std::to_string(imu_msg_ground_velocity));
    // data_w.push_back(std::to_string(imu_msg_ins_status));
    // data_w.push_back(std::to_string(modestatus));
    // data_w.push_back(std::to_string(system_ms));
 
    // if (AppendCsv(filename0b, data_w)) {
    //   // std::cout << "数据成功写入到文件 " << filename << "\n";
    // } else {
    //   std::cerr << "写入文件时出现错误\n";
    // }
 
    update_ins = 1;
  } else {
    pos += 3;
  }
}

parseGnss()

void Decode_0B::parseGnss	(	const uint8_t *	data,
		int &	pos
	)

在文件 decode_0B.cc 第 232 行定义.

                                                       {
  int sub_index = 3;
  uint8_t check_sum = 0;
  int dataLength = getLength(m_typeGnss);
  /* check xor */
  for (int i = 0; i < dataLength - 1; ++i) {
    check_sum ^= data[i];
  }
 
  if (check_sum == data[dataLength - 1]) {
    double m_gnssMsg_longitude =
        (toValue<int32_t>(data, sub_index)) * 0.0000001;
    double m_gnssMsg_lon_sigma = (toValue<int16_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_latitude = (toValue<int32_t>(data, sub_index)) * 0.0000001;
    double m_gnssMsg_lat_sigma = (toValue<int16_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_altitude = (toValue<int32_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_alt_sigma = (toValue<int16_t>(data, sub_index)) * 0.001;
 
    double m_gnssMsg_gps_fix = toValue<uint16_t>(data, sub_index);
    float m_gnssMsg_rtk_age = toValue<uint16_t>(data, sub_index);
    uint8_t m_gnssMsg_flags_pos = data[sub_index++];
    uint8_t m_gnssMsg_flags_vel = data[sub_index++];
    uint8_t m_gnssMsg_flags_attitude = data[sub_index++];
    uint8_t m_gnssMsg_flags_time = data[sub_index++];
 
    double m_gnssMsg_hor_vel = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_track_angle = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_ver_vel = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_latency_vel = (toValue<int16_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_base_length = (toValue<int16_t>(data, sub_index)) * 0.001;
 
    double m_gnssMsg_yaw = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_yaw_sigma = (toValue<int16_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_pitch = (toValue<int16_t>(data, sub_index)) * 0.001;
    double m_gnssMsg_pitch_sigma = (toValue<int16_t>(data, sub_index)) * 0.001;
 
    uint16_t utc_year_m = toValue<uint16_t>(data, sub_index);
    uint16_t utc_year = (utc_year_m & 0x3f) + 2000;
    // week_year = (((utc_year_m >> 6)&0x3ff) +2000);
    uint8_t utc_mon = data[sub_index++];
    uint8_t utc_day = data[sub_index++];
    uint8_t utc_hour = data[sub_index++];
    uint8_t utc_min = data[sub_index++];
    float utc_sec = toValue<uint16_t>(data, sub_index) * 0.001;
 
    double m_gnssMsg_ts_pos = toValue<uint32_t>(data, sub_index);
    double m_gnssMsg_ts_vel = toValue<uint32_t>(data, sub_index);
    double m_gnssMsg_ts_heading = toValue<uint32_t>(data, sub_index);
    double m_gnssMsg_state = data[sub_index++];
    double m_gnssMsg_num_master = data[sub_index++];
    sub_index++;
 
    double m_gnssMsg_gdop = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_pdop = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_hdop = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_htdop = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_tdop = (toValue<int16_t>(data, sub_index)) * 0.01;
    double m_gnssMsg_num_reserve = data[sub_index++];
 
    pos += m_lengthGnss;
 
    insdata.flag_pos = m_gnssMsg_flags_pos;
    // 这是融合rtk的输出
    insdata.Lon_gnss_deg = m_gnssMsg_longitude;
    insdata.Lat_gnss_deg = m_gnssMsg_latitude;
    insdata.Alt_gnss_m = m_gnssMsg_altitude;
    insdata.differential_age = m_gnssMsg_rtk_age;
 
    // Do not write csv.
    // std::vector<std::string> data_w;
    // data_w.push_back(std::to_string(m_gnssMsg_longitude));
    // data_w.push_back(std::to_string(m_gnssMsg_lon_sigma));
    // data_w.push_back(std::to_string(m_gnssMsg_latitude));
    // data_w.push_back(std::to_string(m_gnssMsg_lat_sigma));
    // data_w.push_back(std::to_string(m_gnssMsg_altitude));
    // data_w.push_back(std::to_string(m_gnssMsg_alt_sigma));
    // data_w.push_back(std::to_string(m_gnssMsg_gps_fix));
    // data_w.push_back(std::to_string(m_gnssMsg_rtk_age));
    // // data_w.push_back(std::to_string(m_gnssMsg_msg_type));
    // // data_w.push_back(std::to_string(m_gnssMsg_flags_pos));
    // // data_w.push_back(std::to_string(m_gnssMsg_flags_vel));
    // // data_w.push_back(std::to_string(m_gnssMsg_flags_attitude));
    // // data_w.push_back(std::to_string(m_gnssMsg_flags_time));
    // // data_w.push_back(std::to_string(m_gnssMsg_hor_vel));
    // data_w.push_back(std::to_string(m_gnssMsg_track_angle));
    // data_w.push_back(std::to_string(m_gnssMsg_ver_vel));
    // data_w.push_back(std::to_string(m_gnssMsg_latency_vel));
    // data_w.push_back(std::to_string(m_gnssMsg_base_length));
    // data_w.push_back(std::to_string(m_gnssMsg_yaw));
    // data_w.push_back(std::to_string(m_gnssMsg_yaw_sigma));
    // data_w.push_back(std::to_string(m_gnssMsg_pitch));
    // data_w.push_back(std::to_string(m_gnssMsg_pitch_sigma));
    // data_w.push_back(std::to_string(utc_year));
    // data_w.push_back(std::to_string(utc_mon));
    // data_w.push_back(std::to_string(utc_day));
    // data_w.push_back(std::to_string(utc_hour));
    // data_w.push_back(std::to_string(utc_min));
    // data_w.push_back(std::to_string(utc_sec));
    // data_w.push_back(std::to_string(m_gnssMsg_ts_pos));
    // data_w.push_back(std::to_string(m_gnssMsg_ts_vel));
    // data_w.push_back(std::to_string(m_gnssMsg_ts_heading));
    // data_w.push_back(std::to_string(m_gnssMsg_state));
    // data_w.push_back(std::to_string(m_gnssMsg_num_master));
    // data_w.push_back(std::to_string(m_gnssMsg_gdop));
    // data_w.push_back(std::to_string(m_gnssMsg_pdop));
    // data_w.push_back(std::to_string(m_gnssMsg_hdop));
    // // data_w.push_back(std::to_string(m_gnssMsg_vdop));
    // data_w.push_back(std::to_string(m_gnssMsg_tdop));
    // data_w.push_back(std::to_string(m_gnssMsg_num_reserve));
 
    // if (AppendCsv(filename2, data_w)) {
    //   // std::cout << "数据成功写入到文件 " << filename << "\n";
    // } else {
    //   std::cerr << "写入文件时出现错误\n";
    // }
 
  } else {
    pos += 3;
  }
}

subData()

void Decode_0B::subData ( const uint8_t *  sub_address, int &  index  )

virtual

重载 ProtocolAsensing .

在文件 decode_0B.cc 第 79 行定义.

                                                              {
  std::string type = "";
  char str[16] = {0};
  std::snprintf(str, sizeof(str), "%02X%02X%02X", sub_address[0],
                sub_address[1], sub_address[2]);
  type += str;
  if (type == m_typeImu) {
    parse0B(sub_address, index);
  } else if (type == m_typeGnss) {
    parseGnss(sub_address, index);
  } else {
    index += 3;
    printf("protocol type error:%s!\n", type.c_str());
  }
}

类成员变量说明

insdata

InsType Decode_0B::insdata

在文件 protocol_asensing.h 第 146 行定义.

m_lengthGnss

int Decode_0B::m_lengthGnss = 83

在文件 protocol_asensing.h 第 153 行定义.

m_lengthImu

int Decode_0B::m_lengthImu = 63

在文件 protocol_asensing.h 第 151 行定义.

m_typeGnss

std::string Decode_0B::m_typeGnss = "BDDB10"

在文件 protocol_asensing.h 第 152 行定义.

m_typeImu

std::string Decode_0B::m_typeImu = "BDDB0B"

在文件 protocol_asensing.h 第 150 行定义.

update_ins

uint8_t Decode_0B::update_ins = 0

在文件 protocol_asensing.h 第 147 行定义.

---

该类的文档由以下文件生成:

• modules/drivers/gnss/parser/asensing_parser/protocol_asensing.h
• modules/drivers/gnss/parser/asensing_parser/decode_0B.cc