参考论文: 论文:《Layered costmaps for context-sensitive navigation》 https://blog.csdn.net/xmy306538517/article/details/72899667