### 如何在ROS2中使用Python语言安装和运行RTK驱动包 #### 1. 安装依赖项 在开始之前，确保已经安装了必要的依赖项。对于RTK驱动包来说，通常需要GNSS相关的库以及ROS2的核心组件。可以通过以下命令来更新系统的软件包并安装基础依赖： ```bash sudo apt update && sudo apt upgrade -y sudo apt install ros-<distro>-geometry-msgs ros-<distro>-sensor-msgs python3-colcon-common-extensions ``` 其中 `<distro>` 是当前使用的ROS2发行版名称（如 `humble` 或 `foxy`），具体可以替换为实际版本名[^1]。 --- #### 2. 创建工作空间 如果尚未创建ROS2的工作空间，则需先初始化一个新的Catkin工作区。以下是标准流程： ```bash mkdir -p ~/ros2_ws/src cd ~/ros2_ws/ colcon build --symlink-install source install/setup.bash ``` 这一步会构建一个空白的工作空间，并加载环境变量以便后续操作。 --- #### 3. 获取RTK驱动包源码 目前官方并没有提供专门针对RTK的标准化驱动包，但可以根据需求选择合适的开源项目作为起点。例如，可以从GitHub仓库克隆类似的NMEA解析器或GNSS驱动程序代码到本地目录下： ```bash cd ~/ros2_ws/src git clone https://github.com/ros-drivers/nmea_navsat_driver.git ``` 此驱动支持基本的GPS/NMEA数据流处理逻辑，虽然并非专为RTK设计，但仍可作为一个良好的开端[^1]。 --- #### 4. 修改CMakeLists.txt文件 为了仅编译所需的特定包，在根路径下的 CMake 文件加入白名单选项： ```cmake set(CATKIN_WHITELIST_PACKAGES "nmea_navsat_driver") ``` 接着重新执行构建过程以应用更改： ```bash cd ~/ros2_ws/ colcon build --packages-select nmea_navsat_driver source install/setup.bash ``` 通过这种方式能够有效减少不必要的子模块干扰[^1]。 --- #### 5. 编写自定义节点脚本 由于目标是基于 Python 实现 RTK 功能调用，因此建议新增一个独立的 `.py` 脚本来完成任务。下面是一个简单的例子展示如何订阅来自 GPS 设备的主题消息并将它们转换成机器人坐标系中的位姿估计值： ```python import rclpy from rclpy.node import Node from sensor_msgs.msg import NavSatFix, Imu from geometry_msgs.msg import PoseStamped import math class RtkPoseNode(Node): def __init__(self): super().__init__('rtk_pose_node') self.subscription_gps = self.create_subscription( NavSatFix, '/fix', self.gps_callback, 10) self.publisher_ = self.create_publisher(PoseStamped, 'pose', 10) def gps_callback(self, msg:NavSatFix): pose_msg = PoseStamped() # 假设已知初始参考点经纬度 (ref_lat, ref_lon)，这里简单计算平面直角坐标偏移量 delta_x = self.calculate_distance(msg.latitude, msg.longitude, reference_latitude, reference_longitude)[0] delta_y = self.calculate_distance(msg.latitude, msg.longitude, reference_latitude, reference_longitude)[1] pose_msg.pose.position.x = delta_x pose_msg.pose.position.y = delta_y quaternion_orientation = self.euler_to_quaternion(roll=0, pitch=0, yaw=self.heading_from_north(reference_heading)) pose_msg.pose.orientation.w = quaternion_orientation[0] pose_msg.pose.orientation.z = quaternion_orientation[3] self.publisher_.publish(pose_msg) @staticmethod def calculate_distance(lat1, lon1, lat2, lon2): """ 计算两点间距离 """ earth_radius = 6378137.0 # 地球半径单位米 dLat = math.radians(lat2-lat1) dLon = math.radians(lon2-lon1) a = math.sin(dLat / 2)**2 + math.cos(math.radians(lat1)) * \ math.cos(math.radians(lat2)) * math.sin(dLon / 2)**2 c = 2*math.atan2(math.sqrt(a), math.sqrt(1-a)) distance_meters = earth_radius*c bearing_angle = math.degrees(math.atan2(dLon,dLat)) return [distance_meters*math.cos(bearing_angle), distance_meters*math.sin(bearing_angle)] @staticmethod def euler_to_quaternion(roll, pitch, yaw): qx = math.sin(roll/2) * math.cos(pitch/2) * math.cos(yaw/2) - math.cos(roll/2) * math.sin(pitch/2) * math.sin(yaw/2) qy = math.cos(roll/2) * math.sin(pitch/2) * math.cos(yaw/2) + math.sin(roll/2) * math.cos(pitch/2) * math.sin(yaw/2) qz = math.cos(roll/2) * math.cos(pitch/2) * math.sin(yaw/2) - math.sin(roll/2) * math.sin(pitch/2) * math.cos(yaw/2) qw = math.cos(roll/2) * math.cos(pitch/2) * math.cos(yaw/2) + math.sin(roll/2) * math.sin(pitch/2) * math.sin(yaw/2) return [qw,qx,qy,qz] def main(args=None): rclpy.init(args=args) node = RtkPoseNode() try: rclpy.spin(node) except KeyboardInterrupt: pass node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 上述代码片段展示了如何利用接收到的卫星定位信息生成机器人的全局姿态描述符[^2]。 --- #### 6. 启动与验证 最后启动整个系统测试效果： ```bash ros2 launch nmea_navsat_driver example.launch.py device_port:=/dev/ttyUSB0 baud_rate:=9600 frame_id:=gps_link use_rmc:=true ``` 同时激活刚才开发好的 Python 节点服务端口监听状态变化情况： ```bash ros2 run your_package_name rtk_pose_node.py ``` 观察终端输出确认一切正常运作即可[^3]。 ---