（本科生，目前完全没有接触过ros，但是老师布置的项目要求需要用到ros时间也只有一周，没办法系统性学习，求大佬救救孩子）

大概的例子是https://www.mathworks.com/help/nav/ug/offorad-planning-on-digital-elevation-models.html?s_tid=srchtitle_offroad_3  这个链接在matlab中实现了2.5D启发式方法规划路径如何将他在gazebo中仿真显示出来