Article(id=1149420602622116158, tenantId=1146029695717560320, journalId=1146120084050784272, issueId=1149420601376412046, articleNumber=null, orderNo=null, doi=10.19562/j.chinasae.qcgc.2025.04.006, pmid=null, cstr=null, oa=null, hot=null, price=null, onlineType=0, articleFormat=0, articleType=null, articleTypeStr=null, receivedDate=1717257600000, receivedDateStr=2024-06-02, revisedDate=1726243200000, revisedDateStr=2024-09-14, acceptedDate=null, acceptedDateStr=null, onlineDate=1751972826867, onlineDateStr=2025-07-08, pubDate=1745510400000, pubDateStr=2025-04-25, doiRegisterDate=null, doiRegisterDateStr=null, onlineIssueDate=1751972826867, onlineIssueDateStr=2025-07-08, onlineJustAcceptDate=null, onlineJustAcceptDateStr=null, onlineFirstDate=null, onlineFirstDateStr=null, sourceXml=null, magXml=null, createTime=1751972826867, creator=13701087609, updateTime=1751972826867, updator=13701087609, issue=Issue{id=1149420601376412046, tenantId=1146029695717560320, journalId=1146120084050784272, year='2025', volume='47', issue='4', pageStart='587', pageEnd='795', issueExtLink='null', onlineDate='null', pubDate='null', beforeIssueId=null, nextIssueId=null, price=null, status=1, issueComplete=1, articleOrder=1, issueType=-1, specialIssue=null, createTime=1751972826539, creator=13701087609, updateTime=1754389785974, updator=13701087609, preIssue=null, nextIssue=null, ext={EN=IssueExt(id=1159558063947952346, tenantId=1146029695717560320, journalId=1146120084050784272, issueId=1149420601376412046, language=EN, specialIssueTitle=, coverIllustrator=, specialIssueEditor=, specialIssueAbout=), CN=IssueExt(id=1159558063947952347, tenantId=1146029695717560320, journalId=1146120084050784272, issueId=1149420601376412046, language=CN, specialIssueTitle=, coverIllustrator=, specialIssueEditor=, specialIssueAbout=)}, issueFiles=null}, startPage=645, endPage=657, ext={EN=ArticleExt(id=1149420602915717440, articleId=1149420602622116158, tenantId=1146029695717560320, journalId=1146120084050784272, language=EN, title=Trajectory Planning for Autonomous Vehicles Considering Complex Terrains and Obstacle Scales, columnId=1149809888211198868, journalTitle=Automotive Engineering, columnName=Feature Topic:Key Technologies on Intelligent and Connected Vehicles, runingTitle=null, highlight=

Unstructured road often has uneven surface and varying obstacle sizes. Neglecting the uneven terrain and handling obstacles improperly can lead to an imbalance between vehicle safety and travel efficiency. To cope with this challenge,in this paper a trajectory planning method that considers complex terrain and obstacle scales (TOTP) for unstructured road is proposed. Firstly,the trajectory-planning framework for unstructured road is established based on vehicle passability analysis,to determine the optimal travel pattern. Then,an operational risk field is established based on road roughness and obstacle’s size information. In addition,considering both operational risk and travel efficiency,an obstacle avoidance path planning method based on dynamic programming and an obstacle crossing path planning method based on improved A* are proposed. Furthermore,based on vehicle stability analysis,a speed planning method considering terrain constraints is proposed. Finally,real-world experiments are conducted,and the experimental results show that under unstructured road conditions,the trajectory planning method proposed in this paper increases the average vehicle speed by 15.8%,with the average absolute pitch angle and average absolute roll angle reduced by 68.1% and 73.6% respectively. This method can effectively coordinate the safety and efficiency of vehicle operation,demonstrating good generalization and meeting the requirements of real-time performance.

, articleAbstract=

Unstructured road often has uneven surface and varying obstacle sizes. Neglecting the uneven terrain and handling obstacles improperly can lead to an imbalance between vehicle safety and travel efficiency. To cope with this challenge, in this paper a trajectory planning method that considers complex terrain and obstacle scales (TOTP) for unstructured road is proposed. Firstly, the trajectoryplanning framework for unstructured road is established based on vehicle passability analysis, to determine the optimal travel pattern. Then, an operational risk field is established based on road roughness and obstacle's size information. In addition, considering both operational risk and travel efficiency, an obstacle avoidance path planning method based on dynamic programming and an obstacle crossing path planning method based on improved A* are proposed. Furthermore, based on vehicle stability analysis, a speed planning method considering terrain constraints is proposed. Finally, realworld experiments are conducted, and the experimental results show that under unstructured road conditions, the trajectory planning method proposed in this paper increases the average vehicle speed by 15.8%, with the average absolute pitch angle and average absolute roll angle reduced by 68.1% and 73.6% respectively. This method can effectively coordinate the safety and efficiency of vehicle operation, demonstrating good generalization and meeting the requirements of realtime performance.

, correspAuthors=Shida Nie, authorNote=null, correspAuthorsNote=null, copyrightStatement=null, copyrightOwner=null, extLink=null, articleAbsUrl=null, sourceXml=null, magXml=null, pdfUrl=null, pdf=null, pdfFileSize=null, pdfExtLink=null, richHtmlUrl=null, mobilePdfUrl=null, reviewReport=null, pdfFirstPage=null, abstractGraph=null, abstractGraphContent=null, abstractVideo=null, citation=null, cebUrl=null, magXmlContent=null, mapNumber=null, authorCompany=null, fund=null, authors=null, authorsList=Congshuai Guo, Hui Liu, Shida Nie, Yingjie Song, Yujia Xie, Fawang Zhang), CN=ArticleExt(id=1149420620213027413, articleId=1149420602622116158, tenantId=1146029695717560320, journalId=1146120084050784272, language=CN, title=考虑复杂地形和障碍尺度的无人车轨迹规划*, columnId=1149809888341222293, journalTitle=汽车工程, columnName=专题:汽车智能化关键技术, runingTitle=null, highlight=

非结构化道路往往路面起伏不平,障碍物尺度不一,忽视起伏地形及不合理处理障碍物会造成车辆运行安全性和通行效率失衡。为应对上述挑战,本文提出了考虑复杂地形和障碍尺度的轨迹规划方法。首先,基于车辆通过性分析建立了面向非结构化道路的轨迹规划框架,判定最优通行模式。其次,基于路面粗糙程度和障碍物尺度信息建立了运行风险场。另外,综合考虑运行风险和通行效率,提出了基于动态规划的避障路径规划算法和基于改进A*的跨障路径规划算法。进一步的,基于稳定性分析,提出了考虑地形约束的速度规划方法。最后,进行了实车试验。试验结果表明,非结构化道路起伏地形条件下,本文所提的轨迹规划方法平均车速提高15.8%,平均绝对俯仰角和平均绝对侧倾角分别降低68.1%和73.6%,可有效协调车辆运行安全性和通行效率,具有较好的泛化性且符合实时性需求。

, articleAbstract=

非结构化道路往往路面起伏不平,障碍物尺度不一,忽视起伏地形及不合理处理障碍物会造成车辆运行安全性和通行效率失衡。为应对上述挑战,本文提出了考虑复杂地形和障碍尺度的轨迹规划方法。首先,基于车辆通过性分析建立了面向非结构化道路的轨迹规划框架,判定最优通行模式。其次,基于路面粗糙程度和障碍物尺度信息建立了运行风险场。另外,综合考虑运行风险和通行效率,提出了基于动态规划的避障路径规划算法和基于改进A*的跨障路径规划算法。进一步的,基于稳定性分析,提出了考虑地形约束的速度规划方法。最后,进行了实车试验。试验结果表明,非结构化道路起伏地形条件下,本文所提的轨迹规划方法平均车速提高15.8%,平均绝对俯仰角和平均绝对侧倾角分别降低68.1%和73.6%,可有效协调车辆运行安全性和通行效率,具有较好的泛化性且符合实时性需求。

, correspAuthors=聂士达, authorNote=null, correspAuthorsNote=
聂士达,助理教授,博士,E-mail:
, copyrightStatement=null, copyrightOwner=null, extLink=null, articleAbsUrl=null, sourceXml=yBMCOA33QVWVgLVC0zaN+A==, magXml=hmcLnRiOdy0mw9ZeSVmhlA==, pdfUrl=null, pdf=bY+xvMQrTuCvVzfSfCB1nA==, pdfFileSize=null, pdfExtLink=null, richHtmlUrl=null, mobilePdfUrl=null, reviewReport=null, pdfFirstPage=null, abstractGraph=null, abstractGraphContent=null, abstractVideo=null, citation=null, cebUrl=null, magXmlContent=nptiAESP3Utxu2qT//XkMg==, mapNumber=null, authorCompany=null, fund=null, authors=

助理教授,博士

, authorsList=郭丛帅, 刘辉, 聂士达, 宋英杰, 谢雨佳, 张发旺)}, authors=[Author(id=1170299373918368619, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=0, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=null, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299373989671788, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299373918368619, language=EN, stringName=Congshuai Guo, firstName=Congshuai, middleName=null, lastName=Guo, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299374052586349, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299373918368619, language=CN, stringName=郭丛帅, firstName=丛帅, middleName=null, lastName=郭, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=null), Author(id=1170299374249718639, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=1, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=null, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299374367159152, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374249718639, language=EN, stringName=Hui Liu, firstName=Hui, middleName=null, lastName=Liu, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299374476211057, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374249718639, language=CN, stringName=刘辉, firstName=辉, middleName=null, lastName=刘, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=null), Author(id=1170299374530737011, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=2, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=nieshida@bit.edu.cn, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299374606234484, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374530737011, language=EN, stringName=Shida Nie, firstName=Shida, middleName=null, lastName=Nie, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299374660760437, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374530737011, language=CN, stringName=聂士达, firstName=士达, middleName=null, lastName=聂, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=null), Author(id=1170299374711092087, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=3, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=null, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299374761423736, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374711092087, language=EN, stringName=Yingjie Song, firstName=Yingjie, middleName=null, lastName=Song, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299374836921209, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374711092087, language=CN, stringName=宋英杰, firstName=英杰, middleName=null, lastName=宋, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=null), Author(id=1170299374908224379, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=4, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=null, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299374971138941, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374908224379, language=EN, stringName=Yujia Xie, firstName=Yujia, middleName=null, lastName=Xie, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=School of Mechanical Engineering,Beijing Institute of Technology,Beijing 100081, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299375034053502, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299374908224379, language=CN, stringName=谢雨佳, firstName=雨佳, middleName=null, lastName=谢, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=北京理工大学机械与车辆学院,北京 100081, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=[AuthorCompany(id=1170299373725430631, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, xref=null, ext=[AuthorCompanyExt(id=1170299373775762280, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, companyId=1170299373725430631, language=EN, country=null, province=null, city=null, postcode=null, companyName=null, departmentName=null, remark=School of Mechanical Engineering,Beijing Institute of Technology,Beijing 100081), AuthorCompanyExt(id=1170299373796733801, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, companyId=1170299373725430631, language=CN, country=null, province=null, city=null, postcode=null, companyName=null, departmentName=null, remark=北京理工大学机械与车辆学院,北京 100081)])]), Author(id=1170299375084385152, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, orderNo=5, firstName=null, middleName=null, lastName=null, nameCn=null, orcid=null, stid=null, country=null, authorPic=null, dead=0, email=null, emailSecond=null, emailThird=null, correspondingAuthor=0, authorType=1, ext={EN=AuthorExt(id=1170299375155688321, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299375084385152, language=EN, stringName=Fawang Zhang, firstName=Fawang, middleName=null, lastName=Zhang, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null), CN=AuthorExt(id=1170299375210214274, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, authorId=1170299375084385152, language=CN, stringName=张发旺, firstName=发旺, middleName=null, lastName=张, prefix=null, suffix=null, authorComment=null, nameInitials=null, affiliation=null, department=null, xref=null, address=null, bio=null, bioImg=null, bioContent=null, aboutCorrespAuthor=null)}, companyList=null)], keywords=[Keyword(id=1170299375369597827, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, orderNo=1, keyword=unstructured road), Keyword(id=1170299375436706692, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, orderNo=2, keyword=trajectory planning), Keyword(id=1170299375495426949, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, orderNo=3, keyword=path planning), Keyword(id=1170299375549952902, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, orderNo=4, keyword=risk filed), Keyword(id=1170299375596090247, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, orderNo=5, keyword=speed planning), Keyword(id=1170299375650616200, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, orderNo=1, keyword=非结构化道路), Keyword(id=1170299375705142153, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, orderNo=2, keyword=轨迹规划), Keyword(id=1170299375747085194, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, orderNo=3, keyword=路径规划), Keyword(id=1170299375801611147, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, orderNo=4, keyword=风险场), Keyword(id=1170299375856137100, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, orderNo=5, keyword=速度规划)], refs=[Reference(id=1170299380029469639, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[1], rfOrder=0, authorNames=null, journalName=null, refType=null, unstructuredReference=HU J,HU Y,LU C,et al. Integrated path planning for unmanned differential steering vehicles in off-road environment with 3D terrains and obstacles[J]. IEEE Transactions on Intelligent Transportation Systems,2022,23(6): 5562-5572., articleTitle=null, refAbstract=null), Reference(id=1170299380083995592, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[2], rfOrder=1, authorNames=null, journalName=null, refType=null, unstructuredReference=FAN H,ZHU F,LIU C,et al. Baidu apollo EM motion planner[J]. ArXiv,2018,abs/1807.08048., articleTitle=null, refAbstract=null), Reference(id=1170299380184658889, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[3], rfOrder=2, authorNames=null, journalName=null, refType=null, unstructuredReference=SHI Y,HUANG Y,CHEN Y. Trajectory planning of autonomous trucks for collision avoidance with rollover prevention[J]. IEEE Transactions on Intelligent Transportation Systems,2021: 1-10., articleTitle=null, refAbstract=null), Reference(id=1170299380297905098, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[4], rfOrder=3, authorNames=null, journalName=null, refType=null, unstructuredReference=WERLING M,ZIEGLER J,KAMMEL S,et al. Optimal trajectory generation for dynamic street scenarios in a Frenét Frame[C]. Proceedings of the 2010 IEEE International Conference on Robotics and Automation (ICRA). IEEE,2010: 987-993., articleTitle=null, refAbstract=null), Reference(id=1170299380365013963, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[5], rfOrder=4, authorNames=null, journalName=null, refType=null, unstructuredReference=YANG L,QI J,SONG D,et al. Survey of robot 3D path planning algorithms[J]. Journal of Control Science and Engineering,2016,2016: 1-22., articleTitle=null, refAbstract=null), Reference(id=1170299380427928524, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[6], rfOrder=5, authorNames=null, journalName=null, refType=null, unstructuredReference=CLAUSSMANN L,REVILLOUD M,GRUYER D,et al. A review of motion planning for highway autonomous driving[J]. IEEE Transactions on Intelligent Transportation Systems,2020,21(5): 1826-1848., articleTitle=null, refAbstract=null), Reference(id=1170299380499231693, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[7], rfOrder=6, authorNames=null, journalName=null, refType=null, unstructuredReference=PADEN B,ČáP M,YONG S Z,et al. A survey of motion planning and control techniques for self-driving urban vehicles[J]. IEEE Transactions on Intelligent Vehicles,2016,1(1): 33-55., articleTitle=null, refAbstract=null), Reference(id=1170299380574729166, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[8], rfOrder=7, authorNames=null, journalName=null, refType=null, unstructuredReference=吴晓建,廖平伟,雷耀,等. 面向结构化道路的智能驾驶轨迹规划一致性研究[J]. 汽车工程,2024,46(3): 383-395,430., articleTitle=null, refAbstract=null), Reference(id=1170299380667003855, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[8], rfOrder=8, authorNames=null, journalName=null, refType=null, unstructuredReference=WU X J,LIAO P W,LEI Y,et al. Research on consistency of intelligent driving trajectory planning for structured road[J]. Automotive Engineering,2024,46(3): 383-395,430., articleTitle=null, refAbstract=null), Reference(id=1170299380763472848, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[9], rfOrder=9, authorNames=null, journalName=null, refType=null, unstructuredReference=HART P E,NILSSON N J,RAPHAEL B. A formal basis for the heuristic determination of minimum cost paths[J]. IEEE Transactions on Systems Science and Cybernetics,1968,4(2): 100-107., articleTitle=null, refAbstract=null), Reference(id=1170299380830581713, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[10], rfOrder=10, authorNames=null, journalName=null, refType=null, unstructuredReference=SHANG E,DAI B,NIE Y,et al. A guide-line and key-point based A-star path planning algorithm for autonomous land vehicles[C]. Proceedings of the 2020 IEEE 23rd International Conference on Intelligent Transportation Systems (ITSC). IEEE,2020., articleTitle=null, refAbstract=null), Reference(id=1170299380901884882, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[11], rfOrder=11, authorNames=null, journalName=null, refType=null, unstructuredReference=ERKE S,BIN D,YIMING N,et al. An improved A-Star based path planning algorithm for autonomous land vehicles[J]. International Journal of Advanced Robotic Systems,2020,17(5)., articleTitle=null, refAbstract=null), Reference(id=1170299381061268435, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[12], rfOrder=12, authorNames=null, journalName=null, refType=null, unstructuredReference=JIANG J,HAN Z,LI J,et al. Global path planning of UGVs in large-scale off-road environment based on improved A-star algorithm and quadratic programming[C]. Proceedings of the 2023 IEEE Intelligent Vehicles Symposium (IV). IEEE,2023., articleTitle=null, refAbstract=null), Reference(id=1170299381166126036, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[13], rfOrder=13, authorNames=null, journalName=null, refType=null, unstructuredReference=RASTGOFTAR H,ZHANG B,ATKINS E M. A data-driven approach for autonomous motion planning and control in off-road driving scenarios [Z]. Ithaca; Cornell University Library,arXiv.org. 2018., articleTitle=null, refAbstract=null), Reference(id=1170299381287760853, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[14], rfOrder=14, authorNames=null, journalName=null, refType=null, unstructuredReference=TIAN F,ZHOU R,LI Z,et al. Trajectory planning for autonomous mining trucks considering terrain constraints[J]. IEEE Transactions on Intelligent Vehicles,2021,6(4): 772-786., articleTitle=null, refAbstract=null), Reference(id=1170299381371646934, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[15], rfOrder=15, authorNames=null, journalName=null, refType=null, unstructuredReference=CAI X,EVERETT M,FINK J,et al. Risk-aware off-road navigation via a learned speed distribution map[C]. Proceedings of the 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE,2022: 2931-3937., articleTitle=null, refAbstract=null), Reference(id=1170299381430367191, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[16], rfOrder=16, authorNames=null, journalName=null, refType=null, unstructuredReference=田洪清,丁峰,郑讯佳,等. 基于势能场虚拟力的智能网联车辆运动规划[J]. 汽车工程,2021,43(4): 518-526., articleTitle=null, refAbstract=null), Reference(id=1170299381505864664, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[16], rfOrder=17, authorNames=null, journalName=null, refType=null, unstructuredReference=TIAN H Q,DING F,ZHENG X J,et al. Motion planning based on virtual force of potential field for intelligent connected vehicles[J]. Automotive Engineering,2021,43(4): 518-526., articleTitle=null, refAbstract=null), Reference(id=1170299381627499481, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[17], rfOrder=18, authorNames=null, journalName=null, refType=null, unstructuredReference=CHI W,WANG C,WANG J,et al. Risk-DTRRT-based optimal motion planning algorithm for mobile robots[J]. IEEE Transactions on Automation Science and Engineering,2019,16(3): 1271-1288., articleTitle=null, refAbstract=null), Reference(id=1170299381824631770, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[18], rfOrder=19, authorNames=null, journalName=null, refType=null, unstructuredReference=田洪清,王建强,黄荷叶,等. 越野环境下基于势能场模型的智能车概率图路径规划方法[J]. 兵工学报,2021,42(7): 1496-1505., articleTitle=null, refAbstract=null), Reference(id=1170299381937877979, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[18], rfOrder=20, authorNames=null, journalName=null, refType=null, unstructuredReference=TIAN H Q,WANG J Q,HUANG H Y,et al. Probabilistic roadmap method for path planning of intelligent vehicle based on artificial potential field model in off-road environment[J]. Acta Armamentarii,2021,42(7): 1496-1505., articleTitle=null, refAbstract=null), Reference(id=1170299382030152668, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[19], rfOrder=21, authorNames=null, journalName=null, refType=null, unstructuredReference=TANG C,ZHAO Y. Hierarchical path planning based on PPO for UVs on 3D off-road terrain[C]. Proceedings of the 2022 IEEE 4th International Conference on Power,Intelligent Computing and Systems (ICPICS). IEEE,2022: 295-300., articleTitle=null, refAbstract=null), Reference(id=1170299382088872925, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[20], rfOrder=22, authorNames=null, journalName=null, refType=null, unstructuredReference=YANG L,WANG Q,TAN Y,et al. Autonomous vehicle path planning considering dwarf or negative obstacles[C]. Proceedings of the 2019 IEEE Intelligent Vehicles Symposium (IV). IEEE,2019: 1021-1026., articleTitle=null, refAbstract=null), Reference(id=1170299382151787486, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[21], rfOrder=23, authorNames=null, journalName=null, refType=null, unstructuredReference=LUO H,LI M,LIANG G,et al. An obstacle-crossing strategy based on the fast self-reconfiguration for modular sphere robots[C]. Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE,2020: 3296-3303., articleTitle=null, refAbstract=null), Reference(id=1170299382218896351, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[22], rfOrder=24, authorNames=null, journalName=null, refType=null, unstructuredReference=CHEN M,CAO Y,TIAN Y,et al. A passive compliance obstacle-crossing robot for power line inspection and maintenance[J]. IEEE Robotics and Automation Letters,2023,8(5): 2772-2779., articleTitle=null, refAbstract=null), Reference(id=1170299382281810912, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[23], rfOrder=25, authorNames=null, journalName=null, refType=null, unstructuredReference=BERTI M,CORSINI A,DAEHNE A. Comparative analysis of surface roughness algorithms for the identification of active landslides[J]. Geomorphology,2013,182: 1-18., articleTitle=null, refAbstract=null), Reference(id=1170299382348919777, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[24], rfOrder=26, authorNames=null, journalName=null, refType=null, unstructuredReference=余志生. 汽车理论 [M]. 6版. 北京:机械工业出版社,2018., articleTitle=null, refAbstract=null), Reference(id=1170299382441194466, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[24], rfOrder=27, authorNames=null, journalName=null, refType=null, unstructuredReference=YU Z S. Automotive theory [M]. 6th ed. Beijing: China Machine Press,2018., articleTitle=null, refAbstract=null), Reference(id=1170299382512497635, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, doi=null, pmid=null, pmcid=null, year=null, volume=null, issue=null, pageStart=null, pageEnd=null, url=null, language=null, rfNumber=[25], rfOrder=28, authorNames=null, journalName=null, refType=null, unstructuredReference=RAJAMANI R. Vehicle dynamics and control [M]. Springer Science & Business Media,2011., articleTitle=null, refAbstract=null)], funds=[Fund(id=1170299379823948741, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, awardId=52394262, language=CN, fundingSource=*国家自然科学基金重大项目(52394262), fundOrder=null, country=null), Fund(id=1170299379886863302, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, awardId=52472445, language=CN, fundingSource=国家自然科学基金面上项目(52472445), fundOrder=null, country=null)], companyList=[AuthorCompany(id=1170299373725430631, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, xref=null, ext=[AuthorCompanyExt(id=1170299373775762280, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, companyId=1170299373725430631, language=EN, country=null, province=null, city=null, postcode=null, companyName=null, departmentName=null, remark=School of Mechanical Engineering,Beijing Institute of Technology,Beijing 100081), AuthorCompanyExt(id=1170299373796733801, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, companyId=1170299373725430631, language=CN, country=null, province=null, city=null, postcode=null, companyName=null, departmentName=null, remark=北京理工大学机械与车辆学院,北京 100081)])], figs=[ArticleFig(id=1170299376040686477, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=+IuD6WZxOGGh/dDenumXwA==, figureFileBig=0dbQtJPrrLyfS+GW3WxDqw==, tableContent=null), ArticleFig(id=1170299376103601038, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图1, caption=面向非结构化道路的轨迹规划框架, figureFileSmall=+IuD6WZxOGGh/dDenumXwA==, figureFileBig=0dbQtJPrrLyfS+GW3WxDqw==, tableContent=null), ArticleFig(id=1170299376158126991, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=tn9QJS4m0/cL671r71RXLw==, figureFileBig=F5icWHc0l7igHTiNYNeH9g==, tableContent=null), ArticleFig(id=1170299376242013072, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图2, caption=车辆运动学模型, figureFileSmall=tn9QJS4m0/cL671r71RXLw==, figureFileBig=F5icWHc0l7igHTiNYNeH9g==, tableContent=null), ArticleFig(id=1170299376321704849, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=DU2qqkXTqJEaUXhdNthb+g==, figureFileBig=6PGCGKgkrcMhbIi4YynMdw==, tableContent=null), ArticleFig(id=1170299376367842194, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图3, caption=轨迹规划流程图, figureFileSmall=DU2qqkXTqJEaUXhdNthb+g==, figureFileBig=6PGCGKgkrcMhbIi4YynMdw==, tableContent=null), ArticleFig(id=1170299376418173843, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=LzMilq3G+KAogWxnRIpFSA==, figureFileBig=wtveou0F2vRUQ3+yCFfWaw==, tableContent=null), ArticleFig(id=1170299376489477012, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图4, caption=左转预估路径构建, figureFileSmall=LzMilq3G+KAogWxnRIpFSA==, figureFileBig=wtveou0F2vRUQ3+yCFfWaw==, tableContent=null), ArticleFig(id=1170299376552391573, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=+mIj6gfB3g/WScnHV8nAqg==, figureFileBig=EXM3ZPvDrDs1Utxc8EfFjA==, tableContent=null), ArticleFig(id=1170299376611111830, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图5, caption=3×3移动网格, figureFileSmall=+mIj6gfB3g/WScnHV8nAqg==, figureFileBig=EXM3ZPvDrDs1Utxc8EfFjA==, tableContent=null), ArticleFig(id=1170299376661443479, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=VHa8DbtZmwJ1y0kNu+INvw==, figureFileBig=claOq8iiyJf9CKW11hRdog==, tableContent=null), ArticleFig(id=1170299376703386520, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图6, caption=运行风险场, figureFileSmall=VHa8DbtZmwJ1y0kNu+INvw==, figureFileBig=claOq8iiyJf9CKW11hRdog==, tableContent=null), ArticleFig(id=1170299376762106777, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=6N3caegqxwQ9MVsgAu8ugA==, figureFileBig=J6vpVOECbfq2naS3OyA5tw==, tableContent=null), ArticleFig(id=1170299376812438426, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图7, caption=避障路径规划算法流程图, figureFileSmall=6N3caegqxwQ9MVsgAu8ugA==, figureFileBig=J6vpVOECbfq2naS3OyA5tw==, tableContent=null), ArticleFig(id=1170299376858575771, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=LgJl4vkHsgzY7QNlNgMKoQ==, figureFileBig=Dnq1ZUkjXiQ9KWT3Fia+Qg==, tableContent=null), ArticleFig(id=1170299376908907420, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图8, caption=路径单元构建, figureFileSmall=LgJl4vkHsgzY7QNlNgMKoQ==, figureFileBig=Dnq1ZUkjXiQ9KWT3Fia+Qg==, tableContent=null), ArticleFig(id=1170299376967627677, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=f1k633f7P47Pv0bQV31mYA==, figureFileBig=CqyoWad4YxZbKz5zeOwfow==, tableContent=null), ArticleFig(id=1170299377017959326, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图9, caption=跨障路径规划流程图, figureFileSmall=f1k633f7P47Pv0bQV31mYA==, figureFileBig=CqyoWad4YxZbKz5zeOwfow==, tableContent=null), ArticleFig(id=1170299377068290975, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=A4+qhaUHzGgJKOPJfuKJ8w==, figureFileBig=E+eoPFoSFTDb+o1uV6NpaA==, tableContent=null), ArticleFig(id=1170299377135399840, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图10, caption=运动基元扩展子节点, figureFileSmall=A4+qhaUHzGgJKOPJfuKJ8w==, figureFileBig=E+eoPFoSFTDb+o1uV6NpaA==, tableContent=null), ArticleFig(id=1170299377210897313, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=LxD8jqeFG1ERveOqlT3vAw==, figureFileBig=ulMXSvo1YU1m8eM+cxJ3oQ==, tableContent=null), ArticleFig(id=1170299377273811874, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图11, caption=障碍物前扩展的子节点, figureFileSmall=LxD8jqeFG1ERveOqlT3vAw==, figureFileBig=ulMXSvo1YU1m8eM+cxJ3oQ==, tableContent=null), ArticleFig(id=1170299377315754915, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=CGNKyq3E2ds+DJn6qTYAhw==, figureFileBig=aF3pGP/Br/Bb0aPOHv75sg==, tableContent=null), ArticleFig(id=1170299377370280868, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图12, caption=碰撞检测, figureFileSmall=CGNKyq3E2ds+DJn6qTYAhw==, figureFileBig=aF3pGP/Br/Bb0aPOHv75sg==, tableContent=null), ArticleFig(id=1170299377445778341, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=AHDbE5rwOIj8bAACmFrJjg==, figureFileBig=1558NxkOzlPeHFixUKgqLg==, tableContent=null), ArticleFig(id=1170299377508692902, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图13, caption=可通行区域及约束范围, figureFileSmall=AHDbE5rwOIj8bAACmFrJjg==, figureFileBig=1558NxkOzlPeHFixUKgqLg==, tableContent=null), ArticleFig(id=1170299377559024551, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=WOFsxoF3EyPXpbO6+rx45g==, figureFileBig=z2PXgQwn3AhywrFHcTM4jA==, tableContent=null), ArticleFig(id=1170299377634522024, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图14, caption=试验车辆及其传感器布置情况, figureFileSmall=WOFsxoF3EyPXpbO6+rx45g==, figureFileBig=z2PXgQwn3AhywrFHcTM4jA==, tableContent=null), ArticleFig(id=1170299377726796713, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=XMYkVeP4Rb/0o7MXKC04UQ==, figureFileBig=vcfne1aXlBQUBHnbfUIY0g==, tableContent=null), ArticleFig(id=1170299377798099882, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图15, caption=包头试验场地, figureFileSmall=XMYkVeP4Rb/0o7MXKC04UQ==, figureFileBig=vcfne1aXlBQUBHnbfUIY0g==, tableContent=null), ArticleFig(id=1170299377898763179, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=+nH1GqPutQ8dzVszYGSDaQ==, figureFileBig=QxNl4L3I2DV/Sp4Uvs37TA==, tableContent=null), ArticleFig(id=1170299377965872044, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图16, caption=工况1试验场景及结果, figureFileSmall=+nH1GqPutQ8dzVszYGSDaQ==, figureFileBig=QxNl4L3I2DV/Sp4Uvs37TA==, tableContent=null), ArticleFig(id=1170299378028786605, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=hFVdvqfgcnXkDYXsX2bBKw==, figureFileBig=UdCr4Y6uTDD30xZFaFACRw==, tableContent=null), ArticleFig(id=1170299378112672686, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图17, caption=工况2试验场景及结果, figureFileSmall=hFVdvqfgcnXkDYXsX2bBKw==, figureFileBig=UdCr4Y6uTDD30xZFaFACRw==, tableContent=null), ArticleFig(id=1170299378167198639, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=8znQl32G1HbO8qkSUSCTmA==, figureFileBig=tHJCvC+wCOE2MM+9S4VkGw==, tableContent=null), ArticleFig(id=1170299378217530288, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图18, caption=工况3试验场景及结果, figureFileSmall=8znQl32G1HbO8qkSUSCTmA==, figureFileBig=tHJCvC+wCOE2MM+9S4VkGw==, tableContent=null), ArticleFig(id=1170299378276250545, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=TNkBVqBsJr1ndvuXU3x1Jw==, figureFileBig=n6upGQdsQQ2CP5Dia5q9mA==, tableContent=null), ArticleFig(id=1170299378322387890, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=图19, caption=工况4试验场景及结果, figureFileSmall=TNkBVqBsJr1ndvuXU3x1Jw==, figureFileBig=n6upGQdsQQ2CP5Dia5q9mA==, tableContent=null), ArticleFig(id=1170299378393691059, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=

工况

名称

工况特点 试验目的
工况1 包含起伏路面 验证TOTP对复杂地形的处理能力

算法

有效性

泛化能力
工况2 包含起伏路面和不可跨越障碍 验证TOTP对复杂地形和不可跨越障碍物的处理能力
工况3 包含可跨越障碍和不可跨越障碍 验证非结构化道路同时存在可跨越和不可跨越障碍时TOTP的处理能力

决策

合理性

工况4 包含可跨越障碍和起伏路面 验证同时存在起伏道路和可跨越障碍条件下TOTP的处理能力
), ArticleFig(id=1170299378452411316, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表1, caption=

试验工况及目的

, figureFileSmall=null, figureFileBig=null, tableContent=

工况

名称

工况特点 试验目的
工况1 包含起伏路面 验证TOTP对复杂地形的处理能力

算法

有效性

泛化能力
工况2 包含起伏路面和不可跨越障碍 验证TOTP对复杂地形和不可跨越障碍物的处理能力
工况3 包含可跨越障碍和不可跨越障碍 验证非结构化道路同时存在可跨越和不可跨越障碍时TOTP的处理能力

决策

合理性

工况4 包含可跨越障碍和起伏路面 验证同时存在起伏道路和可跨越障碍条件下TOTP的处理能力
), ArticleFig(id=1170299378502742965, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
参数 数值
车辆长度 Lv/m 4.610
车辆宽度 W/m 1.826
车辆高度 H/m 1.763
车辆质量 m/kg 2 285
轴距 L/m 2.69
轮距 B/m 1.581
质心高度 hg/m 0.67
最小离地间隙 h/m 0.283
两侧轮胎内缘距离 b/m 1.36
车辆前轴刚度 k f /(N·m-1 39 600
车辆后轴刚度 k r/(N·m-1 39 600
), ArticleFig(id=1170299378561463222, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表2, caption=

车辆参数

, figureFileSmall=null, figureFileBig=null, tableContent=
参数 数值
车辆长度 Lv/m 4.610
车辆宽度 W/m 1.826
车辆高度 H/m 1.763
车辆质量 m/kg 2 285
轴距 L/m 2.69
轮距 B/m 1.581
质心高度 hg/m 0.67
最小离地间隙 h/m 0.283
两侧轮胎内缘距离 b/m 1.36
车辆前轴刚度 k f /(N·m-1 39 600
车辆后轴刚度 k r/(N·m-1 39 600
), ArticleFig(id=1170299378641154999, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1
EM Planner 0.074 0.096 3.71
TOTP 0.022 0.026 5.21
对比 -70.3% -72.9% 40.4%
), ArticleFig(id=1170299378750206904, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表3, caption=

工况1各项数据对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1
EM Planner 0.074 0.096 3.71
TOTP 0.022 0.026 5.21
对比 -70.3% -72.9% 40.4%
), ArticleFig(id=1170299378855064505, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1
EM Planner 0.047 0.072 5.62
TOTP 0.015 0.019 6.51
对比 -68.1% -73.6% 15.8%
), ArticleFig(id=1170299378955727802, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表4, caption=

工况2各项数据对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1
EM Planner 0.047 0.072 5.62
TOTP 0.015 0.019 6.51
对比 -68.1% -73.6% 15.8%
), ArticleFig(id=1170299379136082875, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad

MV

/( m s - 1

MALA

/( m s - 2

避障 0.006 0.009 5.58 1.65
跨障 0.007 0.009 7.23 0.47
对比 16.6% 0 29.6% -71.5%
), ArticleFig(id=1170299379194803132, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表5, caption=

工况3各项数据对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad

MV

/( m s - 1

MALA

/( m s - 2

避障 0.006 0.009 5.58 1.65
跨障 0.007 0.009 7.23 0.47
对比 16.6% 0 29.6% -71.5%
), ArticleFig(id=1170299379249329085, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 J   l o n   o b j J   l a t   o b j J   l o n   s J
避障 385.44 145.87 120.40 651.71
跨障 245.49 34.92 122.78 403.19
), ArticleFig(id=1170299379308049342, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表6, caption=

工况3避障跨障代价对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 J   l o n   o b j J   l a t   o b j J   l o n   s J
避障 385.44 145.87 120.40 651.71
跨障 245.49 34.92 122.78 403.19
), ArticleFig(id=1170299379354186687, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1 MALA/( m s - 2
避障 0.015 0.012 6.19 1.53
跨障 0.041 0.039 5.79 0.45
对比 173.3% 225.0% -6.4% -70.6%
), ArticleFig(id=1170299379425489856, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表7, caption=

工况4各项数据对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 MAP/rad MAR/rad MV/( m s - 1 MALA/( m s - 2
避障 0.015 0.012 6.19 1.53
跨障 0.041 0.039 5.79 0.45
对比 173.3% 225.0% -6.4% -70.6%
), ArticleFig(id=1170299379488404417, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=
项目 J   l o n   o b j J   l a t   o b j J   l o n   s J
避障 355.46 137.87 128.72 622.05
跨障 407.34 29.92 307.44 744.7
), ArticleFig(id=1170299379555513282, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表8, caption=

工况4避障跨障代价对比

, figureFileSmall=null, figureFileBig=null, tableContent=
项目 J   l o n   o b j J   l a t   o b j J   l o n   s J
避障 355.46 137.87 128.72 622.05
跨障 407.34 29.92 307.44 744.7
), ArticleFig(id=1170299379610039235, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=EN, label=null, caption=null, figureFileSmall=null, figureFileBig=null, tableContent=

跨障规划

平均耗时

避障规划

平均耗时

速度规划

平均耗时

总耗时
20.3 21.57 18.3 60.37
), ArticleFig(id=1170299379714896836, tenantId=1146029695717560320, journalId=1146120084050784272, articleId=1149420602622116158, language=CN, label=表9, caption=

轨迹规划耗时 ms

, figureFileSmall=null, figureFileBig=null, tableContent=

跨障规划

平均耗时

避障规划

平均耗时

速度规划

平均耗时

总耗时
20.3 21.57 18.3 60.37
)], attaches=null, journal=Journal(id=1146119049450201092, delFlag=0, nameCn=汽车工程, nameEn=Automotive Engineering, nameHistory1=null, nameHistory2=null, issn=1000-680X, eissn=, cn=11-2221/U, coden=null, periodic=0, language=CN, oaType=否, ccby=null, superviseOffice=null, ownerOffice=null, pubOffice=null, editorOffice=null, officeType=null, aims=null, clcCode=null, officeProv=null, officeCity=null, officeAddr=null, officeZip=null, officeEmail=null, officePhone=null, editDirector=null, officeDirector=null, officeDirectorPhone=null, officeStaffNum=null, officeEmpNum=null, coverPicUrl=QBBRQev7wkMVPuUPGz0mFw==, journalPrice=null, startedYear=null, abbrevIsoEn=Auto Eng, journalRemark=null, publicationField=null, createdTime=null, updatedTime=1755587219741, createdBy=null, updatedBy=15831073675, firstLetterCn=A, firstLetterEn=A, subjectCode=Engineering, subjectName=工程, subjectCodeEn=Engineering, subjectNameEn=null, picCn=QBBRQev7wkMVPuUPGz0mFw==, picEn=p+MsLQKu3DZkDibBsTBu1Q==, jcr=null, cjcr=null, exts=[JournalExt(id=1164580465202643295, language=CN, name=汽车工程, nameHistory1=null, nameHistory2=null, managedBy=, sponsoredBy=, publishedBy=, editorOffice=, officeProv=null, officeCity=null, officeAddr=, officeZip=, editDirector=null, officeDirector=null, officePhone=null, coverPicUrl=null, journalRemark=, submitArticleUrl=null, websiteUrl=https://www.qichegongcheng.com/CN/1000-680X/home.shtml, createdTime=1755587219763, updatedTime=1755587219763, createdBy=15831073675, updatedBy=15831073675, submissionGuidelinesUrl=https://www.qichegongcheng.com/CN/column/column6.shtml, submissionAuthorUrl=https://journal03.magtechjournal.com/journalx_qcgc/authorLogOn.action, submissionEditorUrl=https://journal03.magtechjournal.com/journalx_qcgc/editorLogOn.action, submissionReviewUrl=https://journal03.magtechjournal.com/journalx_qcgc/expertLogOn.action, submissionCeEditorUrl=https://journal03.magtechjournal.com/journalx_qcgc/editorInChiefLogOn.action, submissionAeEditorUrl=, option={"copyright":""}), JournalExt(id=1164580465248780640, language=EN, name=Automotive Engineering, nameHistory1=null, nameHistory2=null, managedBy=, sponsoredBy=, publishedBy=, editorOffice=, officeProv=null, officeCity=null, officeAddr=, officeZip=, editDirector=null, officeDirector=null, officePhone=null, coverPicUrl=null, journalRemark=, submitArticleUrl=null, websiteUrl=https://www.qichegongcheng.com/EN/1000-680X/home.shtml, createdTime=1755587219774, updatedTime=1755587219774, createdBy=15831073675, updatedBy=15831073675, submissionGuidelinesUrl=https://www.qichegongcheng.com/EN/column/column6.shtml, submissionAuthorUrl=https://journal03.magtechjournal.com/journalx_qcgc/authorLogOn.action, submissionEditorUrl=https://journal03.magtechjournal.com/journalx_qcgc/editorLogOn.action, submissionReviewUrl=https://journal03.magtechjournal.com/journalx_qcgc/expertLogOn.action, submissionCeEditorUrl=https://journal03.magtechjournal.com/journalx_qcgc/editorInChiefLogOn.action, submissionAeEditorUrl=, option={"copyright":""})], databaseList=null, tenantJournalId=1146120084050784272, websiteList=[Website(id=1148243202387206565, webName=null, webTitle=null, webDomain=null, webCopyrigh=null, webIpcNo=null, seoTitle=null, seoKeywords=null, seoDescription=null, tenantJournalId=null, journalId=1146120084050784272, journalNameCn=null, journalNameEn=null, grayFlag=null, tenantId=1146029695717560320, platformId=null, journalGroupId=null, journalGroupNameCn=null, journalGroupNameEn=null, type=1, domain=https://castjournals.cast.org.cn/joweb/qcygc/CN, language=CN, createTime=1751692112776, createBy=18614031015, updateTime=1753500958911, updateBy=18614031015, name=《汽车工程》中文站点, tplId=1146099689490845704, title=汽车工程, delFlag=0, indexPage=/home, props=[WebsiteProps(id=1148622315115540535, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1148243202387206565, code=articleTextType, value=kx, createTime=1751782500294, updateTime=1751782500294, creator=18614031015, updator=18614031015), WebsiteProps(id=1148622315094569012, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1148243202387206565, code=banner, value=null, createTime=1751782500289, updateTime=1751782500289, creator=18614031015, updator=18614031015), WebsiteProps(id=1148622315081986099, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1148243202387206565, code=logo, value=https://castjournals.cast.org.cn/joweb/kjdb/CN/file/pic?fileId=+W0ZN6/p6N8AvZxnX71krg==, createTime=1751782500286, updateTime=1751782500286, creator=18614031015, updator=18614031015), WebsiteProps(id=1148622315107151926, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1148243202387206565, code=picServerUrl, value=https://castjournals.cast.org.cn/joweb/kjdb/CN/file/pic, createTime=1751782500292, updateTime=1751782500292, creator=18614031015, updator=18614031015), WebsiteProps(id=1148622315102957621, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1148243202387206565, code=staticResourcePath, value=https://castjournals.cast.org.cn/joweb/cast_kjdb_cn_619/, createTime=1751782500291, updateTime=1751782500291, creator=18614031015, updator=18614031015)]), Website(id=1155829970321686531, webName=null, webTitle=null, webDomain=null, webCopyrigh=null, webIpcNo=null, seoTitle=null, seoKeywords=null, seoDescription=null, tenantJournalId=null, journalId=1146120084050784272, journalNameCn=null, journalNameEn=null, grayFlag=null, tenantId=1146029695717560320, platformId=null, journalGroupId=null, journalGroupNameCn=null, journalGroupNameEn=null, type=1, domain=https://castjournals.cast.org.cn/joweb/qcygc/EN, language=EN, createTime=1753500939211, createBy=18614031015, updateTime=1753500939211, updateBy=18614031015, name=《汽车工程》英文站点, tplId=1146101810881728533, title=Automotive Engineering, delFlag=0, indexPage=/home, props=[WebsiteProps(id=1155830904879702095, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1155829970321686531, code=articleTextType, value=kx, createTime=1753501162023, updateTime=1753501162023, creator=18614031015, updator=18614031015), WebsiteProps(id=1155830904858730572, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1155829970321686531, code=banner, value=null, createTime=1753501162018, updateTime=1753501162018, creator=18614031015, updator=18614031015), WebsiteProps(id=1155830904837759051, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1155829970321686531, code=logo, value=https://castjournals.cast.org.cn/joweb/kjdb/CN/file/pic?fileId=+W0ZN6/p6N8AvZxnX71krg==, createTime=1753501162013, updateTime=1753501162013, creator=18614031015, updator=18614031015), WebsiteProps(id=1155830904875507790, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1155829970321686531, code=picServerUrl, value=https://castjournals.cast.org.cn/joweb/kjdb/CN/file/pic, createTime=1753501162022, updateTime=1753501162022, creator=18614031015, updator=18614031015), WebsiteProps(id=1155830904867119181, tenantId=1146029695717560320, journalId=null, journalGroupId=null, siteId=1155829970321686531, code=staticResourcePath, value=https://castjournals.cast.org.cn/joweb/cast_kjdb_cn_619/, createTime=1753501162020, updateTime=1753501162020, creator=18614031015, updator=18614031015)])], journalTitle=汽车工程, weixinUrl=null, journalUrl=null, iacademicId=null, status=0, seqNo=null, journalTitleEn=Automotive Engineering, journalPhotoCn=QBBRQev7wkMVPuUPGz0mFw==, journalPhotoEn=p+MsLQKu3DZkDibBsTBu1Q==, journalFirstLetter=A, journalRecommend=null, journalNew=null, journalCollection=null, jcrJf=null, cjcrJf=null, jcrJfStr=null, cjcrJfStr=null, submissionFirstDecision=null, sciSubjectClassification=null, casSubjectClassification=null, citeScore=null, totalCitationFrequency=null, icpCode=null, psCode=null, advertisingLicenseCode=null, copyrightInformation=null, country=null, option=, provinceCode=null, provinceName=null, collectFlag=false), detailUrlCn=https://castjournals.cast.org.cn/joweb/qcygc/CN/10.19562/j.chinasae.qcgc.2025.04.006, detailUrlEn=https://castjournals.cast.org.cn/joweb/qcygc/EN/10.19562/j.chinasae.qcgc.2025.04.006, pdfUrlCn=https://castjournals.cast.org.cn/joweb/qcygc/CN/PDF/10.19562/j.chinasae.qcgc.2025.04.006, pdfUrlEn=https://castjournals.cast.org.cn/joweb/qcygc/EN/PDF/10.19562/j.chinasae.qcgc.2025.04.006, aliStartDate=null, aliEndDate=null, collectionFlag=false, citedCount=null, citedUrl=null, reference=null)
收藏切换
考虑复杂地形和障碍尺度的无人车轨迹规划*
收藏切换
PDF下载
郭丛帅 , 刘辉 , 聂士达 , 宋英杰 , 谢雨佳 , 张发旺
汽车工程 | 专题:汽车智能化关键技术 2025,47(4): 645-657
收起
收藏切换
汽车工程 | 专题:汽车智能化关键技术 2025, 47(4): 645-657
考虑复杂地形和障碍尺度的无人车轨迹规划*
全屏
郭丛帅, 刘辉, 聂士达 , 宋英杰, 谢雨佳, 张发旺
作者信息
  • 北京理工大学机械与车辆学院,北京 100081

通讯作者:

聂士达,助理教授,博士,E-mail:
Trajectory Planning for Autonomous Vehicles Considering Complex Terrains and Obstacle Scales
Congshuai Guo, Hui Liu, Shida Nie , Yingjie Song, Yujia Xie, Fawang Zhang
Affiliations
  • School of Mechanical Engineering,Beijing Institute of Technology,Beijing 100081
出版时间: 2025-04-25 doi: 10.19562/j.chinasae.qcgc.2025.04.006
文章导航
收藏切换

非结构化道路往往路面起伏不平,障碍物尺度不一,忽视起伏地形及不合理处理障碍物会造成车辆运行安全性和通行效率失衡。为应对上述挑战,本文提出了考虑复杂地形和障碍尺度的轨迹规划方法。首先,基于车辆通过性分析建立了面向非结构化道路的轨迹规划框架,判定最优通行模式。其次,基于路面粗糙程度和障碍物尺度信息建立了运行风险场。另外,综合考虑运行风险和通行效率,提出了基于动态规划的避障路径规划算法和基于改进A*的跨障路径规划算法。进一步的,基于稳定性分析,提出了考虑地形约束的速度规划方法。最后,进行了实车试验。试验结果表明,非结构化道路起伏地形条件下,本文所提的轨迹规划方法平均车速提高15.8%,平均绝对俯仰角和平均绝对侧倾角分别降低68.1%和73.6%,可有效协调车辆运行安全性和通行效率,具有较好的泛化性且符合实时性需求。

非结构化道路  /  轨迹规划  /  路径规划  /  风险场  /  速度规划

Unstructured road often has uneven surface and varying obstacle sizes. Neglecting the uneven terrain and handling obstacles improperly can lead to an imbalance between vehicle safety and travel efficiency. To cope with this challenge, in this paper a trajectory planning method that considers complex terrain and obstacle scales (TOTP) for unstructured road is proposed. Firstly, the trajectoryplanning framework for unstructured road is established based on vehicle passability analysis, to determine the optimal travel pattern. Then, an operational risk field is established based on road roughness and obstacle's size information. In addition, considering both operational risk and travel efficiency, an obstacle avoidance path planning method based on dynamic programming and an obstacle crossing path planning method based on improved A* are proposed. Furthermore, based on vehicle stability analysis, a speed planning method considering terrain constraints is proposed. Finally, realworld experiments are conducted, and the experimental results show that under unstructured road conditions, the trajectory planning method proposed in this paper increases the average vehicle speed by 15.8%, with the average absolute pitch angle and average absolute roll angle reduced by 68.1% and 73.6% respectively. This method can effectively coordinate the safety and efficiency of vehicle operation, demonstrating good generalization and meeting the requirements of realtime performance.

unstructured road  /  trajectory planning  /  path planning  /  risk filed  /  speed planning
郭丛帅, 刘辉, 聂士达, 宋英杰, 谢雨佳, 张发旺. 考虑复杂地形和障碍尺度的无人车轨迹规划*. 汽车工程, 2025 , 47 (4) : 645 -657 . DOI: 10.19562/j.chinasae.qcgc.2025.04.006
Congshuai Guo, Hui Liu, Shida Nie, Yingjie Song, Yujia Xie, Fawang Zhang. Trajectory Planning for Autonomous Vehicles Considering Complex Terrains and Obstacle Scales[J]. Automotive Engineering, 2025 , 47 (4) : 645 -657 . DOI: 10.19562/j.chinasae.qcgc.2025.04.006
轨迹规划是无人驾驶关键技术之一。传统轨迹规划技术主要聚焦在结构化道路,结构化道路路面平坦,坡度变化小且障碍物类型单一。然而,非结构化道路区别于结构化道路[1]。一方面,地形复杂,不考虑复杂地形信息,不能保证车辆在三维地形下的安全运行。另一方面,障碍尺度不一,如果路径规划中对所有障碍物统一采用绕行的方式会导致在多障碍物的场景下车辆频繁转向,降低车辆行驶安全性和通行效率。因此,综合考虑复杂地形和障碍尺度进行轨迹规划,可充分发挥越野车辆高通过性的优势,协调车辆运行安全性和通行效率,具有非常重大的意义。
近年来,轨迹规划算法已成为无人驾驶车辆领域的研究热点之一。解耦式轨迹规划通过将路径-速度解耦(如百度EM Planner)[2-3]或是横纵向解耦[4],得益于其高效性解耦式轨迹规划应用广泛。根据算法原理的差异,可将轨迹规划方法分为图搜索法、采样法、曲线插值法、数值优化法、势场法和智能算法[5-8]
A*算法[9]加入了启发式函数,搜索速度快,但是路径不连续,搜索效率受启发式函数影响,所以研究人员提出了多种改进A*算法。Shang等[10]提出了一种基于引导线的A*算法和一种新的基于关键点的算法,该算法相对于传统算法能够更早地引导规划路径避开障碍物。Erke等[11]提出了一种可变步长的A*路径规划算法,可减少计算时间。Jiang等[12]建立了包含不可达区域和越野地形不确定性信息的栅格地图,提出了一种基于改进A*算法和二次规划的双层全局路径规划方法,可降低计算成本并提高通行效率。动态规划(dynamic programming,DP)可处理多阶段决策问题,并得到全局最优解。Rastgoftar等[13]基于地理信息和云端气象信息数据,提出了基于DP的越野环境全局路径规划算法,所规划路径更具通过性和安全性。百度Fan等[2]提出了基于DP的运动规划算法,该算法具有较高的实用性和可扩展性。然而,单一算法在处理复杂地形及多尺度障碍对于车辆通行的影响时效果较差,尤其是通行模式较为单一,对于障碍均采取避让策略,难以适应非结构化道路的特点,实现非结构化道路最优通行路径的决策与规划。
针对复杂地形,Tian等[14]针对露天矿的崎岖地形条件下矿车运输,提出了考虑地形约束和发动机动力限制的轨迹规划方法。然而,该方法并未考虑起伏地形对于车辆运行特性的影响。为表征机器人穿越越野地形的能力(即速度),Cai等[15]提出了一种完全基于机器人速度的可通过性的表示方法,该方法可以从数据中学习,提供可解释性和直观的调整,然而其对数据依赖性强烈。势场法能有效结合地形和障碍信息[16],Chi等[17]结合人工势场法和双向快速搜索随机树(rapidly exploring random tree,RRT)算法提出了一种基于风险的双树RRT算法。针对越野道路,田洪清等[18]采用人工势场法对越野环境建模量化车辆通行风险,提出了基于势能场模型的概率图算法。Tang等[19]综合考虑地形和障碍物的影响,提出了适应障碍物大小的综合势场,结合最近邻策略优化(proximal policy optimization,PPO)提出了分层路径规划方法,该方法提高了无人车辆在起伏地形运行的安全性和稳定性。以上算法虽然可以提高复杂地形条件下车辆运行安全性,但并不能处理多尺度障碍物跨越的问题。
障碍物一般均被认为不可跨越,然而,由于非结构化道路障碍尺度不一的特点,相较于单一避障,跨障路径会带来更高的通行效率。Yang等[20]提出了一种考虑矮障碍物或负障碍物的双层碰撞检查方法,该方法提高了可移动性和稳定性,然而,其不能处理复杂地形。Luo等[21]提出了针对新型模块化机器人的跨障策略,通过自重构实现跨障。Chen等[22]设计了一种新型电线检查维护机器人,采用被动顺应性跨障原理,可快速穿越障碍物。然而,区别于以上研究对象和应用场景,阿克曼转向车辆并不能实现自身结构变化,且非结构化道路地形和障碍复杂多变。
综上所述,为协调非结构化道路复杂地形和多尺度障碍条件下车辆运行安全性和通行效率,本文提出了考虑复杂地形和障碍尺度的轨迹规划方法 (TOTP)。本文贡献主要包括以下几个方面。
(1) 基于车辆通过性分析建立了面向非结构化道路的轨迹规划框架,如图1所示。
(2) 综合考虑运行风险和通行效率,分别提出了基于动态规划的避障路径规划算法和基于改进A*的跨障路径规划算法。另外,基于稳定性分析,提出了考虑地形约束的速度规划方法。
(3) 通过实车试验证明了非结构化道路条件下本文所提算法的有效性。
图2所示, L为车辆轴距,P为车辆后轴中心位置, P p r o j为车辆后轴中心在参考轨迹上的投影点, θ p为点 P p r o j处参考轨迹的切线方向与X轴的夹角, δ为车轮转角, θ c为笛卡尔坐标系下车辆航向角,定义车辆航向角与参考线切线的角度偏差为 θ F,可表示为
θ F = θ c - θ p
参考轨迹上点 P p r o j处的曲率 κ r可以表示为
κ r = d θ P / d s
式中: s为参考线弧长; l为车辆后轴中心到参考轨迹的横向偏差。 s ˙ l ˙可分别表示为
s ˙ = v c o s   θ F / 1 - κ r l
l ˙ = v s i n   θ F
联立式(4)得,Frenet坐标系基于时间的车辆运动学方程为
l ˙ θ ˙ F δ ˙ = s i n   θ F t a n   δ L 0 v - 0 1 0 θ ˙ p + 0 0 1 δ ˙
为便于做路径规划,将式(5)转为基于参考线弧长s的表达式,可得:
l ' = 1 - κ r l t a n   θ F θ F ' = t a n   δ 1 - κ r l L c o s   θ F - θ ˙ P δ ' = δ ˙ 1 - κ r l / v c o s   θ F
车辆的通过性几何参数包括最小离地间隙、车辆两侧轮胎内缘距离、纵向通过角、接近角、离去角[23]。影响车辆能否跨越障碍物的主要参数是最小离地间隙h和两侧轮胎内缘距离b。定义车辆能否跨越障碍物的条件为
b > W o b s F + ζ 1 h > h o b s + ζ 2
式中: W o b s F为障碍物在Frent坐标系下的投影宽度; h o b s为障碍的高度; ζ 1为宽度松弛因子,取 ζ 1 = 0.2 b ζ 2为高度松弛因子,取 ζ 2 = 0.1 h
本文中避障/跨障决策主要包含两部分:第一部分目的是对预估避障路径和跨障路径的代价进行对比,判断是否有必要生成跨障路径;第二部分目的是对生成的避障轨迹和跨障轨迹进行综合决策,选取最优的轨迹输出。本文轨迹规划流程如图3所示。
本文基于车辆运动基元构建预估路径,建立代价函数对左转预估路径、右转预估路径和跨越路径进行评价来决定是否进行跨越规划。运动基元是由车辆运动学模型生成的路径,基元终点确定条件为:车辆在Frenet坐标系下s值与障碍物的s值相等,且车辆轮廓刚好不与障碍物发生接触,以左转预估路径构建为例,如图4所示。
图4中, l为自车在Frenet坐标系下的横向偏移, θ t l为左转工况下基元终点航向角度与参考线切线的角度差值, l t l为左转工况下基元终点的横向偏移值。
代价函数由距离改变代价和航向改变代价两者构成,左转的代价为
J t l = ω 1 θ F - θ t l + ω 2 l - l t l
式中: ω 1为距离代价权重; ω 2为航向改变代价权重,取 ω 1 = 0.3 ω 2 = 0.7
右转的代价为
J t r = ω 1 θ F - θ t r + ω 2 l - l t r
式中: θ t r为右转工况下基元终点航向角度与参考线切线的角度差值; l t r为右转工况下基元终点的横向偏移值。
跨越的代价为
J a c r o s s = ω 1 θ F - θ a + ω 2 l - l a
式中: θ a为跨越工况下基元终点航向角度与参考线切线的角度差值; l a为跨越工况下基元终点的横向偏移值。
该部分主要是根据预估的避障和跨障路径判断接下来是否有必要生成跨障轨迹。在满足预估跨障路径代价小于预估避障路径代价,或是预估跨障路径代价与预估避障路径代价很接近的条件,都应生成跨障轨迹。则,若满足条件 J a c r o s s - m i n   J t l , J t r < Δ     J a c r o s s < m i n   J t l , J t r Δ为定值,则考虑跨越障碍物,同时进行跨越规划和避障规划;反之,不考虑跨越障碍物,轨迹规划系统只进行避障轨迹规划。
为判定车辆通行模式,选取最优的车辆运行轨迹,本文通过3方面进行评定,包括:纵向目标代价、横向安全性代价和地形安全性代价。纵向目标代价主要衡量车辆的通行效率,轨迹点的速度越接近目标速度,轨迹平均速度越高,纵向目标代价就越小。纵向目标代价定义如下:
J l o n o b j = ω v t = 0 T t 2 v r e f - s ˙ ( t ) + ω s 1 1 + s
式中: v r e f为轨迹的目标速度; s为轨迹的纵向长度;T为轨迹的时间长度; ω v为纵向速度代价; ω s为纵向距离代价。
横向安全代价主要衡量车辆的横向安全性和稳定性,其定义如下:
J l a t = t = 0 T a l a t 2 a l a t
式中 a l a t = ( s ˙ ( t ) ) 2 κ
地形代价是轨迹点纵向速度和路面粗糙度的函数,主要考虑地形对于车辆运行安全性和稳定性的影响,其定义如下:
J l o n s = t = 0 T e f ( R r o u g h , s ˙ ( t ) )
式中 f   ( R r o u g h , s ˙ ) = ω s 1 R r o u g h + ω s 2 s ˙ ω s 1为地形代价, ω s 2为速度代价, R r o u g h为路面粗糙度。
本文通过高程均方差算法(RMSH)[23]计算路面粗糙度,并以此来表征地形起伏程度。本文使用的模型为存储高程信息的2.5D栅格地图,选择3×3的占据栅格作为目标区域,如图5所示。
路面粗糙度 R r o u g h可表示为
R r o u g h = 1 n 2 i = 1 n ( z i - i = 1 n z i n ) 2
式中: z i为第i个数据点的高程值;n为数据点的数量。
因此,轨迹的总代价可表示为
J = ω o b j J l o n o b j + ω l a t J l a t + ω s J l o n s
式中 ω o b j ω l a t ω s分别表示纵向目标代价权重、横向安全代价权重和地形代价权重。
为引导车辆避开不可通行障碍,本文提出障碍风险场量化障碍物对于车辆运行的威胁,如图6(a)所示。非结构化道路存在正负障碍,两者的区别在于负障碍的高度并不会影响车辆的通过性,其长度和宽度是影响车辆通过性的关键参数。从规划的角度,正负障碍的路径规划无本质差别,所以本文只以正障碍物作为典型。定义障碍风险函数为
U o b s ( d o i ) = e x p - τ d o i 2 / d 0 2 , d o i d 0 0 ,                              d o i > d 0
式中: τ为风险场调整因子; d o i为车辆与第i个障碍物的欧氏距离,认为该参数可以从感知层获取; d 0为风险场辐射的半径,通过障碍物尺寸和安全膨胀距离确定。
为在路径规划中使车辆避开障碍物的同时,尽量避免穿越粗糙度过大的路面,借鉴风险场的思想表征起伏地形对于车辆运行的影响。当路面粗糙度超过预设值时,则以地形风险场量化其对于车辆运行的影响,以引导车辆避开这些区域,如图6(b)所示。值得注意的是,与不可通行障碍物不同,在特定情况下车辆可能须穿越这些地形。因此,当车辆与路面风险场中心距离小于一定范围时,将风险值设定为固定值而非无限大,以保证车辆局部路径有解。因此,定义地形风险场为
U R ( d t i ) = e x p - τ d 1 2 / d 2 2 ,   d t i < d 1 e x p - τ d 1 2 / d 2 2 ,   d 1 d t i d 2 0 ,                           d t i > d 2
式中: d t i为车辆与第i个起伏地形中心的欧氏距离; d 1为起伏地形半径,认为该参数可以从感知层获取; d 2为风险场辐射半径。
避障路径规划旨在引导车辆安全、高效地绕行静态障碍物,同时尽量选择路面粗糙度较小的地形行驶。针对此目标,以运行风险场综合量化复杂地形和障碍下车辆运行风险,结合动态规划算法求解避障路径,具体规划流程如图7所示。
动态规划过程以等纵向间隔距离采样将路径划分为若干段。为保证采样点间曲线平滑,且更合理计算路径代价,本文采用五次多项式曲线作为基本单元来构建路径,如图8所示。
Frenet坐标系下,每段路径可表示为
l = f i ( s ) = a 0 i + a 1 i s + a 2 i s 2 + a 3 i s 3 + a 4 i s 4 + a 5 i s 5
式中 s p i s s p i + 1
路径规划起点状态应与车辆初始状态保持一致,设置其边界条件为
f ( s 0 ) = l 0 ; f ' ( s 0 ) = t a n   θ F ; f " ( s 0 ) = 0
另外,对于任意路径点 P i,应保证曲线连续平滑。因此,令:
f ( s i ) = l i ; f ' ( s i ) = 0 ; f " ( s i ) = 0
为保证车辆在安全无碰撞的条件下,运行平稳且尽可能靠近参考路径,本文主要考虑车辆运行风险、路径平滑性和横向偏移程度。
车辆运行过程中,希望其不与障碍物发生接触,且减少在起伏道路运行,以此保证车辆安全稳定运行。因此,安全代价 J   a v   s f可定义如下:
J a v s f = i = 1 n o i = 1 O I U o b s ( d o i i ) + t i = 1 T I U R ( d t i i )
式中: O I T I分别表示障碍物和起伏地形的总数; d o i   i d t i   i表示第i个采样点车辆与第oi个障碍物和第ti个起伏地形的距离。
路径平滑性代价主要是为了保证路径满足车辆运动学要求,可以通过最小化横向偏移的1阶和2阶导数来实现,定义平滑代价 J   a v   s m o如下:
J a v s m o = ω d l i = 1 n ( l ' ( s i ) ) 2 + ω d d l i = 1 n ( l ( s i ) ) 2
式中 ω d l ω d d l为权重系数。
横向偏移代价主要是为防止盲目搜索,使车辆偏离参考线,通过最小横向偏移来实现,定义偏移代价 J   a v   r如下:
J a v r = i = 1 n ( f ( s i ) ) 2
综上,避障路径规划代价函数可定义为
J a v = ω a v a t t J a v s f + ω a v s m o J a v s m o + ω a v r J a v r
式中 ω a v a t t ω a v s m o ω a v r分别表示安全性、平滑性和横向偏移代价权重。
对于任意障碍物统一采取避让策略,会降低车辆通行效率。跨障路径规划旨在避免车辆盲目绕行,降低转向频率,提高车辆的通行效率和安全性。本文应用分离轴定理进行碰撞检测,确保车辆与障碍物之间无碰撞,提出基于改进A*算法的跨障路径规划,具体规划流程如图9所示。
经典A*算法存在一定局限性,即生成的路径具有固定的角度,路径不够平滑,且往往无法规划出局部最短路径。因此,本文采用车辆运动基元作为A*算法的节点扩展方式,给定运动基元的长度和车辆最大转向曲率,基元之间的曲率变化限制则可以保证生成路径符合车辆运动学约束。这种节点扩展方式充分考虑了车辆的非完整约束,从而保证了路径的可行性。本文只考虑车辆前进运动,运动基元扩展如图10所示。
累计真实代价值 g ( N )由从起点到当前点的各条边的代价值累加得到,其设计体现了该路径规划算法的最优准则。为使车辆的行驶范围限制在参考线左右一定范围内,设计横向偏离代价,横向偏移代价可以通过最小化横向偏移来完成,将横向偏移 J   a c   r定义为
J a c r = j = 1 N ( f ( s j ) ) 2
式中 s j表示第j个扩展节点的纵向位移。
为保证轨迹的平滑性,在代价函数中加入路径曲率 κ切换的代价,平滑代价 J   a c   s m o定义为
J a c s m o = j = 1 N Δ κ
式中 κ表示两个运动基元之间的曲率变化值, κ = κ j + 1 - κ j
由于跨越规划要求车辆从可通行障碍物正上方行驶通过,因此,只考虑地形风险和不可通行障碍风险,使车辆尽量选择平缓区域通过,避开不可通行障碍物,定义安全代价 J   a c   s f
J a c s f = j = 1 N o j = 1 O J U o b s ( d o j j ) + t i = 1 T I U R ( d t i j )
式中: O J表示不可通行障碍的总数; d o j   j d t i   j分别表示第j个扩展节点,车辆与第oj个障碍物和第ti个起伏地形的距离。
综上,累计真实代价 g ( N )可表示为
g ( N ) = ω a c a t t J a c s f + ω a c s m o J a v s m o + ω a c r J a c r
式中 ω a c a t t ω a c s m o ω a c r分别表示安全性、平滑性和横向偏移代价权重。
启发项设计:启发项 h ( N )影响了算法收敛速度,其意义在于引导搜索方向和减少扩展节点。本文采用Frenet坐标系下的曼哈顿距离设计启发项,使扩展节点在横向和纵向上同时靠近目标点,从而有效引导车辆跨越障碍物和前进。
对于规划起点和被跨越障碍物之间扩展的子节点,如图11中的 P 1,其主要作用是引导车辆精准跨越障碍物。而对于障碍物和目标点之间扩展的子节点,如图11中的 P 2,其主要用于引导车辆前进至目标点,因此启发项定义为
h ( N ) = s N - s o b s + l N - l o b s , s N s o b s s N - s G + l N - l G ,         s N > s o b s
非结构化环境路面有明显的起伏变化,车辆所在平面与障碍物平面往往不同,因此单独根据底盘离地高度大于障碍物高度的条件不能够保证跨越障碍物时车体不与障碍物发生碰撞,如图12所示。
因此,在改进A*算法扩展子节点时,需要对车体边界框和障碍物边界框进行碰撞检测,确保车辆在跨越障碍物时不与障碍物发生碰撞。若检测到车体与障碍物发生碰撞,则将该节点的真实累计代价 g ( N )设置为无穷大。本文基于分离轴定理进行碰撞检测。以障碍物位置和尺寸信息作为障碍物边界框绘制基准,以车辆尺寸、位置、姿态角和路径点的位置和高程信息作为车体边界框绘制基准。
(1)车辆运动学约束
本文针对的对象是阿克曼转向车辆,因为车辆存在最小转弯半径,所以对最大曲率进行限制,否则路径曲率过大。根据车辆运动学模型可推导得到曲率表达式为
κ = l ' ' + l κ ˙ r + l ' κ r t a n   θ F c o s 2   θ F 1 - l κ r + κ r ( 1 - l κ r ) / c o s   θ F
假设 θ F l ' '均趋近于0,则简化式(30)
κ = κ r   / ( 1 - l κ r )
根据车辆最大车轮转角可得最大曲率为
κ m a x = t a n   δ m a x / L
因此,路径最大曲率限制可表示为
t a n   δ m a x l κ r - t a n   δ m a x + κ r L 0
(2) 无碰撞约束
图13中,蓝色线段表示每个位置的侧向安全范围,所有蓝色线段组成了可通行空间。对于每个 s k值,都可以根据可通行空间确定 l k的上下界 l k _ m a x l k _ m i n,可通行障碍的上下界分别为 l   m a x   o b s l   m i n   o b s
针对避障路径,须考虑车辆外部轮廓不与障碍物发生碰撞且不超出可通行区域。如图13所示,本文以矩形表示车辆轮廓。车辆轮廓4个顶点的l值分别为
l k b p 1 = l k + d 1 s i n   θ F + W c o s   θ F / 2 l k b p 2 = l k + d 1 s i n   θ F - W c o s   θ F / 2 l k b p 3 = l k - d 2 s i n   θ F + W c o s   θ F / 2 l k b p 4 = l k - d 2 s i n   θ F - W c o s   θ F / 2
式中: d 1为车辆后轴中心到车辆前端外沿的距离; d 2为车辆后轴中心到车辆后端外沿的距离; W为车辆宽度。
l   k _ m a x   b p m l   k _ m i n   b p m分别为点 b p m对应的可通行空间侧向位移的上、下界,故无碰撞约束可以表示为
l k _ m i n b p m < l k b p m < l k _ m a x b p m , m [ 1,4 ]
针对跨障路径,须考虑车辆轮胎内缘不与障碍物发生碰撞且车辆不超出可通行区域。本文以矩形包围盒表示车辆轮廓。如图13所示, t p 1 ~ t p 4分别表示4个轮胎内缘中心,其侧向位置分别为
l k t p 1 = l k + L v s i n   θ F + b c o s   θ F / 2 l k t p 2 = l k + L v s i n   θ F - b c o s   θ F / 2 l k t p 3 = l k + b c o s   θ F / 2 l k t p 4 = l k - b c o s   θ F / 2
式中 L v为车辆长度。
则无碰撞约束可以表示为
l m a x o b s < l k t p 1 , l k t p 3 < l k _ m a x l k _ m i n < l k t p 2 , l k t p 4 < l m i n o b s     , s k - s o b s < L v
(3)连续性约束
在路径优化问题中,曲线是通过一系列离散点来表示的,因此必须在这些点之间施加连续性约束,以保证优化后的曲线是连续平滑的。
l k + 1 = l k + l k ' Δ s + l k ( Δ s ) 2 2 + l k + 1 - l k 6 Δ s ( Δ s ) 3 l k + 1 ' = l k ' + l k Δ s + l k + 1 - l k 2 Δ s ( Δ s ) 2
由于避障路径规划缺乏对无碰撞约束和车辆运动学约束的限制;相对的,基于运动基元生成的跨障路径不同基元之间存在曲率差异,不能保证整条路径平滑,因此需要对路径进一步优化,以确保路径的安全性和可行性。定义优化变量为 x = l 1 , l 1 ' , l 1 ' ' , l 2 , l 2 ' , l 2 ' ' , l 3 , l 3 ' , l 3 ' ' , , l K , l K ' , l K ' ' l k ' = d l / d s l k ' ' = d l ' / d s
代价函数主要有平滑性代价和与动态规划路径的误差两个指标。可以通过最小化l的1阶导数和2阶导数实现第1个指标,最小化l与动态规划路径的横向偏移 l k r e f的误差来实现第2个指标。因此,代价函数可以表示为
J p p o p t = ω o p t d l k = 1 K ( l k ' ) 2 + ω o p t d d l k = 2 K ( l k ) 2 +             ω o p t r e f k = 1 K ( l k - l k r e f ) 2
式中 ω o p t d l ω o p t d d l ω o p t r e f分别表示纵向目标代价权重、横向安全代价权重和横向偏移权重。
越野工况具有高路径曲率、横坡和低附着系数等特征,导致车辆易于在行驶过程中失稳。因此,在越野车辆速度规划中,必须考虑车辆的稳定性约束,以防止侧滑、侧翻等危险情况的发生。
根据刚性汽车的准静态侧翻过程[24]可得侧向加速度为
a y = 1 2 c o s   α - F z i m g B h g + s i n   α
式中: α为侧坡角度; F z i为车辆转向过程内侧轮胎垂向反作用力;B为轮距; h g为质心高度。
则横坡条件下车辆速度约束可表示为
s ˙ 0 , B g c o s   α h g κ + g s i n   α κ
为保障驾驶安全性,防止车辆失稳情况的发生,质心侧偏角 β和横摆角速度 ω应该满足以下条件[25]
β a r c t a n ( 0.02 φ g ) ω μ g / s ˙
式中 μ为路面附着系数。
根据单车模型,车辆横摆角速度、质心侧偏角、纵向车速和前轮转角之间的关系如下:
β = b δ L - s ˙ 2 L R r ( b m f k f + a m r k r ) ω = δ s ˙ L - s ˙ 3 L R r ( m f k f - m r k r )
式中: R r表示弯道半径; m f表示前轴质量; m r表示后轴质量; k f表示前轴刚度; k r表示后轴刚度。
因此,车辆质心侧偏角保持在稳定域内的条件可以表示为
- ζ b δ L - s ˙ 2 L R r ψ ζ
式中: ζ = a r c t a n   ( 0.02 φ g ) ψ = b m f / | k f | + a m r / | k r |。求解式(44)可以得到纵向车速的范围为
s ˙ [ η R r ψ , ( b δ + L ζ ) R r ψ ] ,     η 0 [ 0 , ( b δ + L ζ ) R r ψ ] ,                 η < 0
式中 η = b δ - L ζ
联立式(42)式(43)可得车辆横摆角速度保持在稳定域内的条件为
- φ g s ˙ 4 L R r ( m f k f - m r k r ) - δ s ˙ 2 L φ g
为简化公式,令 γ = m f / | k f | - m r / | k r |,然而,随着路面坡度和车辆加速的变化, γ可能发生符号变化,因此分类讨论得到横摆稳定速度范围为
s ˙ [ 0 , ξ 2 + ξ 2 2 + 4 ξ 1 ξ 3 2 ξ 1 ]   , γ 0 Δ < 0 [ 0 , ξ 2 - ξ 2 2 - 4 ξ 1 ξ 3 2 ξ 1 ]   , γ 0 Δ 0 [ 0 , ξ 2 - ξ 2 2 - 4 ξ 1 ξ 3 2 ξ 1 ]   ,     γ < 0 [ 0 , φ g L δ ] ,                               γ = 0
式中: ξ 1 = γ / L R r ξ 2 = δ / L ξ 3 = φ g Δ = ξ 2 2 - 4 ξ 1 ξ 3
在速度规划中,要求车辆在连续时间段内速度的变化是连续的,可保证车辆运动的稳定性和可控性。另外,有助于降低驾驶员和乘客的不适感,同时,连续性还有助于优化约束路径规划,减少了路径跟踪中的误差,提高了路径执行的可行性和稳定性,连续性约束的定义如下:
s k + 1 = s k + s ˙ k d t + s ¨ k d t 2 2 + s ¨ k + 1 - s ¨ k d t 2 6 s ˙ k + 1 = s ˙ k + s ¨ k d t + s ¨ k + 1 - s ¨ k d t 2
边界条件约束要求速度曲线起始点符合车辆当前状态,其定义如下:
s 0 = s s t a r t ; s ˙ 0 = v ; s ¨ 0 = a
式中: s s t a r t为规划起点的s值; v为车辆速度; a为车辆加速度。
速度优化问题的目标是为所得到的规划路径规划一条符合车辆运动学约束和地形约束的安全平滑的速度曲线。与路径优化相似,期望得到由K s , s ˙ , s ¨ , t组成的速度曲线,对于第k个点: s k表示该点的纵向位移; s ˙ k表示该点的纵向速度; s ¨ k表示该点的纵向加速度。因此,定义优化变量为: s = s 1 , s ˙ 1 , s ¨ 1 , s 2 , s ˙ 2 , s ¨ 2 , s 3 , s ˙ 3 , s ¨ 3 , , s K , s ˙ K , s ¨ K。速度优化问题可表示为
J s p o p t = ω s r e f k = 1 K ( s ˙ k - v s r e f ) 2 +             ω s a k = 1 K s ¨ k 2 + ω s j k = 2 K ( s ¨ k + 1 - s ¨ k ) 2 s . t .     40 , 44 , 46 ~ 48
式中 ω s r e f ω s a ω s j分别表示速度偏差代价权重、加速度和加加速度权重。
式(50)中等号右边第1项衡量了速度曲线靠近目标速度的程度,该项代价越小,说明速度曲线更接近目标速度,提高该项的权重有助于提高车辆的通行效率;第2项和第3项衡量速度曲线的平滑程度,这两项代价越小,速度曲线越平滑。
为验证本文所提出的算法(TOTP)在复杂地形和多尺度障碍条件下的有效性、决策合理性及其泛化能力,本文设置了4个试验工况进行分析验证,试验工况及目的如表1所示。另外,验证TOTP的实时性,并将其部署到工控机上,进行实车测试。图14所示为本文试验车辆及其传感器布置情况。试验车搭载线控转向、线控驱动、线控制动系统、激光雷达、摄像头和惯性导航单元,一台处理器为 Intel Core i9-10900K、显卡为NVIDIA GeForce RTX 3080,并安装机器人操作系统(robot operation system,ROS)的边缘计算平台作为工控机,车辆参数如表2所示。试验场地如图15所示。
为验证TOTP对复杂地形的处理能力,本节将本文提出的TOTP算法与EM Planner[2]进行对比分析。本节设置试验场景包括起伏路面,如图16(a)所示,车辆初速度为3 m / s,目标速度为10 m / s
图16(b)图16(c)图16(d)可知,由EM Planner规划的轨迹有两处车辆俯仰角和侧倾角绝对值较大,且抖动十分剧烈。原因是EM Planner未考虑地形变化对于车辆运行状态的影响,规划路径经过了两处起伏路面,造成了车辆俯仰角和侧倾角的抖动,由TOTP规划的轨迹车辆俯仰角和侧倾角变化更为平缓,如表3所示,平均绝对俯仰角(mean absolute pitch,MAP)和平均绝对侧倾角(mean absolute roll,MAR)数值显著降低,分别降低70.3%和72.9%。
图16(e)图16(f)可知,有两种方法规划的速度曲线均位于速度约束范围内,保证了车辆安全行驶。由EM Planner规划得到的平均速度(mean speed,MV)为3.71 m/s,然而,由TOTP规划得到的平均速度为5.21 m/s,平均速度提高了40.4%。
为验证TOTP对于复杂地形和不可跨越障碍物的处理能力,本节设置试验场景包括起伏路面和不可跨越障碍物如图17(a)所示,车辆初速度为3 m / s,目标速度为10 m / s
图17(b)图17(c)图17(d)可知,因EM Planner没有考虑复杂地形,其倾向于选择距离参考线较近的左侧绕行了障碍物,并没有避开起伏路面,其规划的轨迹存在两处车辆俯仰角和侧倾角绝对值较大,且抖动十分剧烈。而TOTP考虑了地形和障碍的共同影响,选择从右侧绕行障碍物,且避开了起伏地形,车辆俯仰角和侧倾角变化较为平缓。如表4所示,MAP和MAR显著降低,分别降低68.1%和73.6%。
其次,由两种方法规划的速度曲线均位于速度约束范围内,保证了车辆安全行驶,如图17(e)图17(f)所示。由EM Planner规划得到的MV为5.62 m / s,然而,由TOTP规划得到的平均速度为6.51 m / s,平均速度提高了15.8%。
为验证非结构化道路同时存在可跨越和不可跨越障碍物时,考虑障碍物尺度进行路径规划的优势。设置试验场景主要包括不可跨越障碍和可跨越障碍,如图18(a)所示,初速度为3 m / s,目标速度为10 m / s
图18(b)图18(c)图18(d)可知,跨障轨迹和避障轨迹均保证车辆安全运行,两条轨迹经过的路面都比较平坦,车辆姿态角接近且数值较小。由于避障路径规划算法将所有障碍物统一视为不可跨越障碍物,其倾向于绕行可跨越障碍物,导致规划路径存在较大曲率变化。相反,跨障路径规划算法选择避让不可跨越障碍物的条件下跨越尺度较小的可跨越障碍物。结合速度规划算法,其规划的路径曲率相对较小,进而规划得到更大的通行速度,如图18(e)图18(f)所示。结合表5可知,跨障轨迹平均车速提高29.6%,且平均绝对侧向加速度(mean absolute lateral acceleration,MALA)降低71.5%。如表6所示,跨障轨迹具有更小的整体代价,尤其是在横向安全代价和纵向目标代价方面显著降低,分别为34.92和245.49。由于道路相对平坦,两种轨迹地形代价基本一致。因此,通行模式判定模块选取车辆通行模式为跨障模式,输出跨障轨迹。
为验证起伏道路且存在可跨越障碍物条件下,本文所提算法对于复杂场景的处理能力,设置起伏路面和可跨越障碍连续出现的场景为工况4测试场景,如图19(a)所示,车辆初速度为3 m / s,目标速度为10 m / s
图19(b)图19(c)图19(d)可知,避障轨迹绕行障碍物和起伏地形,而跨障轨迹受限于障碍物的跨越过程,其也会从起伏地形上经过,导致车辆存在较大的俯仰角和侧倾角。其原因在于,本文所提轨迹规划框架的通行模式判定模块综合考虑了车辆通行效率和运行安全性目标,保证车辆以最佳轨迹运行。根据表7表8可知,避障轨迹相对于跨障轨迹更能够保证车辆的稳定运行,姿态变化更为平缓。对应的,虽然路径较直,相对路程变少,MV和MALA分别降低6.4%和70.6%,具有较小的横向安全代价,但另一方面,MAP和MAR分别增加173.3%和225.0%,具有较大的纵向目标代价和地形代价,整体代价高于避障路径,所以输出避障轨迹。
在跨障试验中,由于须同时规划两条局部轨迹,总耗时相当于单独规划避障轨迹的两倍,因此须验证跨障、避障同时规划的实时性。为验证其实时性,本文设置30 m规划长度,随机设置3个障碍物,包括可跨越和不可跨越障碍,进行200组规划测试,轨迹规划耗时如表9所示。
表9所示,跨障规划平均耗时20.3 ms,避障规划平均耗时21.57 ms,速度规划平均耗时18.3 ms,轨迹规划程序平均耗时为60.37 ms,满足一般自动驾驶系统对规划节点要求,本文所提算法符合实时性需求。
为协调非结构化道路条件下车辆运行安全性与通行效率,提出了考虑复杂地形和障碍尺度的轨迹规划方法。为规划得到综合性能更好的轨迹,本文提出了面向非结构化道路的轨迹规划框架。根据车辆通行模式并综合考虑运行风险和通行效率,分别提出了基于动态规划的避障路径规划算法和基于改进A*的跨障路径规划算法,协调非结构化道路车辆运行安全性与通行效率。基于稳定性分析,提出了考虑地形约束的速度规划方法,保证车辆非结构化道路运行稳定性。基于实车试验分析,起伏地形条件下,相对于EM Planner,本文所提的轨迹规划方法可提高车辆运行效率和安全性,平均车速提高15.8%,平均绝对俯仰角和平均绝对侧倾角分别降低68.1%和73.6%。多尺度障碍和复杂地形综合作用条件下,本文所提算法框架可判定最优通行模式,并规划得到最优通行轨迹,协调车辆运行安全性和通行效率,保证综合性能最佳。且本文所提算法平均耗时60.37 ms,符合实时性需求。在未来研究中,将进一步研究多个可跨越障碍条件下的轨迹规划方法,扩展轨迹规划场景,从而全面保障非结构化道路无人车辆安全性和通行效率。
  • *国家自然科学基金重大项目(52394262)
  • 国家自然科学基金面上项目(52472445)
参考文献 引证文献
排序方式:
[1]
HU J,HU Y,LU C,et al. Integrated path planning for unmanned differential steering vehicles in off-road environment with 3D terrains and obstacles[J]. IEEE Transactions on Intelligent Transportation Systems,2022,23(6): 5562-5572.
[2]
FAN H,ZHU F,LIU C,et al. Baidu apollo EM motion planner[J]. ArXiv,2018,abs/1807.08048.
[3]
SHI Y,HUANG Y,CHEN Y. Trajectory planning of autonomous trucks for collision avoidance with rollover prevention[J]. IEEE Transactions on Intelligent Transportation Systems,2021: 1-10.
[4]
WERLING M,ZIEGLER J,KAMMEL S,et al. Optimal trajectory generation for dynamic street scenarios in a Frenét Frame[C]. Proceedings of the 2010 IEEE International Conference on Robotics and Automation (ICRA). IEEE,2010: 987-993.
[5]
YANG L,QI J,SONG D,et al. Survey of robot 3D path planning algorithms[J]. Journal of Control Science and Engineering,2016,2016: 1-22.
[6]
CLAUSSMANN L,REVILLOUD M,GRUYER D,et al. A review of motion planning for highway autonomous driving[J]. IEEE Transactions on Intelligent Transportation Systems,2020,21(5): 1826-1848.
[7]
PADEN B,ČáP M,YONG S Z,et al. A survey of motion planning and control techniques for self-driving urban vehicles[J]. IEEE Transactions on Intelligent Vehicles,2016,1(1): 33-55.
[8]
吴晓建,廖平伟,雷耀,等. 面向结构化道路的智能驾驶轨迹规划一致性研究[J]. 汽车工程,2024,46(3): 383-395,430.
WU X J,LIAO P W,LEI Y,et al. Research on consistency of intelligent driving trajectory planning for structured road[J]. Automotive Engineering,2024,46(3): 383-395,430.
[9]
HART P E,NILSSON N J,RAPHAEL B. A formal basis for the heuristic determination of minimum cost paths[J]. IEEE Transactions on Systems Science and Cybernetics,1968,4(2): 100-107.
[10]
SHANG E,DAI B,NIE Y,et al. A guide-line and key-point based A-star path planning algorithm for autonomous land vehicles[C]. Proceedings of the 2020 IEEE 23rd International Conference on Intelligent Transportation Systems (ITSC). IEEE,2020.
[11]
ERKE S,BIN D,YIMING N,et al. An improved A-Star based path planning algorithm for autonomous land vehicles[J]. International Journal of Advanced Robotic Systems,2020,17(5).
[12]
JIANG J,HAN Z,LI J,et al. Global path planning of UGVs in large-scale off-road environment based on improved A-star algorithm and quadratic programming[C]. Proceedings of the 2023 IEEE Intelligent Vehicles Symposium (IV). IEEE,2023.
[13]
RASTGOFTAR H,ZHANG B,ATKINS E M. A data-driven approach for autonomous motion planning and control in off-road driving scenarios [Z]. Ithaca; Cornell University Library,arXiv.org. 2018.
[14]
TIAN F,ZHOU R,LI Z,et al. Trajectory planning for autonomous mining trucks considering terrain constraints[J]. IEEE Transactions on Intelligent Vehicles,2021,6(4): 772-786.
[15]
CAI X,EVERETT M,FINK J,et al. Risk-aware off-road navigation via a learned speed distribution map[C]. Proceedings of the 2022 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE,2022: 2931-3937.
[16]
田洪清,丁峰,郑讯佳,等. 基于势能场虚拟力的智能网联车辆运动规划[J]. 汽车工程,2021,43(4): 518-526.
TIAN H Q,DING F,ZHENG X J,et al. Motion planning based on virtual force of potential field for intelligent connected vehicles[J]. Automotive Engineering,2021,43(4): 518-526.
[17]
CHI W,WANG C,WANG J,et al. Risk-DTRRT-based optimal motion planning algorithm for mobile robots[J]. IEEE Transactions on Automation Science and Engineering,2019,16(3): 1271-1288.
[18]
田洪清,王建强,黄荷叶,等. 越野环境下基于势能场模型的智能车概率图路径规划方法[J]. 兵工学报,2021,42(7): 1496-1505.
TIAN H Q,WANG J Q,HUANG H Y,et al. Probabilistic roadmap method for path planning of intelligent vehicle based on artificial potential field model in off-road environment[J]. Acta Armamentarii,2021,42(7): 1496-1505.
[19]
TANG C,ZHAO Y. Hierarchical path planning based on PPO for UVs on 3D off-road terrain[C]. Proceedings of the 2022 IEEE 4th International Conference on Power,Intelligent Computing and Systems (ICPICS). IEEE,2022: 295-300.
[20]
YANG L,WANG Q,TAN Y,et al. Autonomous vehicle path planning considering dwarf or negative obstacles[C]. Proceedings of the 2019 IEEE Intelligent Vehicles Symposium (IV). IEEE,2019: 1021-1026.
[21]
LUO H,LI M,LIANG G,et al. An obstacle-crossing strategy based on the fast self-reconfiguration for modular sphere robots[C]. Proceedings of the 2020 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS). IEEE,2020: 3296-3303.
[22]
CHEN M,CAO Y,TIAN Y,et al. A passive compliance obstacle-crossing robot for power line inspection and maintenance[J]. IEEE Robotics and Automation Letters,2023,8(5): 2772-2779.
[23]
BERTI M,CORSINI A,DAEHNE A. Comparative analysis of surface roughness algorithms for the identification of active landslides[J]. Geomorphology,2013,182: 1-18.
[24]
余志生. 汽车理论 [M]. 6版. 北京:机械工业出版社,2018.
YU Z S. Automotive theory [M]. 6th ed. Beijing: China Machine Press,2018.
[25]
RAJAMANI R. Vehicle dynamics and control [M]. Springer Science & Business Media,2011.
2025年第47卷第4期
PDF下载
419
151
引用本文
BibTeX
文章信息
doi: 10.19562/j.chinasae.qcgc.2025.04.006
  • 接收时间:2024-06-02
  • 首发时间:2025-07-08
  • 出版时间:2025-04-25
补充材料
相关文章
文章信息
作者
出版历史
  • 收稿日期:2024-06-02
  • 修回日期:2024-09-14
基金
*国家自然科学基金重大项目(52394262)
国家自然科学基金面上项目(52472445)
作者信息
    北京理工大学机械与车辆学院,北京 100081

通讯作者:

聂士达,助理教授,博士,E-mail:
参考文献
分享链接
https://castjournals.cast.org.cn/joweb/qcygc/CN/10.19562/j.chinasae.qcgc.2025.04.006
分享至
全文二维码

扫描看全文

引用本文
BibTeX
本文的引用情况
2种不同金属材料的力学参数

Family
属数
Number of
genus
种数
Number of
species
占总种数比例
Percentage of
total species (%)

Genus
种数
Number of
species
占总种数比例
Percentage of total
species (%)
鹅膏菌科Amanitaceae 2 11 5.26 鹅膏菌属 Amanita 10 4.78
小菇科 Mycenaceae 2 12 5.74 丝盖伞属 Inocybe 5 2.39
多孔菌科 Polyporaceae 8 14 6.70 蜡蘑属 Laccaria 5 2.39
红菇科 Russulaceae 3 23 11.00 小皮伞属 Marasmius 6 2.87
小菇属 Mycena 11 5.26
光柄菇属 Pluteus 5 2.39
红菇属 Russula 17 8.13
栓菌属 Trametes 5 2.39
关闭全屏