CN112356036B - 一种scara机器人轨迹规划方法、装置、设备及存储介质 - Google Patents

一种scara机器人轨迹规划方法、装置、设备及存储介质 Download PDF

Info

Publication number
CN112356036B
CN112356036B CN202011322110.1A CN202011322110A CN112356036B CN 112356036 B CN112356036 B CN 112356036B CN 202011322110 A CN202011322110 A CN 202011322110A CN 112356036 B CN112356036 B CN 112356036B
Authority
CN
China
Prior art keywords
scara robot
joint
motion
equation
end piece
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.)
Active
Application number
CN202011322110.1A
Other languages
English (en)
Other versions
CN112356036A (zh
Inventor
张志明
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing A&e Technologies Co ltd
Original Assignee
Beijing A&e Technologies Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing A&e Technologies Co ltd filed Critical Beijing A&e Technologies Co ltd
Priority to CN202011322110.1A priority Critical patent/CN112356036B/zh
Publication of CN112356036A publication Critical patent/CN112356036A/zh
Application granted granted Critical
Publication of CN112356036B publication Critical patent/CN112356036B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1656Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Automation & Control Theory (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种SCARA机器人轨迹规划方法、装置、设备及存储介质,该SCARA机器人轨迹规划方法应用于SCARA机器人各个关节的运动控制,包括:获取SCARA机器人末端件在起始点和终止点之间的平面位置;将该平面位置进行归一化处理,得到运动控制参数;对各个关节分别建立关于运动控制参数的运动轨迹方程,运动轨迹方程用于输出给SCARA机器人以控制其各个关节的轨迹。通过一个共同的运动控制参数,将各个旋转关节的角位移和移动关节的位移联系起来,实现了SCARA机器人各个旋转关节和移动关节的联动,可使末端件沿着期望的轨迹运动,确保末端件位置的精确性。

Description

一种SCARA机器人轨迹规划方法、装置、设备及存储介质
技术领域
本发明涉及机器人轨迹规划技术领域,更具体地说,涉及一种SCARA机器人轨迹规划方法、装置、设备及存储介质。
背景技术
SCARA机器人包括三个旋转关节和一个移动关节,三个旋转关节的轴线相互平行,且该轴线平行于移动关节的运动方向,三个旋转关节用于实现末端件在平面内的定位和定向,移动关节则实现末端件在垂直于该平面方向的直线运动。
因此,SCARA机器人最适用于平面定位且垂直方向进行装配的作业,例如,将一个圆头针插入配对的圆孔,或者搬动和取放物件。此时,三个旋转关节在水平面内转动,使得末端件自起始点的水平位置运动到终止点的水平位置处,移动关节在垂直方向运动,实现末端件在高度方向的位置变化,最终将末端件送到指定位置点。
现有技术中,通常采用点到点的运动或轨迹跟踪运动来分别对各个旋转关节和移动关节的轨迹进行单独规划。也即,对于单个关节的运动而言,旋转关节对旋转方向上的转动角度按照一定规律进行插补,移动关节则对移动方向上的位移进行插补。
对于点到点的运动来说,在轨迹规划时,只关心起始点和目标点,对运动路径并没有限制,因此,只需要在关节空间对每个关节分别进行运动规划,以保证机器人的运动平稳性即可,此时,各个关节可以有不同的运动时间。
例如,通过设定起点、目标点以及末端件需要达到的高度,进行点到点规划,并且在必要的拐点进行轨迹平滑,使得末端件能够顺利过渡,末端件的运动轨迹如图7所示。
按照此方法进行规划时,主要是通过控制机器人各个关节的运动,使机器人的末端件到达目标位姿,因此机器人各个关节无需联动,各个关节也可具有不同的运动时间。比如,在SCARA机器人搬动取放作业过程中,对于AB段或EF段轨迹,只需要机器人的移动关节进行运动,机器人的旋转关节保持静止,进入平滑阶段BC段或DE段后,旋转关节才开始和移动关节同时运动。
对于轨迹跟踪运动来说,在轨迹规划时,根据规划出的各个路径点处的机器人位置与姿态,通过逆运动学求取机器人各个关节的目标位置,然后,通过分别单独规划各个关节的运动,使机器人的末端件到达路径上各点处的期望位姿;在此过程中,虽然各个关节是同时运动的,各个关节的运动却是相互独立,互不干涉的。
显然,上述两种运动方式均没有实现各个关节之间的联动,其本质均是点到点的运动,对于轨迹跟踪运动来说,也只是能够保证路径上各个位置点处各个关节的对应位置关系,但是由于各个路径点之间的路径无法保证,因此,存在一定的不确定性,末端件的位置精度低。
综上所述,如何使得SCARA机器人各个关节之间实现联动,以提高SCARA机器人末端件的位置精度,是目前本领域技术人员亟待解决的问题。
发明内容
有鉴于此,本发明的目的是提供一种SCARA机器人轨迹规划方法,以减小SCARA机器人末端件位姿的不确定性,提高末端件的位置精度。
本发明的另一目的是提供一种SCARA机器人轨迹规划装置、设备和存储介质,具有上述有益效果。
为了实现上述目的,本发明提供如下技术方案:
一种SCARA机器人轨迹规划方法,应用于SCARA机器人各个关节的运动控制,包括:
获取SCARA机器人的末端件在起始点和终止点之间的平面位置;
将所述平面位置进行归一化处理,得到运动控制参数,记为u,u∈[0,1];
对所述SCARA机器人的各个关节分别建立关于所述运动控制参数的运动轨迹方程,所述运动轨迹方程用于输出给所述SCARA机器人以控制其各个关节的轨迹。
优选地,对所述SCARA机器人的各个关节分别建立关于所述运动控制参数的运动轨迹方程,包括:
对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程。
优选地,对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程,包括:
分别建立所述SCARA机器人各个旋转关节的角位移与所述运动控制参数之间的一次函数通用方程,所述一次函数通用方程为:
Figure BDA0002793207040000031
其中,i=1,2,3,表示所述SCARA机器人的三个旋转关节;
Figure BDA0002793207040000032
为第i个旋转关节的角位移;ki为第i个旋转关节的一次函数通用方程的系数;ci为第i个旋转关节的一次函数通用方程的常数项;
获取所述末端件在所述起始点时各个所述旋转关节的角位移
Figure BDA0002793207040000033
以及所述末端件在所述终止点时各个所述旋转关节的角位移
Figure BDA0002793207040000034
其中,所述末端件在所述起始点时,u=0;所述末端件在所述终止点时,u=1;
根据
Figure BDA0002793207040000035
Figure BDA0002793207040000036
结合u的对应取值,计算得到ki和ci的具体值。
优选地,对所述SCARA机器人的各个关节分别建立关于所述运动控制参数的运动轨迹方程,包括:
对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程。
优选地,对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程,包括:
建立所述SCARA机器人的移动关节的位移与所述运动控制参数的二次函数通用方程,所述二次函数通用方程为:
h=au2+bu+c,a≠0
其中,h为所述末端件的高度位移;a为二次项系数,b为一次项系数,c为常数项;
获取所述末端件在所述起始点的高度h0、所述末端件在所述终止点的高度h1以及所述末端件的最大高度hmax,其中,所述末端件在所述起始点时,u=0;所述末端件在所述终止点时,u=1;所述末端件达到所述最大高度hmax时,对应的u=-b/2a;
根据h0、h1和hmax,结合u的对应取值,计算得到a,b和c的具体值。
一种SCARA机器人轨迹规划装置,包括:
平面位置获取模块,用于获取SCARA机器人的末端件在起始点和终止点之间的平面位置;
归一化处理模块,用于将所述平面位置进行归一化处理,得到运动控制参数u,u∈[0,1];
运动轨迹方程建立模块,用于对所述SCARA机器人的各个关节分别建立关于所述运动控制参数的运动轨迹方程,所述运动轨迹方程用于输出给所述SCARA机器人以控制其各个关节的轨迹。
优选地,所述运动轨迹方程建立模块包括:
旋转关节运动轨迹方程建立模块,用于对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程。
优选地,所述运动轨迹方程建立模块包括:
移动关节运动轨迹方程建立模块,用于对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程。
一种SCARA机器人轨迹规划设备,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现上述任意一种SCARA机器人轨迹规划方法的步骤。
一种计算机可读存储介质,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现上述任意一种SCARA机器人轨迹规划方法的步骤。
本发明提供的SCARA机器人轨迹规划方法,通过将SCARA机器人的末端件在起始点和终止点之间的平面位置进行归一化处理,得到一个平面位置参数,将该平面位置参数作为各个关节共同的运动控制参数,对SCARA机器人的各个关节分别进行运动轨迹规划。
也即,通过同一个运动控制参数u来分别对SCARA机器人的各个旋转关节及其移动关节进行轨迹规划,当运动控制参数u变化时,通过各个旋转关节的角位移与运动控制参数之间的函数关系,可以确定出末端件在各个平面位置点处时,SCARA机器人各个旋转关节的角位移;同时,通过移动关节的位移与运动控制参数之间的函数关系,可以确定出末端件在各个平面位置点处时,SCARA机器人的移动关节的位移,也即,确定末端件在各个平面位置点的高度位置。
由于对各个关节的规划中采用了同一个运动控制参数u,通过该运动控制参数u可以将SCARA机器人各个旋转关节的角位移和SCARA机器人的移动关节的位移联系起来,换句话说,实现了SCARA机器人各个旋转关节和移动关节的联动,从而可以使末端件沿着期望的轨迹进行运动,确保SCARA机器人末端件位置的精确性。
本发明提供的SCARA机器人轨迹规划装置、SCARA机器人轨迹规划设备以及计算机可读存储介质,均具有上述有益效果。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其它的附图。
图1为本发明具体实施例一所提供的SCARA机器人轨迹规划方法的流程图;
图2为本发明具体实施例二所提供的SCARA机器人轨迹规划方法的流程图;
图3为本发明具体实施例所提供的SCARA机器人旋转关节的一次函数运动轨迹方程的图像;
图4为本发明具体实施例所提供的SCARA机器人移动关节的二次函数运动轨迹方程的图像;
图5为本发明具体实施例提供的SCARA机器人轨迹规划装置的结构图;
图6为本发明具体实施例提供的SCARA机器人轨迹规划设备的结构图;
图7为现有技术中机器人末端件的运动轨迹示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其它实施例,都属于本发明保护的范围。
本发明的核心是提供一种SCARA机器人轨迹规划方法,以减小SCARA机器人末端件位姿的不确定性,提高末端件的位置精度。本发明的另一核心是提供一种SCARA机器人轨迹规划装置、设备和存储介质,具有上述有益效果。
请参考图1-图4,图1为本发明具体实施例一所提供的SCARA机器人轨迹规划方法的流程图;图2为本发明具体实施例二所提供的SCARA机器人轨迹规划方法的流程图;图3为本发明具体实施例所提供的SCARA机器人旋转关节的一次函数运动轨迹方程的图像;图4为本发明具体实施例所提供的SCARA机器人移动关节的二次函数运动轨迹方程的图像。
本发明提供一种SCARA机器人轨迹规划方法,应用于SCARA机器人各个关节的运动控制,包括步骤S1至步骤S3:
步骤S1:获取SCARA机器人的末端件在起始点和终止点之间的平面位置。
需要说明的是,平面位置是指SCARA机器人的末端件在与SCARA机器人各旋转关节的转动平面相平行的平面内的位置坐标,或者说,平面位置是指SCARA机器人的末端件在垂直于SCARA机器人移动关节移动方向的平面内的位置坐标。
步骤S2:将该平面位置进行归一化处理,得到运动控制参数,记为u,u∈[0,1]。
可以理解的是,将SCARA机器人的末端件在起始点和终止点之间的平面位置进行归一化处理,得到的运动控制参数是与末端件的平面位置相关的变量,也即,运动控制参数与平面位置具有一定的对应关系。
步骤S3:对SCARA机器人的各个关节分别建立关于运动控制参数的运动轨迹方程,运动轨迹方程用于输出给SCARA机器人以控制其各个关节的轨迹。
需要说明的是,对SCARA机器人的各个旋转关节分别建立关于运动控制参数的运动轨迹方程,是指分别建立各个旋转关节的角位移与运动控制参数之间的函数关系;对SCARA机器人的移动关节建立关于运动控制参数的运动轨迹方程,是指建立移动关节的位移与运动控制参数之间的函数关系。
可以理解的是,SCARA机器人的各个旋转关节在垂直于其移动关节的移动方向的平面内转动,用于实现末端件在平面内的定位和定向,因此,末端件在平面内的各个位置点时,SCARA机器人的各个旋转关节具有对应的角位移,也即,SCARA机器人的各个旋转关节的角位移与运动控制参数之间具有一定的对应关系,因此,可通过建立SCARA机器人的各个旋转关节的角位移与运动控制参数之间的函数关系,来规划SCARA机器人各个旋转关节的运动轨迹。
同理,SCARA机器人的移动关节用于实现末端件在垂直于上述平面的方向上的直线运动,以改变末端件的高度位置。显然,末端件在平面内的各个位置点时,具有与各个平面位置点相对应的高度位置,末端件在各个平面位置点的高度位置则由SCARA机器人的移动关节的位移决定,也即,SCARA机器人的移动关节的位移与运动控制参数之间具有一定的对应关系,因此,可通过建立SCARA机器人的移动关节的位移与运动控制参数之间的函数关系,来规划SCARA机器人移动关节的运动轨迹。
由此可以看出,本发明可以通过同一个运动控制参数u来分别对SCARA机器人的各个旋转关节及其移动关节进行轨迹规划,当运动控制参数u变化时,通过各个旋转关节的角位移与运动控制参数之间的函数关系,可以确定出末端件在各个平面位置点处时,SCARA机器人各个旋转关节的角位移;同时,通过移动关节的位移与运动控制参数之间的函数关系,可以确定出末端件在各个平面位置点处时,SCARA机器人的移动关节的位移,也即,确定末端件在各个平面位置点的高度位置。
也即,通过一个共同的运动控制参数u,将SCARA机器人各个旋转关节的角位移和SCARA机器人的移动关节的位移联系起来,换句话说,实现了SCARA机器人各个旋转关节和移动关节的联动,从而可以使末端件沿着期望的轨迹进行运动,确保SCARA机器人末端件位置的精确性。
需要说明的是,本发明对SCARA机器人各个旋转关节的角位移与运动控制参数之间的具体函数关系不做限定,各个旋转关节的角位移与运动控制参数之间可以是一次函数关系、二次函数关系或其它函数关系。
考虑到运动的简单及便于实现性,在上述实施例的基础之上,对SCARA机器人的各个关节分别建立关于运动控制参数的运动轨迹方程,包括步骤S31:
步骤S31:对SCARA机器人的各个旋转关节分别建立关于运动控制参数的一次函数运动轨迹方程。
也即,各个旋转关节的角位移与运动控制参数之间是一次函数关系,这样,使得各个旋转关节的运动简单,便于实现各个旋转关节的快速运动。
为了确定具体的该一次函数运动轨迹方程,在上述实施例的基础之上,对SCARA机器人的各个旋转关节分别建立关于运动控制参数的一次函数运动轨迹方程,包括:
分别建立SCARA机器人各个旋转关节的角位移与运动控制参数之间的一次函数通用方程,一次函数通用方程为:
Figure BDA0002793207040000081
其中,i=1,2,3,表示SCARA机器人的三个旋转关节;
Figure BDA0002793207040000082
为第i个旋转关节的角位移;ki为第i个旋转关节的一次函数通用方程的系数;ci为第i个旋转关节的一次函数通用方程的常数项。
获取末端件在起始点时各个旋转关节的角位移
Figure BDA0002793207040000083
以及末端件在终止点时各个旋转关节的角位移
Figure BDA0002793207040000091
其中,末端件在起始点时,u=0;末端件在终止点时,u=1。
根据
Figure BDA0002793207040000092
Figure BDA0002793207040000093
结合u的对应取值,计算得到ki和ci的具体值。
由此可得到确定的一次函数运动轨迹方程,即:将ki和ci的具体值代入一次函数通用方程
Figure BDA0002793207040000094
后得到的具体方程,据此方程可规划出SCARA机器人三个旋转关节的运动轨迹,进而可控制各个旋转关节按此轨迹进行运动。
例如,设定末端件在起始点时,u=0,SCARA机器人的某一旋转关节的角位移为
Figure BDA0002793207040000095
末端件在终止点时,u=1,SCARA机器人该旋转关节的角位移为
Figure BDA0002793207040000096
则,将u=0,
Figure BDA0002793207040000097
和u=1,
Figure BDA0002793207040000098
分别代入
Figure BDA0002793207040000099
后,可求得:c=-20,ki=20;此时,该旋转关节的一次函数运动轨迹方程为:
Figure BDA00027932070400000910
如图3所示,图3中,运动控制参数u以0.01为间距示出,等间距取值,即u=0,0.01,0.02,…,1。
另外,需要说明的是,本发明对SCARA机器人移动关节的位移与运动控制参数之间的具体函数关系不做限定,移动关节的位移与运动控制参数之间可以是一次函数关系、二次函数关系或其它函数关系等。
考虑到移动关节运动实现的方便性,同时保证末端件在拐角处运动的连续性,避免产生抖动或跳变等,在上述实施例的基础之上,对SCARA机器人的各个关节分别建立关于运动控制参数的运动轨迹方程,包括步骤S32:
步骤S32:对SCARA机器人的移动关节建立关于运动控制参数的二次函数运动轨迹方程。
可以理解的是,末端件的平面位置与时间参数之间具有一定的关系,也即,运动控制参数实质上与时间参数相关,这里之所以将移动关节的位移与运动控制参数之间建立二次函数关系,是为了能够对运动控制参数求取二阶倒数,以保证移动关节加速度的连续性,从而保证末端件在拐角处能够平滑过渡,以避免末端件在拐角处产生抖动和跳变。
为了确定具体的该二次函数运动轨迹方程,在上述实施例的基础之上,对SCARA机器人的移动关节建立关于运动控制参数的二次函数运动轨迹方程,包括:
建立SCARA机器人的移动关节的位移与运动控制参数的二次函数通用方程,二次函数通用方程为:
h=au2+bu+c,a≠0,
其中,h为末端件的高度位移;a为二次项系数,b为一次项系数,c为常数项。
获取末端件在起始点的高度h0、末端件在终止点的高度h1以及末端件的最大高度hmax,其中,末端件在起始点时,u=0;末端件在终止点时,u=1;末端件达到最大高度hmax时,对应的u=-b/2a。
根据h0、h1和hmax,结合u的对应取值,计算得到a,b和c的具体值。
由此可得到确定的二次函数运动轨迹方程,即:将a,b和c的具体值代入二次函数通用方程h=au2+bu+c后得到的具体方程,据此方程可规划出SCARA机器人的移动关节的运动轨迹,进而可控制移动关节按此轨迹进行运动。
例如,设定末端件在起始点时,u=0,SCARA机器人末端件的高度为h0=10cm;末端件在终止点时,u=1,末端件的高度为h1=30cm;末端件相对起始点需要抬起的高度为35cm,也即,hmax=45cm,此时,u=-b/2a,将u=0,h0=10,u=1,h1=30cm以及u=-b/2a,hmax=45分别代入h=au2+bu+c后,可求得a,b和c的值,进而可绘制出二次函数运动轨迹方程的图像,如图4所示,图4中,运动控制参数u以0.01为间距示出,等间距取值,即u=0,0.01,0.02,…,1。
请参考图5,为本发明具体实施例提供的SCARA机器人轨迹规划装置的结构图。
除了上述SCARA机器人轨迹规划方法,本发明还提供一种实现上述SCARA机器人轨迹规划方法的SCARA机器人轨迹规划装置,该SCARA机器人轨迹规划装置与上述方法实施例相对应,下文描述的SCARA机器人轨迹规划装置与上文描述的SCARA机器人轨迹规划方法可相互对应参照。
该SCARA机器人轨迹规划装置包括:
平面位置获取模块,用于获取SCARA机器人的末端件在起始点和终止点之间的平面位置。
归一化处理模块,用于将SCARA机器人的末端件在起始点和终止点之间的平面位置进行归一化处理,得到运动控制参数u,u∈[0,1]。
运动轨迹方程建立模块,用于对SCARA机器人的各个关节分别建立关于运动控制参数的运动轨迹方程,运动轨迹方程用于输出给SCARA机器人以控制其各个关节的轨迹。
显然,本发明实施例提供的SCARA机器人轨迹规划装置,具有上述SCARA机器人轨迹规划方法具有的有益效果。
在上述实施例的基础之上,运动轨迹方程建立模块包括:
旋转关节运动轨迹方程建立模块,用于对SCARA机器人的各个旋转关节分别建立关于运动控制参数的一次函数运动轨迹方程。
进一步地,旋转关节运动轨迹方程建立模块包括:
一次函数通用方程建立模块,用于分别建立SCARA机器人各个旋转关节的角位移与运动控制参数之间的一次函数通用方程,一次函数通用方程为:
Figure BDA0002793207040000111
角位移获取模块,用于获取末端件在起始点时各个旋转关节的角位移
Figure BDA0002793207040000112
以及末端件在终止点时各个旋转关节的角位移
Figure BDA0002793207040000113
其中,末端件在起始点时,u=0;末端件在终止点时,u=1。
第一系数计算模块,用于根据
Figure BDA0002793207040000114
Figure BDA0002793207040000115
结合u的对应取值,计算得到ki和ci的具体值,进而可确定
Figure BDA0002793207040000116
的具体方程。
另外,在上述实施例的基础之上,运动轨迹方程建立模块包括:
移动关节运动轨迹方程建立模块,用于对SCARA机器人的移动关节建立关于运动控制参数的二次函数运动轨迹方程。
进一步地,移动关节运动轨迹方程建立模块包括:
二次函数通用方程建立模块,用于建立SCARA机器人的移动关节的位移与运动控制参数的二次函数通用方程,二次函数通用方程为:
h=au2+bu+c,a≠0。
高度获取模块,用于获取末端件在起始点的高度h0、末端件在终止点的高度h1以及末端件的最大高度hmax,其中,末端件在起始点时,u=0;末端件在终止点时,u=1;末端件达到最大高度hmax时,对应的u=-b/2a。
第二系数计算模块,用于根据h0、h1和hmax,结合u的对应取值,计算得到a,b和c的具体值,进而可确定h=au2+bu+c的具体方程。
请参见图6,图6为本发明具体实施例所提供的SCARA机器人轨迹规划设备的结构图,该SCARA机器人轨迹规划设备相应于上述SCARA机器人轨迹规划方法的实施例,可以包括:
存储器21,用于存储计算机程序;
处理器22,用于执行上述存储器21存储的计算机程序时实现如上述任意一个实施例公开的SCARA机器人轨迹规划方法的步骤。
本发明实施例提供的SCARA机器人轨迹规划设备,具有上述SCARA机器人轨迹规划方法的有益效果。
对于本发明提供的SCARA机器人轨迹规划设备的介绍请参照上述方法实施例,本发明在此不做赘述。
相应于上面的方法实施例,本发明还提供一种计算机可读存储介质,计算机可读存储介质上存储有计算机程序,计算机程序被处理器执行时实现如上述任意一个实施例公开的SCARA机器人轨迹规划方法的步骤。
本发明实施例提供的计算机可读存储介质,具有上述SCARA机器人轨迹规划方法的有益效果。
该计算机可读存储介质可以包括:U盘、移动硬盘、只读存储器(Read-OnlyMemory,ROM)、随机存取存储器(Random Access Memory,RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
对于本发明提供的计算机可读存储介质的介绍请参照上述方法实施例,本发明在此不做赘述。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其它实施例的不同之处,各个实施例之间相同相似部分互相参见即可。
以上对本发明所提供的SCARA机器人轨迹规划方法、装置、设备及存储介质进行了详细介绍。本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以对本发明进行若干改进和修饰,这些改进和修饰也落入本发明权利要求的保护范围内。

Claims (6)

1.一种SCARA机器人轨迹规划方法,应用于SCARA机器人各个关节的运动控制,其特征在于,包括:
获取SCARA机器人的末端件在起始点和终止点之间的平面位置;
将所述平面位置进行归一化处理,得到运动控制参数,记为u,u∈[0,1];
对所述SCARA机器人的移动关节和各个旋转关节分别建立关于所述运动控制参数的运动轨迹方程,所述运动轨迹方程用于输出给所述SCARA机器人以控制其各个关节的轨迹;
其中,对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的运动轨迹方程,包括:
对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程;
对所述SCARA机器人的移动关节建立关于所述运动控制参数的运动轨迹方程,包括:
对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程。
2.根据权利要求1所述的SCARA机器人轨迹规划方法,其特征在于,对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程,包括:
分别建立所述SCARA机器人各个旋转关节的角位移与所述运动控制参数之间的一次函数通用方程,所述一次函数通用方程为:
Figure FDA0003798486760000011
其中,i=1,2,3,表示所述SCARA机器人的三个旋转关节;
Figure FDA0003798486760000012
为第i个旋转关节的角位移;ki为第i个旋转关节的一次函数通用方程的系数;ci为第i个旋转关节的一次函数通用方程的常数项;
获取所述末端件在所述起始点时各个所述旋转关节的角位移
Figure FDA0003798486760000013
以及所述末端件在所述终止点时各个所述旋转关节的角位移
Figure FDA0003798486760000014
其中,所述末端件在所述起始点时,u=0;所述末端件在所述终止点时,u=1;
根据
Figure FDA0003798486760000015
Figure FDA0003798486760000016
结合u的对应取值,计算得到ki和ci的具体值。
3.根据权利要求1或2所述的SCARA机器人轨迹规划方法,其特征在于,对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程,包括:
建立所述SCARA机器人的移动关节的位移与所述运动控制参数的二次函数通用方程,所述二次函数通用方程为:
h=au2+bu+c,a≠0
其中,h为所述末端件的高度位移;a为二次项系数,b为一次项系数,c为常数项;
获取所述末端件在所述起始点的高度h0、所述末端件在所述终止点的高度h1以及所述末端件的最大高度hmax,其中,所述末端件在所述起始点时,u=0;所述末端件在所述终止点时,u=1;所述末端件达到所述最大高度hmax时,对应的u=-b/2a;
根据h0、h1和hmax,结合u的对应取值,计算得到a,b和c的具体值。
4.一种SCARA机器人轨迹规划装置,其特征在于,包括:
平面位置获取模块,用于获取SCARA机器人的末端件在起始点和终止点之间的平面位置;
归一化处理模块,用于将所述平面位置进行归一化处理,得到运动控制参数u,u∈[0,1];
运动轨迹方程建立模块,用于对所述SCARA机器人的各个关节分别建立关于所述运动控制参数的运动轨迹方程,所述运动轨迹方程用于输出给所述SCARA机器人以控制其各个关节的轨迹;
其中,所述运动轨迹方程建立模块包括:
旋转关节运动轨迹方程建立模块,用于对所述SCARA机器人的各个旋转关节分别建立关于所述运动控制参数的一次函数运动轨迹方程;
移动关节运动轨迹方程建立模块,用于对所述SCARA机器人的移动关节建立关于所述运动控制参数的二次函数运动轨迹方程。
5.一种SCARA机器人轨迹规划设备,其特征在于,包括:
存储器,用于存储计算机程序;
处理器,用于执行所述计算机程序时实现如权利要求1至3任一项所述SCARA机器人轨迹规划方法的步骤。
6.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质上存储有计算机程序,所述计算机程序被处理器执行时实现如权利要求1至3任一项所述SCARA机器人轨迹规划方法的步骤。
CN202011322110.1A 2020-11-23 2020-11-23 一种scara机器人轨迹规划方法、装置、设备及存储介质 Active CN112356036B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011322110.1A CN112356036B (zh) 2020-11-23 2020-11-23 一种scara机器人轨迹规划方法、装置、设备及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011322110.1A CN112356036B (zh) 2020-11-23 2020-11-23 一种scara机器人轨迹规划方法、装置、设备及存储介质

Publications (2)

Publication Number Publication Date
CN112356036A CN112356036A (zh) 2021-02-12
CN112356036B true CN112356036B (zh) 2022-11-25

Family

ID=74533124

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011322110.1A Active CN112356036B (zh) 2020-11-23 2020-11-23 一种scara机器人轨迹规划方法、装置、设备及存储介质

Country Status (1)

Country Link
CN (1) CN112356036B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114227655B (zh) * 2021-12-30 2024-06-04 深圳市英威腾电气股份有限公司 确定规划路径的方法、装置、scara机器人及介质

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104191428B (zh) * 2014-08-27 2016-04-27 深圳科瑞技术股份有限公司 一种基于scara机械手的运动轨迹规划方法及系统
CN105068536B (zh) * 2015-08-13 2017-12-15 吉林大学 基于非线性优化方法实现的移动基座轨迹规划器
CN105500354B (zh) * 2016-02-02 2017-05-17 南京埃斯顿机器人工程有限公司 一种工业机器人应用的过渡轨迹规划方法
CN106112951A (zh) * 2016-07-01 2016-11-16 广州霞光技研有限公司 多自由度主从式遥操作机械手控制方法
JP6859756B2 (ja) * 2017-03-03 2021-04-14 オムロン株式会社 制御システム、コントローラ、制御方法、および制御プログラム
CN107139173A (zh) * 2017-06-15 2017-09-08 华南理工大学 一种工业机器人门型轨迹插补方法
CN109623825B (zh) * 2018-12-30 2021-11-16 深圳市越疆科技有限公司 一种移动轨迹规划方法、装置、设备和存储介质

Also Published As

Publication number Publication date
CN112356036A (zh) 2021-02-12

Similar Documents

Publication Publication Date Title
CN104339349B (zh) 机器人装置及机器人控制方法
CN113334393B (zh) 一种机械臂控制方法、系统、机器人及存储介质
WO2022062464A1 (zh) 基于计算机视觉的手眼标定方法及装置、存储介质
CN109352648B (zh) 机械机构的控制方法、装置和电子设备
CN110955262B (zh) 光伏组件清洁机器人的路径规划与跟踪的控制方法及系统
CN112356036B (zh) 一种scara机器人轨迹规划方法、装置、设备及存储介质
CN114670191B (zh) 一种七自由度肘偏置机械臂轨迹规划方法
CN114043479B (zh) 一种误差矫正的地坪磨抛机器人轨迹纠偏方法及装置
CN111427361A (zh) 一种回充方法、回充装置及机器人
CN111844130A (zh) 一种修正机器人末端工具位姿的方法和装置
CN111687838A (zh) 机械手轨迹跟随误差的在线补偿方法、系统及存储介质
CN108189034A (zh) 一种机器人连续轨迹实现方法
CN113524201A (zh) 机械臂位姿主动调节方法、装置、机械臂和可读存储介质
CN116019564B (zh) 膝关节手术机器人和控制方法
JP5948914B2 (ja) ロボット制御装置、ロボット制御方法、ロボット制御プログラムおよびロボットシステム
CN113787518A (zh) 一种机器人末端姿态控制方法、装置、设备及存储介质
CN112034869B (zh) 一种无人机变参神经动力学控制器的设计方法及其应用
Cunha et al. Vision-based control for rigid body stabilization
CN112847373A (zh) 一种机器人轨迹同步控制方法、计算机可读存储介质
JP5157545B2 (ja) 全身協調装置、ロボット及びロボットの制御方法
Ostanin et al. Programming by Demonstration Using Two-Step Optimization for Industrial Robot.
CN114800488B (zh) 一种基于深度强化学习的冗余机械臂可操作度优化方法及装置
CN113650010B (zh) 一种乒乓球机器人的运动控制方法、系统及存储介质
CN110231823B (zh) 一种双轮机器人的直接控制方法
Gans et al. Performance tests of partitioned approaches to visual servo control

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant