### ROS系统中使用Python创建二维地图 在ROS2环境中，通过Python可以利用`nav_msgs`包中的`OccupancyGrid`消息来表示二维地图。下面是一个简单的例子展示如何构建并发布一个静态的二维地图。 ```python import rclpy from rclpy.node import Node from nav_msgs.msg import OccupancyGrid from std_msgs.msg import Header class MapPublisher(Node): def __init__(self): super().__init__('map_publisher') self.publisher_ = self.create_publisher(OccupancyGrid, 'map', 10) timer_period = 2.0 # seconds self.timer = self.create_timer(timer_period, self.publish_map) def publish_map(self): map_msg = OccupancyGrid() header = Header() width = height = 100 # 地图尺寸为100x100单元格 resolution = 0.1 # 单元格大小为0.1米 data = [-1]*width*height # 初始化数据数组,-1代表未知区域; 0为空闲空间；100为障碍物 # 设置一些随机位置作为已知的空间状态 (这里仅作示范用途) for i in range(width//4, width * 3 // 4): for j in range(height//4, height * 3 // 4): if ((i % 7 == 0 and j % 9 != 0) or (j % 7 == 0 and i % 9 != 0)): data[i + j * width] = 100 # 障碍物标记 header.frame_id = "map" header.stamp = self.get_clock().now().to_msg() map_msg.header = header map_msg.info.resolution = resolution map_msg.info.width = width map_msg.info.height = height map_msg.data = data map_msg.info.origin.position.x = -resolution * width / 2.0 map_msg.info.origin.position.y = -resolution * height / 2.0 map_msg.info.origin.orientation.w = 1.0 self.publisher_.publish(map_msg) def main(args=None): rclpy.init(args=args) node = MapPublisher() try: rclpy.spin(node) except KeyboardInterrupt: pass node.destroy_node() rclpy.shutdown() if __name__ == '__main__': main() ``` 此脚本定义了一个名为`MapPublisher`的节点类，该类会定期向`/map`话题发送`OccupancyGrid`类型的消息[^1]。在这个例子中，创建了一张分辨率为0.1m x 0.1m的地图，并设置了部分网格的状态以模拟环境特征。对于实际应用而言，通常是从传感器读数或其他源获取这些信息而不是硬编码它们。 为了使这段代码正常工作，在启动之前需要确保已经安装了必要的依赖项并且配置好了ROS2的工作环境。此外，还需要运行RViz或者其他能够订阅到`/map`主题的应用程序以便查看发布的地图。