CN103802113A - 基于任务和样条曲线的工业机器人路径规划方法 - Google Patents
基于任务和样条曲线的工业机器人路径规划方法 Download PDFInfo
- Publication number
- CN103802113A CN103802113A CN201210442709.8A CN201210442709A CN103802113A CN 103802113 A CN103802113 A CN 103802113A CN 201210442709 A CN201210442709 A CN 201210442709A CN 103802113 A CN103802113 A CN 103802113A
- Authority
- CN
- China
- Prior art keywords
- industrial robot
- prime
- task
- formula
- module
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
Images
Landscapes
- Numerical Control (AREA)
Abstract
本发明公开了一种基于任务和样条曲线的工业机器人路径规划方法,其包括有机器人控制器、输入信息到控制器的运动学模块、任务模块、轨迹规划器,该规划方法包括以下步骤:S1、建立工业机器人的运动学模型,求得工业机器人的运动学的正反解;S2、由所述的任务模块给出工业机器人的任务点的位置信息和姿态信息:S3、由工业机器人的轨迹规划器结合所述的任务模块,给出基于样条曲线的路径规划曲线:S4、工业机器人轨迹规划器将产生的路径曲线,结合运动学正反解得到关节空间的信息发给工业机器人的驱动器。采用本发明的技术方案,不但可以解决工业机器人在应用中需要经过多个中间位姿的问题,并且为了保证工业机器人在运动中的加速度无急动。
Description
技术领域
本发明涉及一种基于任务和样条曲线的工业机器人路径规划方法。
背景技术
工业机器人是工作机器,其可以装备用于对对象进行自动处理和/或加工的工具,并可以对多个运动轴,例如就方向、位置和工作流程进行编程。工业机器人通常包括具有多个轴的机器人臂以及可编程控制器(控制装置),控制器在运行中控制或调整工业机器人的运动过程。
为了实现运动,控制器可以通过轨迹规划来计划这种运动。
常用的轨迹规划方法有:3-4-5正则多项式;4-5-6-7正则多项式;摆线运动与抛物线拟合的线性函数等。4-5-6-7正则多项式相对3-4-5正则多项式的优点是,可以保证加速度的变化没有急动;摆线运动与抛物线拟合的线性函数方法对要求通过中间位姿的情况处理起来较为复杂。当机器人要求通过中间位姿时,大多采用高阶正则多项式,Kahaner,Moler和Nash等指出中间位姿数量增加时这种采用多项式插值的方法变得不切实际,这时因为中间位姿的增加会使得正则多项式的次数增加,多项式系数的方程组的条件数变大,相对舍入误差等于舍入误差乘以一个放大系数—方程组条件数,从而方程组的解失真。
发明内容
本发明提供一种基于任务和样条曲线的工业机器人路径规划方法,其可克服上述缺陷,能解决工业机器人在应用中需要经过多个中间位姿的问题,并且可保证工业机器人在运动中的加速度无急动。
为实现上述目的,本发明采用如下技术方案:
一种基于任务和样条曲线的工业机器人路径规划方法,其包括有机器人控制器、输入信息到控制器的运动学模块、任务模块、轨迹规划器,该规划方法包括以下步骤:
S1、建立工业机器人的运动学模型,求得工业机器人的运动学的正反解;
S2、由所述的任务模块给出工业机器人的任务点的位置信息和姿态信息:
S3、由工业机器人的轨迹规划器结合所述的任务模块,给出基于样条曲线的路径规划曲线:
S4、工业机器人轨迹规划器将产生的路径曲线,结合运动学正反解得到关节空间的信息发给工业机器人的驱动器:
上述的任务模块,设有两个信息输入口,所述的第一个信息输入口,是直接与所述的机器人控制器相连;所述的第二个信息输入口,是利用串口与PC相连。
在步骤S2中的任务点,是利用示教或离线编程给出的,所述的工业机器人要完成任务需要通过的点。
上述的路径规划曲线,由下述步骤所得:
定义所述的任务模块给出的工业机器人通过点的个数用N表示,这些点用Pk(xk,yk)(k=1,2...N)表示;这里用三次样条曲线s(xk)连接已知的N个位姿点Pk(xk,yk)(k=1,2...N)间的N-1个区间,在连接点Pk上有s(xk)=yk,而且定义样条函数在x1≤x≤xN上式二次可微的,即这样的样条函数称为C2函数,也就是有连续的二阶导数;设两个连续点Pk(xk,yk)和Pk+1(xk+1,yk+1)间的三次多项式sk(x)及相应的一阶导数和二阶导数如公式(1):
为了便于书写设定如下恒等式,由公式(1)计算可得公式(2):
sk≡s(xk),s′k≡s(x′k),s″k≡s(x″k)
Δxk≡xk+1-xk,Δsk≡sk+1-sk
接下来,将多项式系数都用样条曲线的二阶导数和样条函数值表示;考虑两个样条曲线在连接处函数值及一阶和二阶导数连续,可以得到如下方程(3):
由上式的第一个等式和最后一个等式,可以分别得到公式(4):
于是各多项式的系数用样条函数及其二阶导数表示如公式(5):
将(3)的第二个方程的k改为k-1,并将上式带入,得到含有N个未知数的N-2方程组(6):
(Δxk)s″k+1+2(Δxk-1+Δxk)s″k+(Δxk-1)s″k-1
=6(Δsk/Δxk-Δsk-1/Δxk-1),k=2,3...N-1 (6)
将式(6)整理成矩阵形式,如公式(7):
As″=6Cs (7)
公式(7)中的符号说明如下:
s=[s1 s2 ... sN]T,s″=[s1″s2″...s″N]T
对于i,j,k=1,2...N-1有如下恒等式。
αK≡Δxk,αi,j≡αi+αj,N'≡N-1,N″≡N-2
βk≡1/αk,βi,j≡βi+βj,N″′≡N-3
使用自然样条曲线,即设s1″=s″N=0。
在步骤S4中,其中利用工业机器人的控制器内所输入的运动学模块,根据轨迹规划器给出的路径曲线,计算关节空间值,发送到工业机器人各关节驱动器。
采用上述的技术方案,不但可以解决工业机器人在应用中需要经过多个中间位姿的问题,并且为了保证工业机器人在运动中的加速度无急动。
附图说明
图1为实现本发明工业机器人路径规划流程示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。
参考图1所示,本发明,公开了一种基于任务和样条曲线的工业机器人路径规划方法,该工业机器人包括有机器人控制器、输入信息到控制器的运动学模块、任务模块、轨迹规划器,其中:
该任务模块,是一个软件模块,它有主要的两个信息输入口,第一个信息输入口,是直接与机器人控制器相连,这主要是为了示教的输入;第二个信息输入口,是利用串口与PC相连,这主要为编程的输入。
其包括以下步骤:
S1、建立工业机器人的运动学模型,求得工业机器人的运动学的正反解。
该任务点是利用DH方法建立工业机器人各连杆坐标系,并利用连杆参数求出各个坐标系的位姿传递矩阵,将各连杆位姿传递矩阵相乘,得到运动学正解,给定机器人末端位置,求解机器人各关节角度,得到机器人运动学反解。
S2、由任务模块给出工业机器人的任务点的位置信息和姿态信息:
该任务点,是利用示教或利用离线编程给出的,这里的任务点是工业机器人要完成任务需要通过的点,由任务模块给出通过点的位置信息和姿态信息。同时,任务模块还给出完成任务所需要的总时间。
S3、由工业机器人的轨迹规划器结合任务模块,给出基于样条曲线的路径规划曲线:
任务模块给出的工业机器人通过点的个数用N表示,这些点用Pk(xk,yk)(k=1,2...N)表示。这里用三次样条曲线s(xk)连接已知的N个位姿点Pk(xk,yk)(k=1,2...N)间的N-1个区间,在连接点Pk上有s(xk)=yk,而且定义样条函数在x1≤x≤xN上式二次可微的,即这样的样条函数称为C2函数,也就是有连续的二阶导数。设两个连续点Pk(xk,yk)和Pk+1(xk+1,yk+1)间的三次多项式sk(x)及相应的一阶导数和二阶导数如公式(1):
为了便于书写设定如下恒等式,由公式(1)计算可得公式(2):
sk≡s(xk),s′k≡s(x′k),s″k≡s(x″k)
Δxk≡xk+1-xk,Δsk≡sk+1-sk
接下来,将多项式系数都用样条曲线的二阶导数和样条函数值表示。考虑两个样条曲线在连接处函数值及一阶和二阶导数连续,可以得到如下方程(3):
由上式的第一个等式和最后一个等式,可以分别得到公式(4)。
于是各多项式的系数用样条函数及其二阶导数表示如公式(5)。
将(3)的第二个方程的k改为k-1,并将上式带入,得到含有N个未知数的N-2方程组(6)。
(Δxk)s″k+1+2(Δxk-1+Δxk)s″k+(Δxk-1)s″k-1
=6(Δsk/Δxk-Δsk-1/Δxk-1),k=2,3...N-1 (6)
将式(6)整理成矩阵形式,如公式(7)。
As″=6Cs (7)
公式(7)中的符号说明如下:
s=[s1 s2 ... sN]T,s″=[s1″ s″2 ... s″N]T
对于i,j,k=1,2...N-1有如下恒等式。
αk≡Δxk,αi,j≡αi+αj,N′≡N-1,N″≡N-2
βk≡1/αk,βi,j≡βi+βj,N″′≡N-3
需要额外的两个方程来求解,这里使用自然样条曲线,即设s″1=s″N=0。
S4、工业机器人轨迹规划器将产生的路径曲线,结合运动学正反解得到关节空间的信息发给工业机器人的驱动器:
在操作时,利用工业机器人的控制器内所输入的运动学模块,根据轨迹规划器给出的路径曲线,计算关节空间值,发送到工业机器人各关节驱动器。
以上所述,仅为本发明较佳的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应该以权利要求的保护范围为准。
Claims (5)
1.一种基于任务和样条曲线的工业机器人路径规划方法,其包括有机器人控制器、输入信息到控制器的运动学模块、任务模块、轨迹规划器,该规划方法包括以下步骤:
S1、建立工业机器人的运动学模型,求得工业机器人的运动学的正反解;
S2、由所述的任务模块给出工业机器人的任务点的位置信息和姿态信息:
S3、由工业机器人的轨迹规划器结合所述的任务模块,给出基于样条曲线的路径规划曲线:
S4、工业机器人轨迹规划器将产生的路径曲线,结合运动学正反解得到关节空间的信息发给工业机器人的驱动器。
2.根据权利要求1所述的基于任务和样条曲线的工业机器人路径规划方法,其特征在于:所述的任务模块,设有两个信息输入口,所述的第一个信息输入口,是直接与所述的机器人控制器相连;所述的第二个信息输入口,是利用串口与PC相连。
3.根据权利要求1或2所述的基于任务和样条曲线的工业机器人路径规划方法,其特征在于:在步骤S2中的任务点,是利用示教或离线编程给出的,所述的工业机器人要完成任务需要通过的点。
4.根据权利要求3所述的基于任务和样条曲线的工业机器人路径规划方法,其特征在于:所述的路径规划曲线,由下述步骤所得:
定义所述的任务模块给出的工业机器人通过点的个数用N表示,这些点用Pk(xk,yk)(k=1,2...N)表示;这里用三次样条曲线s(xk)连接已知的N个位姿点Pk(xk,yk)(k=1,2...N)间的N-1个区间,在连接点Pk上有s(xk)=yk,而且定义样条函数在x1≤x≤xN上式二次可微的,即这样的样条函数称为C2函数,也就是有连续的二阶导数;设两个连续点Pk(xk,yk)和Pk+1(xk+1,yk+1)间的三次多项式sk(x)及相应的一阶导数和二阶导数如公式(1):
为了便于书写设定如下恒等式,由公式(1)计算可得公式(2):
sk≡s(xk),s′k≡s(x′k),s″k≡s(x″k)
Δxk≡xk+1-xk,Δsk≡sk+1-sk
接下来,将多项式系数都用样条曲线的二阶导数和样条函数值表示;考虑两个样条曲线在连接处函数值及一阶和二阶导数连续,可以得到如下方程(3):
由上式的第一个等式和最后一个等式,可以分别得到公式(4):
于是各多项式的系数用样条函数及其二阶导数表示如公式(5):
将(3)的第二个方程的k改为k-1,并将上式带入,得到含有N个未知数的N-2方程组(6):
(Δxk)s″k+1+2(Δxk-1+Δxk)s″k+(Δxk-1)s″k-1
=6(Δsk/Δxk-Δsk-1/Δxk-1),k=2,3...N-1 (6)
将式(6)整理成矩阵形式,如公式(7):
As″=6Cs(7)
公式(7)中的符号说明如下:
s=[s1 s2 ... sN]T,s″=[s1″ s″2 ... s″N]T
对于i,j,k=1,2...N-1有如下恒等式。
αk≡Δxk,αi,j≡αi+αj,N'≡N-1,N'≡N-2
βk≡1/αk,βi,j≡βi+βj,N″′≡N-3
使用自然样条曲线,即设s1″=s″N=0。
5.根据权利要求3所述的基于任务和样条曲线的工业机器人路径规划方法,其特征在于:在步骤S4中,其中利用工业机器人的控制器内所输入的运动学模块,根据轨迹规划器给出的路径曲线,计算关节空间值,发送到工业机器人各关节驱动器。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210442709.8A CN103802113A (zh) | 2012-11-08 | 2012-11-08 | 基于任务和样条曲线的工业机器人路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210442709.8A CN103802113A (zh) | 2012-11-08 | 2012-11-08 | 基于任务和样条曲线的工业机器人路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN103802113A true CN103802113A (zh) | 2014-05-21 |
Family
ID=50699739
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210442709.8A Pending CN103802113A (zh) | 2012-11-08 | 2012-11-08 | 基于任务和样条曲线的工业机器人路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103802113A (zh) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106802625A (zh) * | 2017-03-14 | 2017-06-06 | 成都工业学院 | 一种导数多维空间机床轨迹运动再现方法 |
CN107116549A (zh) * | 2017-03-15 | 2017-09-01 | 广东工业大学 | 一种基于四阶三次b样条函数的机器人轨迹规划方法及仿人机器人平台 |
CN107538493A (zh) * | 2017-10-20 | 2018-01-05 | 湘潭大学 | 一种避免线缆干涉约束的工业机器人轨迹规划方法 |
WO2018064819A1 (zh) * | 2016-10-08 | 2018-04-12 | 浙江国自机器人技术有限公司 | 一种移动机器人的路线规划方法 |
CN109434840A (zh) * | 2018-12-25 | 2019-03-08 | 珞石(山东)智能科技有限公司 | 一种基于样条曲线的机器人自由路径生成方法 |
CN109648571A (zh) * | 2018-12-28 | 2019-04-19 | 深圳市越疆科技有限公司 | 工业机器人的示教轨迹复现方法、系统及机器人 |
CN113103240A (zh) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | 用于实现c2连续的机器人轨迹规划方法、装置及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101308523A (zh) * | 2008-06-24 | 2008-11-19 | 中国科学院力学研究所 | 一种虚拟激光加工过程几何仿真方法 |
CN101791801A (zh) * | 2010-01-15 | 2010-08-04 | 广东工业大学 | 工业机器人运动规划与性能测试系统及其实现方法 |
CN101837591A (zh) * | 2010-03-12 | 2010-09-22 | 西安电子科技大学 | 基于双群协同竞争粒子群和Ferguson样条的机器人路径规划方法 |
CN102298391A (zh) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | 一种重载工业机器人操作空间内运动轨迹规划方法 |
CN102554938A (zh) * | 2010-12-31 | 2012-07-11 | 中国科学院计算技术研究所 | 机器人的机械手末端轨迹跟踪方法 |
-
2012
- 2012-11-08 CN CN201210442709.8A patent/CN103802113A/zh active Pending
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101308523A (zh) * | 2008-06-24 | 2008-11-19 | 中国科学院力学研究所 | 一种虚拟激光加工过程几何仿真方法 |
CN101791801A (zh) * | 2010-01-15 | 2010-08-04 | 广东工业大学 | 工业机器人运动规划与性能测试系统及其实现方法 |
CN101837591A (zh) * | 2010-03-12 | 2010-09-22 | 西安电子科技大学 | 基于双群协同竞争粒子群和Ferguson样条的机器人路径规划方法 |
CN102554938A (zh) * | 2010-12-31 | 2012-07-11 | 中国科学院计算技术研究所 | 机器人的机械手末端轨迹跟踪方法 |
CN102298391A (zh) * | 2011-04-27 | 2011-12-28 | 哈尔滨工业大学 | 一种重载工业机器人操作空间内运动轨迹规划方法 |
Non-Patent Citations (2)
Title |
---|
陈丹: "基于遗传算法B样条曲线优化在机器人轨迹规划中应用", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
陈伟华: "工业机器人笛卡尔空间轨迹规划的研究", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2018064819A1 (zh) * | 2016-10-08 | 2018-04-12 | 浙江国自机器人技术有限公司 | 一种移动机器人的路线规划方法 |
US10310512B2 (en) | 2016-10-08 | 2019-06-04 | Zhejiang Guozi Robot Technology Co., Ltd. | Path planning method for mobile robots |
CN106802625A (zh) * | 2017-03-14 | 2017-06-06 | 成都工业学院 | 一种导数多维空间机床轨迹运动再现方法 |
CN107116549A (zh) * | 2017-03-15 | 2017-09-01 | 广东工业大学 | 一种基于四阶三次b样条函数的机器人轨迹规划方法及仿人机器人平台 |
CN107538493A (zh) * | 2017-10-20 | 2018-01-05 | 湘潭大学 | 一种避免线缆干涉约束的工业机器人轨迹规划方法 |
CN109434840A (zh) * | 2018-12-25 | 2019-03-08 | 珞石(山东)智能科技有限公司 | 一种基于样条曲线的机器人自由路径生成方法 |
CN109648571A (zh) * | 2018-12-28 | 2019-04-19 | 深圳市越疆科技有限公司 | 工业机器人的示教轨迹复现方法、系统及机器人 |
CN113103240A (zh) * | 2021-04-29 | 2021-07-13 | 哈尔滨工业大学 | 用于实现c2连续的机器人轨迹规划方法、装置及系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103802113A (zh) | 基于任务和样条曲线的工业机器人路径规划方法 | |
CN109159151B (zh) | 一种机械臂空间轨迹跟踪动态补偿方法和系统 | |
CN110497411B (zh) | 一种工业机器人协同运动控制方法 | |
CN105772917B (zh) | 一种三关节点焊机器人轨迹跟踪控制方法 | |
CN105073349B (zh) | 机器人系统的控制方法以及机器人系统 | |
CN106502095B (zh) | 一种多工业机器人的协同控制方法 | |
CN111844128A (zh) | 轨道计划装置以及轨道计划方法 | |
CN106777475B (zh) | 一种有限空间约束的注塑机械臂动力学协同仿真方法 | |
JP6411964B2 (ja) | 工作機械とロボットのリアルタイム干渉確認システム | |
CN104723340A (zh) | 基于连接和阻尼配置的柔性关节机械臂的阻抗控制方法 | |
CN105345823B (zh) | 一种基于空间力信息的工业机器人自由驱动示教方法 | |
CN105382835A (zh) | 一种可穿越腕部奇异点的机器人路径规划方法 | |
CN105382841B (zh) | 一种基于双通道通讯的遥操作双边控制方法 | |
CN105598968B (zh) | 一种并联机械臂的运动规划与控制方法 | |
CN103970139A (zh) | 一种机器人连续点位运动规划方法及其运动控制器 | |
KR102030141B1 (ko) | 로봇의 팔꿈치 제어시스템 및 그 제어방법 | |
CN107538493A (zh) | 一种避免线缆干涉约束的工业机器人轨迹规划方法 | |
CN105892412A (zh) | 基于自定义总线的多轴运动控制系统硬件架构 | |
CN107378952A (zh) | 一种冗余度机械臂末端执行器姿态保持的解决方法 | |
Rea Minango et al. | Combining the STEP-NC standard and forward and inverse kinematics methods for generating manufacturing tool paths for serial and hybrid robots | |
JP2015123517A (ja) | 動作プログラム作成方法およびロボットの制御方法 | |
CN101713965A (zh) | 机器人控制程序编译方法 | |
CN110014427A (zh) | 一种基于伪逆的冗余度机械臂高精度运动规划方法 | |
CN103978324A (zh) | 一种双核五轴焊接机器人控制系统 | |
CN106338966B (zh) | 一种工业机器人轨迹规划编程方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20140521 |