[发明专利]面向复杂多轴系统的B样条曲线计算加速方法有效
申请号: | 201911346098.5 | 申请日: | 2019-12-24 |
公开(公告)号: | CN113031510B | 公开(公告)日: | 2022-04-05 |
发明(设计)人: | 韩冰;张华良;赵冰洁;秦锋;李子阳;孙海涛;张诚 | 申请(专利权)人: | 沈阳智能机器人创新中心有限公司;沈阳智能机器人国家研究院有限公司;中国科学院沈阳自动化研究所 |
主分类号: | G05B19/19 | 分类号: | G05B19/19 |
代理公司: | 沈阳科苑专利商标代理有限公司 21002 | 代理人: | 王倩 |
地址: | 110000 辽宁省沈阳*** | 国省代码: | 辽宁;21 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 面向 复杂 系统 曲线 计算 加速 方法 | ||
1.面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,包括以下步骤:
利用设定的关键点规划B样条曲线路径;
基于B样条曲线路径进行速度规划,得到每个控制周期在B样条曲线路径上的期望长度;
在独立的内核中利用数值积分方法求解B样条曲线路径参数关于曲线长度的关系;
利用B样条曲线的参数方程,根据得到的B样条曲线路径参数,确定规划的空间位置点;
将空间位置点发给执行机构,驱动设备移动。
2.根据权利要求1所述的面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,所述利用设定的关键点规划B样条曲线路径具体如下:
根据设定的关键点得到控制点,再利用控制点确定样条曲线C(u);
其中,Pi为第i个控制点,n为控制点个数,Ni,p(u)为定义在非周期并且非均匀节点矢量U上的p次B样条基函数;U包含m+1个节点;a、b分别为u的下限和上限;
U={a,…,a,up+1,…um-p-1,b,…b}。
3.根据权利要求1所述的面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,所述基于B样条曲线路径进行速度规划,得到每个控制周期在B样条曲线路径上的期望长度,包括以下处理过程:
在B样条曲线路径上的运动速度满足S型速度,根据给定的最大速度、最大加速度、最大加加速度、起始及终止的速度和加速度,规划在B样条曲线路径上的运动速度,进而积分得到每个控制周期在B样条曲线路径上的期望长度。
4.根据权利要求1所述的面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,所述利用数值积分方法求解B样条曲线路径参数对于曲线长度的关系,包括以下步骤:
数值积分法表达式如下:
其中:为B样条曲线路径参数u为xw时的曲线长度,f(·)为样条曲线C(u)的导数;[xk-1,xk]表示将定义域[a,b]进行W等分后的小区间,表示W等分节点的横坐标,表示子区间[xk-1,xk]的中点;W为正整数,a、b分别为u的下限和上限;
将每个控制周期在B样条曲线路径上的期望长度带入上述函数S(u)的反函数中,即可确定B样条曲线路径参数u。
5.根据权利要求1或4所述的面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,所述利用数值积分方法求解B样条曲线路径参数关于曲线长度的关系步骤是在独立的cpu核中运行,计算过程不占用控制周期时间。
6.根据权利要求1所述的面向复杂多轴系统的B样条曲线计算加速方法,其特征在于,根据B样条曲线路径参数利用B样条曲线函数确定规划的空间位置点具体为:根据B样条曲线路径参数u,利用B样条曲线确定笛卡尔空间位置点;样条曲线如下:
其中,Pi为第i个控制点,n为控制点个数,Ni,p(u)为定义在非周期并且非均匀节点矢量U上的p次B样条基函数;U包含m+1个节点;a、b分别为u的下限和上限;
U={a,…,a,up+1,…um-p-1,b,…b};
C(u)作为曲线参数为u时的笛卡尔空间位置点。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于沈阳智能机器人创新中心有限公司;沈阳智能机器人国家研究院有限公司;中国科学院沈阳自动化研究所,未经沈阳智能机器人创新中心有限公司;沈阳智能机器人国家研究院有限公司;中国科学院沈阳自动化研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201911346098.5/1.html,转载请声明来源钻瓜专利网。