接入 ROS 2#
SDK 已提供 ROS 2 ament_python 示例包,复用 Python SDK 接收 HTTP 里程计和灰度 JPEG 图像。
准备与构建#
先在 统一 SDK 接入 下载并解压到 /absolute/path/neo-sdk,连接 Neo,启动 VIO 并完成初始化。 在已有 ROS 2 和 colcon 的电脑上加载对应发行版环境,使用原 rclpy 所在 Python, 不要换到没有 rclpy 的普通虚拟环境:
python3 -m pip install -e /absolute/path/neo-sdk/SDK/python
mkdir -p /your/ros2_ws/src
ln -s /absolute/path/neo-sdk/SDK/ros/ros2/robobaton_neo /your/ros2_ws/src/robobaton_neo
cd /your/ros2_ws
colcon build --packages-select robobaton_neo
source install/setup.bash
ros2 run robobaton_neo neo_odometry --ros-args -p origin:=http://192.168.11.1
另开终端,加载相同环境检查:
source /your/ros2_ws/install/setup.bash
ros2 topic echo /neo/odometry
ros2 topic echo /neo/source_header
ros2 topic hz /neo/odometry
ros2 topic hz /neo/image/compressed
ros2 topic echo /neo/image/source_header
跨电脑时确认 ROS_DOMAIN_ID 和 DDS 发现/网络策略。路径是示意,替换自己的解压位置和工作区。 本次没有给出已验收的 ROS 2 发行版矩阵,不能把示例源码当成某发行版的完整兼容承诺。
完整节点源码#
import rclpy
from rclpy.node import Node
from nav_msgs.msg import Odometry
from std_msgs.msg import String
from sensor_msgs.msg import CompressedImage
from robobaton_sdk.ros_adapter import Samples, convert, convert_image, source_header
class NeoOdometry(Node):
def __init__(self):
super().__init__('neo_odometry')
for name, default in (
('origin', 'http://192.168.11.1'), ('world_frame', 'neo_world'),
('imu_frame', 'neo_imu'), ('assumed_pose_variance', 1000000.0),
('assumed_twist_variance', 1000000.0),
('image_frame', 'neo_camera_optical'),
):
self.declare_parameter(name, default)
self.samples = Samples(self.get_parameter('origin').value)
self.images = Samples(self.get_parameter('origin').value, 'gray_jpeg')
self.image_publisher = self.create_publisher(CompressedImage, '/neo/image/compressed', 1)
self.image_headers = self.create_publisher(String, '/neo/image/source_header', 1)
self.publisher = self.create_publisher(Odometry, '/neo/odometry', 1)
self.headers = self.create_publisher(String, '/neo/source_header', 1)
self.timer = self.create_timer(0.01, self.publish_latest)
def publish_latest(self):
image = self.images.latest()
if image is not None:
self.image_publisher.publish(convert_image(
image, CompressedImage(), self.get_clock().now().to_msg(),
self.get_parameter('image_frame').value))
self.image_headers.publish(String(data=source_header(image)))
sample = self.samples.latest()
if sample is None:
return
message = convert(
sample, Odometry(), self.get_clock().now().to_msg(),
self.get_parameter('world_frame').value, self.get_parameter('imu_frame').value,
float(self.get_parameter('assumed_pose_variance').value),
float(self.get_parameter('assumed_twist_variance').value),
)
if message is not None:
self.publisher.publish(message)
self.headers.publish(String(data=source_header(sample)))
def main(args=None):
rclpy.init(args=args)
node = None
try:
node = NeoOdometry()
rclpy.spin(node)
finally:
if node is not None:
node.samples.close()
node.images.close()
node.destroy_node()
rclpy.shutdown()
实际发布的话题#
话题 |
消息 |
内容 |
|---|---|---|
/neo/odometry |
nav_msgs/Odometry |
有效位姿和 IMU 系速度 |
/neo/source_header |
std_msgs/String |
原始设备 seq/stamp JSON |
图像接收默认开启,与位姿使用独立连接,直接转发 gray_jpeg 的 JPEG 字节, 无需 OpenCV 或 cv_bridge,依赖 sensor_msgs:
/neo/image/compressed:sensor_msgs/CompressedImage,544×640 mono8 JPEG。
/neo/image/source_header:std_msgs/String,原设备图像 seq/stamp JSON。
format 为 mono8; jpeg compressed mono8,不进行解码重编码。
不发布原始 Image、CameraInfo、IMU 话题或 TF;不能把计划写成已提供功能。
使用支持 compressed transport 的图像查看器订阅 /neo/image;若直接订阅 /neo/image/compressed,必须使用 CompressedImage 类型,不是普通 Image。 源帧率模式不承诺固定发布频率,慢消费者只保留最新一帧。
默认 image_frame=neo_camera_optical,光学系 X向右/Y向下/Z向前; 改名不会完成相机/IMU 外参变换。图像 header.stamp 为主机发布时间, 原始设备时间保留在 /neo/image/source_header。图像、源 header 与里程计不是原子配对, 未经独立时钟同步与标定不得当作精确融合输入。
时间、坐标与协方差#
默认 neo_world → neo_imu;世界 Z 向上,初始航向不是地理北,速度在 IMU 系。 四元数为 x/y/z/w。修改 frame 名字不会执行安装补偿,不能把 neo_imu 改名 base_link 就当成机器人中心。
header.stamp 使用主机发布时的 ROS 时钟,不把设备开机单调时间冒充 UNIX 时间。 原设备 header 保留在 /neo/source_header;两个 topic 不是原子配对。 精确多传感器融合前需要实现独立时钟同步。实物节点不应使用未运行的模拟 /clock。
设备不提供 covariance。assumed_pose_variance 和 assumed_twist_variance 默认均为 1000000, 填 6×6 对角线,是示例假设而非设备估计质量。它们分别同时用于位置/角度、线/角速度, 量纲分别为 m²/rad²、(m/s)²/(rad/s)²;正式融合前按机器人验证并扩展适配器。
null pose/twist/stamp 跳过,不补零。后台接收队列仅保留最新一条,慢消费者可能丢帧。 断流、序号复位或源时间倒退报错退出,不自动续接;用户显式启动新会话。
参数与验证#
两版共用 origin、image_frame、world_frame、imu_frame、assumed_pose_variance、assumed_twist_variance。 系统禁止全局 pip 安装时,可使用同一 ROS 终端的 PYTHONPATH,不强制破坏系统 Python:
export PYTHONPATH=/absolute/path/neo-sdk/SDK/python:$PYTHONPATH
主机测试覆盖消息映射、空值、队列、源时间和断流处理,尚未完成真实 ROS 构建/运行、 DDS 或机器人融合验收。安装后须核对话题、频率和方向,停止 VIO / 断开 USB 后不能继续发布旧位姿。