话题列表

终端输入ros2 topic list

root@hessian:~# ros2 topic list
/baton_mini/CamL2Imu
/baton_mini/CamR2Imu
/baton_mini/algo_status
/baton_mini/camera_left_info
/baton_mini/camera_right_info
/baton_mini/image_left
/baton_mini/image_left/compressed
/baton_mini/image_left_info
/baton_mini/image_right
/baton_mini/image_right/compressed
/baton_mini/image_right_info
/baton_mini/imu
/baton_mini/imu_temp
/baton_mini/stereo3/feature_img
/baton_mini/stereo3/feature_img/compressed
/baton_mini/stereo3/imu_odom    #200hz IMU插帧里程计
/baton_mini/stereo3/odom_path
/baton_mini/stereo3/odometry    #10hz VIO里程计
/baton_mini/stereo3/pointcloud
/baton_mini/stereo3/version
/baton_mini/stereo3_ctrl
/baton_mini/stereo4/feature_img
/baton_mini/stereo4/feature_img/compressed
/baton_mini/stereo4/fusion_odom
/baton_mini/stereo4/fusion_path
/baton_mini/stereo4/imu_odom #200hz IMU插帧里程计
/baton_mini/stereo4/lla_odom
/baton_mini/stereo4/odom_path
/baton_mini/stereo4/odometry #20hz VIO里程计
/baton_mini/stereo4/pointcloud
/baton_mini/stereo4/rtk_odom
/baton_mini/stereo4/rtk_path
/baton_mini/stereo4/version
/baton_mini/stereo4_ctrl
/parameter_events
/rosout

1.传感器数据话题

（1）左目图像

话题名：/baton_mini/image_left Type: sensor_msgs/msg/Image

（2）右目图像

话题名：/baton_mini/image_right Type: sensor_msgs/msg/Image

（3）左目图像曝光信息

话题名：/baton_mini/image_left_info   Type: sensor_msgs/msg/Image

该消息类型为自定义类型，在自定义消息类型可以找到，具体定义如下。

exposure: 4976 #曝光时间
analog_gain: 1.0 #模拟增益
digital_gain: 1.0 #数字增益

（4)右目图像曝光信息

话题名：/baton_mini/image_right_info   Type: sensor_msgs/msg/Image

（5）imu原始数据

话题名：/baton_mini/imu Type: sensor_msgs/msg/Imu

（6）imu温度数据

话题名：/baton_mini/imu_temp Type: sensor_msgs/msg/Temperature

2.参数话题

（1）左目到IMU外参

话题名：/baton_mini/CamL2Imu  Type: geometry_msgs/msg/PoseStamped

（2）右目到IMU外参

话题名：/baton_mini/CamR2Imu Type: geometry_msgs/msg/PoseStamped

（3）左目参数

话题名：/baton_mini/camera_left_info Type: sensor_msgs/msg/CameraInfo

height: 480 #图像高
width: 640 #图像宽
distortion_model: "ds" #畸变模型
D: [-0.25824591334560476, 0.5672715939661027, 0.0, 0.0, 0.0] #畸变系数
K: [164.15676583809704, 0.0, 318.5936994457823, 
    0.0, 164.0741011283019, 239.66298170413694,
    0.0, 0.0, 1.0]#相机内参
R: [1.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 1.0]
P: [1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0, 0.0, 0.0, 0.0, 1.0, 0.0]
binning_x: 0
binning_y: 0
roi:
  x_offset: 0
  y_offset: 0
  height: 0
  width: 0
  do_rectify: False

（4）右目参数

话题名：/baton_mini/camera_right_info Type: sensor_msgs/msg/CameraInfo

height: 480 #图像高
width: 640  #图像宽
distortion_model: "ds" #畸变模型
D: [-0.2615917683666564, 0.5679955819508452, 0.0, 0.0, 0.0] #畸变系数
K: [163.79787865873183, 0.0, 323.4330173880752, 
    0.0, 163.62052609635333, 243.67927518142795, 
    0.0, 0.0, 1.0]#相机内参
R: [0.9999730625093293, 0.0031151927461599226, 0.006646038659791247,
   -0.0031351685298500703, 0.9999905932027023, 0.002997369579618926, 
   -0.006636638757880752, -0.003018125289258183, 0.9999734226196892]#右目到左目外参旋转矩阵
P: [ 163.79787865873183, 0.0, 323.4330173880752,0.061327748008980894,
     0.0, 163.62052609635333, 243.67927518142795, -0.0004044248281003861, 
     0.0, 0.0, 1.0，-0.00033629396372312104] #最后一列为右目到左目外参平移变换
binning_x: 0
binning_y: 0
roi:
  x_offset: 0
  y_offset: 0
  height: 0
  width: 0
  do_rectify: False

3.算法输出话题

（1）算法状态

话题名：/baton_mini/algo_status

Type:system_ctrl/algo_status

该话题为自定义话题消息类型，在自定义消息里面能找到，具体定义如下

algo_status: "ready" #或者是“stereo3_inilizing”或"stereo3_running"或"stereo4_inilizing"或"stereo4_running"

（2）特征点图

话题名：/baton_mini/stereo3/feature_img or /baton_mini/stereo4/feature_img

Type:sensor_msgs/msg/Image

算法正常启动后，通过左右目提取特征点并跟踪，合成在同一张图片上显示出跟踪到的特征点。

（3）算法输出里程计

话题名：/baton_mini/stereo3/odometry or /baton_mini/stereo4/odometry

Type:nav_msgs/msg/Odometry

算法正常启动后，通过VIO计算出来的当前位姿与开始第一帧位姿（0，0，0，0，0，0，0）之间的相对位姿。

（4）算法输出点云

话题名：/baton_mini/stereo3/pointcloud

Type:sensor_msgs/msg/PointCloud2

算法正常启动后，通过VIO计算特征点投影到三维空间中生成的点云。相对来说会比较稀疏，而且呈散射状。

（5）算法运行轨迹

话题名：/baton_mini/stereo3/path_odom or /baton_mini/stereo4/path_odom

Type:nav_msgs/msg/Path

算法正常启动后，通过算法运行过程中的历史位姿连成的轨迹。

4.控制话题

（1）算法控制

话题名：/baton/stereo3_ctrl or /baton/stereo3_ctrl

Type:system_ctrl/algo_ctrl

用于控制算法的启停、重启。该话题为自定义话题，在自定义消息类型可以找到，具体定义如下：

Header header
bool algo_enable
bool algo_reboot
bool algo_reset