实现矩阵地图与rviz地图重合

一、rviz地图转换矩形地图

此方法矩形地图可能会与rviz地图不重合，通过改变偏移量x_offset，y_offset接近地图

#! /usr/bin/env python
import rospy
from nav_msgs.msg import OccupancyGrid
import numpy as np
import matplotlib.pyplot as plt
class pathPlanning:
    def __init__(self):
        #初始化ROS节点
        rospy.init_node("Astar_globel_path_planning",anonymous=True)
        self.doMap()
        
    def doMap(self):
        '''
            获取数据
            将数据处理成一个矩阵（未知:-1，可通行:0，不可通行:1）
        '''
        #接受数据
        self.OGmap = rospy.wait_for_message("/map",OccupancyGrid,timeout=None)
        #地图的宽度
        self.width = self.OGmap.info.width
        #地图的高度
        self.height = self.OGmap.inf