[发明专利]一种直线段和圆弧的平滑过渡方法及系统有效

专利信息
申请号: 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存在以下关系式,

用数值方法,在区间[sin2e/4+π/8),sin2e/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,重新求取过渡曲线参数方程。

下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。

该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于哈工大机器人(合肥)国际创新研究院,未经哈工大机器人(合肥)国际创新研究院许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服

本文链接:http://www.vipzhuanli.com/pat/books/202011235440.7/1.html,转载请声明来源钻瓜专利网。

×

专利文献下载

说明:

1、专利原文基于中国国家知识产权局专利说明书;

2、支持发明专利 、实用新型专利、外观设计专利(升级中);

3、专利数据每周两次同步更新,支持Adobe PDF格式;

4、内容包括专利技术的结构示意图流程工艺图技术构造图

5、已全新升级为极速版,下载速度显著提升!欢迎使用!

请您登陆后,进行下载,点击【登陆】 【注册】

关于我们 寻求报道 投稿须知 广告合作 版权声明 网站地图 友情链接 企业标识 联系我们

钻瓜专利网在线咨询

周一至周五 9:00-18:00

咨询在线客服咨询在线客服
tel code back_top