[ROS实战] 零硬件成本调试户外导航：Python模拟GPS信号 + RViz加载高德地图实现“云”行走-编程实验室

前言

在机器人户外导航开发中，我们经常面临一个尴尬的局面：人在室内写代码，机器人在吃灰。因为要测试 GPS 融合定位或地图显示功能，往往需要把机器人搬到室外空旷处。

有没有一种方法，能在室内、无硬件（甚至无机器人）的情况下，在 RViz 中模拟出一个 GPS 信号，并且能像玩游戏一样通过键盘（WASD）控制机器人在真实的高德卫星地图上行走？

本文将通过一个 Python 脚本配合rviz_satellite插件，带你实现这套零成本的仿真环境。

准备工作

操作系统：Ubuntu 20.04
ROS 版本：Noetic
所需插件：rviz_satellite

1. 安装核心插件

我们需要一个能让 RViz 加载瓦片地图的插件。

Bash

sudo apt install ros-noetic-rviz-satellite

核心步骤一：编写 GPS + TF 模拟器

RViz 的显示逻辑依赖于TF (坐标变换)，而地图插件依赖于GPS (/fix)。因此，我们的模拟脚本必须同时做两件事：

发布/fix话题：告诉地图插件“我在地球的哪个经纬度”，以便加载对应的瓦片图片。
发布 TF (map->base_link)：告诉 RViz “机器人在地图坐标系下的 (x, y) 坐标”，以便让机器人模型动起来。

在你的工作空间（如~/catkin_ws/src/your_pkg/scripts/）下新建文件gps_simulator.py：

Python

#!/usr/bin/env python3 # -*- coding: utf-8 -*- import rospy from sensor_msgs.msg import NavSatFix import tf import sys, select, termios, tty, threading, math # === 配置区域 === # 初始位置：这里以西安长安大学附近为例 INIT_LAT = 34.373056 INIT_LON = 108.896667 INIT_ALT = 0.0 # 移动步长：每次按键移动 5 米 MOVE_STEP_M = 5.0 # 频率 RATE = 10.0 # 简易经纬度换算系数 (近似值) METERS_PER_LAT = 111000.0 METERS_PER_LON = 111000.0 * math.cos(math.radians(INIT_LAT)) class GpsSimNode: def __init__(self): rospy.init_node('gps_simulator', anonymous=True) # 1. 发布 GPS 话题 (给地图插件用) self.pub = rospy.Publisher('/fix', NavSatFix, queue_size=10) # 2. 广播 TF 变换 (给 RViz 坐标显示用) self.tf_broadcaster = tf.TransformBroadcaster() self.x = 0.0 # 相对原点的东向距离 (米) self.y = 0.0 # 相对原点的北向距离 (米) self.running = True self.lock = threading.Lock() print("=== GPS 模拟器已启动 ===") print(f"初始坐标: Lat {INIT_LAT}, Lon {INIT_LON}") print("控制方式: W(北) A(西) S(南) D(东) Q(退出)") def publish_loop(self): rate = rospy.Rate(RATE) while not rospy.is_shutdown() and self.running: with self.lock: cx, cy = self.x, self.y # 计算当前的经纬度 current_lat = INIT_LAT + (cy / METERS_PER_LAT) current_lon = INIT_LON + (cx / METERS_PER_LON) # A. 发布 GPS msg = NavSatFix() msg.header.stamp = rospy.Time.now() msg.header.frame_id = "base_link" msg.latitude = current_lat msg.longitude = current_lon msg.altitude = INIT_ALT self.pub.publish(msg) # B. 发布 TF (map -> base_link) # 这让 RViz 知道机器人在哪里，从而消除 "Fixed Frame [map] does not exist" 报错 self.tf_broadcaster.sendTransform( (cx, cy, 0.0), tf.transformations.quaternion_from_euler(0, 0, 0), rospy.Time.now(), "base_link", "map" ) rate.sleep() def get_key(self): # 非阻塞键盘读取 tty.setraw(sys.stdin.fileno()) rlist, _, _ = select.select([sys.stdin], [], [], 0.1) key = sys.stdin.read(1) if rlist else '' termios.tcsetattr(sys.stdin, termios.TCSADRAIN, settings) return key def run(self): t = threading.Thread(target=self.publish_loop) t.start() try: while not rospy.is_shutdown(): key = self.get_key() if key: with self.lock: if key == 'w': self.y += MOVE_STEP_M elif key == 's': self.y -= MOVE_STEP_M elif key == 'a': self.x -= MOVE_STEP_M elif key == 'd': self.x += MOVE_STEP_M elif key in ['q', '\x03']: self.running = False break print(f"\r当前偏移: X={self.x:.1f}m, Y={self.y:.1f}m ", end="") finally: self.running = False t.join() if __name__ == '__main__': settings = termios.tcgetattr(sys.stdin) try: GpsSimNode().run() except rospy.ROSInterruptException: pass finally: termios.tcsetattr(sys.stdin, termios.TCSADRAIN, settings)

(别忘了给脚本加权限：chmod +x gps_simulator.py)

核心步骤二：在 RViz 中接入高德地图

国内网络环境下，Google Maps 经常无法加载，而高德地图（AutoNavi）提供了极其稳定的 XYZ 瓦片服务。

启动 ROS：
打开终端运行 roscore。
运行模拟器：
打开新终端运行 python3 gps_simulator.py。
打开 RViz：
打开新终端运行 rviz。
配置 RViz (关键)：
- Global Options -> Fixed Frame: 手动输入map。（注意：因为我们的脚本发布了 map->base_link 的 TF，所以这里必须填 map）。
- Add: 点击左下角 Add，选择AerialMapDisplay。
- AerialMapDisplay 参数设置：
  - Topic: 选择/fix。
  - Map URL: 填入以下高德卫星图链接：
    Plaintext
```
http://webst01.is.autonavi.com/appmaptile?style=6&x={x}&y={y}&z={z}
```
  - Zoom: 设置为18或19。（设置太小如 0-10 可能导致加载不出图片）。
  - Blocks: 设置为4。