[发明专利]一种最小曲率的直线过渡路径生成方法有效
申请号: | 202210256214.X | 申请日: | 2022-03-16 |
公开(公告)号: | CN114310921B | 公开(公告)日: | 2022-06-10 |
发明(设计)人: | 何刚;韩峰涛;庹华;张航;于文进;陈可;韩建欢 | 申请(专利权)人: | 珞石(北京)科技有限公司 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 北京瑞盛铭杰知识产权代理事务所(普通合伙) 11617 | 代理人: | 李绩 |
地址: | 100097 北京市海淀区望福园东区北京海青曙光*** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 最小 曲率 直线 过渡 路径 生成 方法 | ||
1.一种最小曲率的直线过渡路径生成方法,其特征在于,包括如下步骤:
步骤S1,设置机器人行进过程中,连接两段路径的过渡路径采用下式表示:
其中,为第一段直线路径,为第二段直线路径,为生成过渡路径的多项式,需要满足边界条件,并规定;其中,需要满足边界条件,并规定,满足的边界条件如下
因此可以表示成
;
为补偿项,用于补偿引入的过渡路径中的加减速,使的加速度最小;u为一个额外的自由度来改变过渡路径点的加速度,满足边界条件的的表达式为
;
设为六次多项式,同时满足边界约束条件,;
对于直线路径来说,和表示为
;
其中,、分别为两段直线路径、的起点,、分别为两段直线路径、的斜率;
步骤S2,将和代入到中,并求关于s的二阶导数,求得过渡路径沿s的加速度积分,表示如下
上式中,,;从上式看到,右边第一项与两段直线有关,无法改变,而右边第二项通过改变u使其最小;过渡路径表示为:
。
2.如权利要求1所述的最小曲率的直线过渡路径生成方法,其特征在于,k为调整曲线形状系数,通过调整k值来改变过渡路径形状;
当时,过渡路径的加速度将最小,
。
3.如权利要求1所述的最小曲率的直线过渡路径生成方法,其特征在于,设为六次多项式,同时满足边界约束条件,,以使得有额外的自由度。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于珞石(北京)科技有限公司,未经珞石(北京)科技有限公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202210256214.X/1.html,转载请声明来源钻瓜专利网。