- 1、本文档共6页,可阅读全部内容。
- 2、原创力文档(book118)网站文档一经付费(服务费),不意味着购买了该文档的版权,仅供个人/单位学习、研究之用,不得用于商业用途,未经授权,严禁复制、发行、汇编、翻译或者网络传播等,侵权必究。
- 3、本站所有内容均由合作方或网友上传,本站不对文档的完整性、权威性及其观点立场正确性做任何保证或承诺!文档内容仅供研究参考,付费前请自行鉴别。如您付费,意味着您自己接受本站规则且自行承担风险,本站不退款、不进行额外附加服务;查看《如何避免下载的几个坑》。如果您已付费下载过本站文档,您可以点击 这里二次下载。
- 4、如文档侵犯商业秘密、侵犯著作权、侵犯人身权等,请点击“版权申诉”(推荐),也可以打举报电话:400-050-0827(电话支持时间:9:00-18:30)。
查看更多
最佳路径寻找及其方法--曲率法2
一.路径规划方法的选择
我拟考虑使用一条曲线进行路径规划。
我选择曲率法而不选择其他方法有如下考虑:
1,从难易程度上面考虑,曲率法不是最简单的方法,但是它有其它方法不能达到的好处,我们通过计算车子每一点的曲率,首先可以反映跑道每一点的弯曲程度,而且,曲率还能反映我们车子经过该点的最大速度和最大向心加速度。所以即便是我们采用其他方法进行控制,最后还是要回归到求跑道的曲率上面来。
最佳路径的寻找
最佳路径的寻找不是随便找一条曲线作为运行路径,而是特定的那一条曲线,在任何赛道情况下,只能找到一条这样的路径,下面我就通过各种赛道的图像来寻找最佳路径:
情况一:弯道
红色曲线是规划出来的最佳路径,θ为重建出来的跑道所转过的角度,θ0表示向左转,θ0表示向右转。红色曲线与车子起始方向相切,且在满足不压两边跑道的情况下半径最短。 设规划出来的路径半径为r,车子需要跑过θ角度,车子起点为(CarX,CarY),
车子目前的速度为v,以半径r为规划路径行进时的最大速度为,车子的向心加速度(这个是在车子硬件,机械确定以后提前测出来的,为固定值保存在程序中,意思就是通过半径为R的跑道时,允许的最大速度为)。
所以车子在规划路径上跑时,也就是在上图中红色路径上跑的时候,允许的最大速度为:
在此段路程中花费的总时间为:
所以得出r越小,总时间花的就越短。故车子应该尽量切内道跑。
又因为我们规划出来的路径不能压线,由图分析可得,我们只要保证我们规划出来的最远处的那个点不压线切靠近内侧跑道则基本可以保证我们规划出来的跑道不压线。
由图中标注:
a,b应满足:
在计算出上面的参数过后,就给舵机和电机赋值,舵机赋值为1/r,r可以反映出舵机偏转角的大小,r越大,路径越平缓,舵机偏转就应该越小,r越小,路径弯度越大,舵机偏转就应该越大。然后在1/r的基础上再乘以一个比例系数K,K是通过实验调节出的一个合适的值,参数调节合适后,是会适应所有弯道的,并不只是适 用于当前弯道。电机的赋值采用控速的闭环控制法,保证车子以通过此弯道允许的最大速度跑过去。
补充:路径规划的时候还需要考虑到车子相对于跑道的偏向,因为规划出来的路径必须与车子当前的方向相切,否则会是车子强制产生一个偏向角,这种规划出来的路径是不可实现的,并且在这种情况下也有可能会产生侧滑等等。所以我们要计算出车身相对于跑道的偏向角度。通过几何关系我们知道计算这个量的前提是找到每一段规划路径的圆心坐标。
情况二:小S或大S
和情况一中的弯道处理方式一样。
情况三:直道
直道情况一般是弯进直,所以他的路径一般是靠近弯进直那个内侧弯道的一边。处理情况和弯道相同。如图所示:
算法实现
θ计算
Θ是我们路径规划中其中之一的已知量,它的计算我们采用扇形的几何关系求出。
经过测试,这种方法计算出来的θ角较精准,且计算量简便,故予以采用。
如图所示:
所以:
令
得:
所以有:
求解上面的方程得:
(舍)
故:
; ;
向心加速度计算
对特定弯道进行测试,以不同的速度通过半径R固定的弯道,当在速度为V时开始出现侧滑,这最大速度V对应R,向心加速度。因为车子轮胎相对于跑道的摩擦系数不变,故在任何位置a的值不变,保存a的值,在其他跑道中,电机所给的最大速度。
寻找圆心坐标
我们需要求解我们规划出来路径的圆心坐标,这样我们就能求得我们规划路径的方程,然后就能方便的判断我们的规划路径是否压线(两边跑道)。而我们现在的已知量只有起始点和终止点的坐标,设为(x1,y1);(x2,y2)。还有一个已知量就是我们规划路径的半径r,通过这三个量我们需要求解出规划路径的圆心坐标。由于规划出来的路径是理想的,所以圆心坐标也是相当准确的。我们采用的方法是通过过两个点作以半径为r的两个圆,相交的两个点即为圆心坐标,如下图所示:
联立方程组:
令
求解上式,得:
x1!=x2 y1!=y2
x1=x2
y1=y2
sig
k
1
0
1
X大
Y小
X小
Y大
0
X大
Y大
X小
Y小
求直线方程
车身方向直线:
与车身方向垂直的直线:
您可能关注的文档
- 红色英勇勋章 斯蒂芬·克莱恩.ppt
- 气瓶基础知识(2011).ppt
- 2.2 合成气的净化.ppt
- 中小猎头企业发展策略(东莞).pdf
- 1、中铁-丰利1214期华西证券理财指南.pdf
- 福建省三明市2016年中考地理真题(含答案).pdf
- 2012证券从业资格考试《证券投资基金》要点三色记忆法标注打印版.pdf
- 宝明员工绩效考核表格.pdf
- 昆明打折全攻略(-)——美食篇.pdf
- 明远楼与甘肃贡院的兴废[1].pdf
- 甘肃省白银市会宁县第一中学2025届高三3月份第一次模拟考试化学试卷含解析.doc
- 2025届吉林市第一中学高考考前模拟生物试题含解析.doc
- 四川省三台县芦溪中学2025届高三下第一次测试生物试题含解析.doc
- 2025届江苏省启东市吕四中学高三适应性调研考试历史试题含解析.doc
- 浙江省宁波市十校2025届高三二诊模拟考试历史试卷含解析.doc
- 甘肃省甘南2025届高考生物必刷试卷含解析.doc
- 河北省石家庄市一中、唐山一中等“五个一”名校2025届高考历史四模试卷含解析.doc
- 江西省南昌市进贤一中2025届高考生物考前最后一卷预测卷含解析.doc
- 甘肃省白银市会宁县第四中学2025届高三第二次模拟考试历史试卷含解析.doc
- 宁夏银川市宁夏大学附属中学2025届高考化学押题试卷含解析.doc
文档评论(0)