[发明专利]一种直线段和圆弧的平滑过渡方法及系统有效
申请号: | 202011235440.7 | 申请日: | 2020-11-05 |
公开(公告)号: | CN112276957B | 公开(公告)日: | 2022-03-11 |
发明(设计)人: | 王华;郭庆洪;吴自翔;于振中;李文兴 | 申请(专利权)人: | 哈工大机器人(合肥)国际创新研究院 |
主分类号: | B25J9/16 | 分类号: | B25J9/16 |
代理公司: | 合肥市浩智运专利代理事务所(普通合伙) 34124 | 代理人: | 张景云 |
地址: | 236000 安徽省合肥市经济*** | 国省代码: | 安徽;34 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 线段 圆弧 平滑 过渡 方法 系统 | ||
1.一种直线段和圆弧的平滑过渡方法,其特征在于,假设已知直线段以P0为起点,P1为终点,且在P1点和圆弧相接,由P0到P1的方向向量为t0,P0与P1之间的距离为d;圆弧以P1为起点,P2为终点,圆心为O,半径为R,圆弧在起点P1处的切向量为t1,法向量为n1,圆弧所对的圆心角为θ;t0和n1的夹角为α,t0和t1的夹角为β;
方法具体为:给定交融区半径Rc,交融区为以P1为圆心、Rc为半径的区域;在交融区内构造过渡曲线,过渡曲线的起点记为Ps,终点记为Pe;Ps位于直线段上,Pe位于圆弧上,Ps到P1的距离记为ds,Pe到P1的距离记为de;
以O为原点,t0为x轴方向,t0旋转β角度到t1的旋转方向作为逆时针方向,建立平面直角坐标系XOY,并作为参考坐标系,在参考坐标系下,Ps坐标记为(xs,ys),Pe坐标记为(xe,ye);
过渡曲线截取自平面弹性线上的一段,在参考坐标系下,其参数方程具有如下形式,
式中,φ为参数方程的参数,取值范围由-π/2到φ1,且有,
u(φ),v(φ)的表达式为
其中,E(φ,m)为第二类椭圆积分,F(φ,m)为第一类椭圆积分,m为椭圆积分的参数,其取值范围为0<m<1;ic,jc为互相垂直的单位向量,与m有关,其表达式为
p为φ=0时,过渡曲线上对应点的坐标;
确定m,φ1以及p的方法为:
根据α,β的取值,分两种情形处理,α>90°或者α=90°,β=0°为情形一,α<90°或者α=90°,β=180°为情形二;
对于情形一,首先确定过渡曲线的终点Pe,根据下式计算Pe到P1的距离de,
由de得到OPe的辐角θe为:
于是Pe坐标(xe,ye)为
(xe,ye)=(R cosθe,R sinθe)(7)
再求m和φ1,φ1与m存在以下关系式,
用数值方法,在区间[sin2(θe/4+π/8),sin2(θe/2+π/4)]上求解关于m的方程:
式(9)中E(m)为第二类完全椭圆积分,K(m)为第一类完全椭圆积分,根据式(8),式(9)等号两边只与m相关;求解出m后,由式(8)可求得φ1;
最后求p,由式(2)得到p计算公式为
p=(xe,ye)-R|cosφ1|(u(φ1)ic+v(φ1)jc) (10)
对于情形二,首先确定当φ1=π时,过渡曲线起点Ps到P1的距离ds,以及Pe到P1的距离de,具体做法如下:使用数值算法,在区间[0,0.1]内求解以下关于μ的方程,
求解出μ后,ds以及de由下式确定
再按照下式计算Ps到P1的最大允许距离dmax,
根据dmax与ds,de相对大小的不同,分两种情况处理,第一种情况,dmax≥ds且dmax≥de,此时有
m=u,φ1=π (14)
Pe坐标(xe,ye)为
由式(2),p为
p=(xe,ye)-R|cosφ1|(u(φ1)ic+v(φ1)jc) (16)
第二种情况,dmax<ds或dmax<de,对于此情况,首先固定过渡曲线起点Ps使得ds=dmax,求取过渡曲线的参数方程,并验证终点Pe到P1的距离de是否不大于dmax,若de≤dmax,则过渡曲线的方程即为已求取的参数方程,若ds>dmax,则固定过渡曲线终点Pe使得de=dmax,重新求取过渡曲线参数方程。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈工大机器人(合肥)国际创新研究院,未经哈工大机器人(合肥)国际创新研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202011235440.7/1.html,转载请声明来源钻瓜专利网。