CN106041941A - 一种机械臂的轨迹规划方法及装置 - Google Patents
一种机械臂的轨迹规划方法及装置 Download PDFInfo
- Publication number
- CN106041941A CN106041941A CN201610452034.3A CN201610452034A CN106041941A CN 106041941 A CN106041941 A CN 106041941A CN 201610452034 A CN201610452034 A CN 201610452034A CN 106041941 A CN106041941 A CN 106041941A
- Authority
- CN
- China
- Prior art keywords
- mechanical arm
- intersection point
- joint
- ray
- coordinate
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000033001 locomotion Effects 0.000 claims abstract description 35
- 230000000694 effects Effects 0.000 claims description 15
- 238000004422 calculation algorithm Methods 0.000 claims description 10
- 238000004364 calculation method Methods 0.000 claims description 5
- 238000005457 optimization Methods 0.000 claims 1
- 230000008569 process Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 4
- 238000004519 manufacturing process Methods 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- 230000005540 biological transmission Effects 0.000 description 1
- 238000004590 computer program Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
- 239000004065 semiconductor Substances 0.000 description 1
- 230000001225 therapeutic effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1656—Programme controls characterised by programming, planning systems for manipulators
- B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
- B25J9/161—Hardware, e.g. neural networks, fuzzy logic, interfaces, processor
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Fuzzy Systems (AREA)
- Mathematical Physics (AREA)
- Software Systems (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种机械臂的轨迹规划方法,包括:基于待工作的机械臂的关节参数,生成所述机械臂的工作区域;根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划。本发明还公开了一种机械臂的轨迹规划装置,本发明基于几何的方法来确定机械臂工作区域的边界,从而机器人在运动前就可以提前知道终点的位置,方便机器人进行运动轨迹的规划。
Description
技术领域
本发明涉及机械臂运动轨迹规划领域,尤其涉及一种机械臂的轨迹规划方法及装置。
背景技术
在机械臂的工作过程中,需要对机械臂的轨迹进行规划,一般来说,这种轨迹规划都是通过预定的速度规划算法来实现的,例如,可使用S型(Double S)速度规划算法来完成机械臂的轨迹规划。
有些速度规划算法在进行轨迹规划时,需要事先接收用户提供的起点和终点的位置,然后程序会在两点之间生成一系列的插补点来描述机械臂的运行轨迹。比如在示教功能中,用户通过手持设备发送指令,使得机械臂从起点出发,一直沿某个方向直线运动,直至到达到工作区域的边界(即终点)。
其中,起点位置是由用户指定的,因而可以很简单获得,但是终点的位置(即工作区域的边界)是由机械臂的结构决定的,需要通过监测或计算获得。传统的方法是通过不断监测当前机械臂的是否已经是到达极限位置来实现,但是这种方法需要对路径上所有的位置点进行检测,效率低,且计算量大。
发明内容
针对上述问题,本发明的目的在于提供一种机械臂的轨迹规划方法及装置,在运动前就可以提前知道终点的位置,方便机器人进行运动轨迹的规划。
本发明提供了一种机械臂的轨迹规划方法,包括如下步骤:
基于待工作的机械臂的关节参数,生成所述机械臂的工作区域;
根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;
计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;
基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
优选地,所述机械臂为SCARA型机械臂。
优选地,所述关节参数包括关节类型、关节之间的臂长及关节的活动范围;则所述基于待工作的机械臂的关节参数,生成所述机械臂的工作区域,具体包括:
根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系;
根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
优选地,所述根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述述工作区域的边界的交点,生成交点集合,具体为:
将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程;
根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点;
计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,将所述交点存入预设的集合,生成交点集合。
优选地,所述根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点具体为:
根据预先输入的起点的坐标及移动方向生成一条射线,将所述射线方程与每个圆的方程进行联立,基于参数方程法计算所述射线与每个圆的交点。
优选地,所述根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点具体为:
根据预先输入的起点的坐标及移动方向生成一条射线,基于射线与圆相交测试的优化算法计算所述射线与每个圆的交点。
本发明还提供了一种机械臂的轨迹规划装置,包括:
工作区域生成单元,用于基于待工作的机械臂的关节参数,生成所述机械臂的工作区域;
交点集合生成单元,用于根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;
终点标记单元,用于计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;
运动轨迹规划单元,用于基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
优选地,所述机械臂为SCARA型机械臂。
优选地,所述关节参数包括关节类型、关节之间的臂长及关节的活动范围;则所述工作区域生成单元具体包括:
坐标系生成模块,用于根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系;
工作区域生成模块,用于根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
优选地,所述交点集合生成单元具体包括:
工作区域分解模块,用于将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程;
交点计算模块,用于根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点;
判断模块,用于计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,确定所述交点位于所述弧线上,将所述交点存入预设的集合,生成交点集合。
本发明实施例提供的机械臂的运动轨迹规划方法及装置,通过生成所述机械臂的工作区域,再计算由预先输入的起点的坐标及移动方向生成的射线与工作区域的边界的交点,并获取与起点具有最小距离的交点的坐标,获得与所述起点及移动方向相应的终点,再根据所述起点以及所述终点的坐标进行运动轨迹的规划。本发明基于几何的方法来确定机械臂工作区域的边界因此机器人在运动前就可以提前知道终点的位置,方便机器人进行运动轨迹的规划。
附图说明
为了更清楚地说明本发明的技术方案,下面将对实施方式中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1是本发明实施例提供的机械臂的轨迹规划方法的流程示意图。
图2是SCARA型机械臂的结构示意图。
图3是图2所示的SCARA型机械臂在DH坐标系的示意图。
图4是图2所示的SCARA型机械臂的工作区域示意图。
图5是图4所示的工作区域的俯视图。
图6是射线与工作区域的连接示意图。
图7是本发明实施例提供的通过射线与圆相交测试的优化算法来计算射线与圆的交点的流程示意图。
图8(a)至(c)是图7所示的优化算法的原理图。
图9是本发明实施例提供的机械臂的轨迹规划装置的结构示意图。
图10是图9的工作区域生成单元的结构示意图。
图11是图9的交点集合生成单元的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
请参阅图1,本发明实施例提供一种机械臂的轨迹规划方法,所述机械臂的轨迹规划方法可由机械臂的轨迹规划装置来执行,并至少包括如下步骤:
S101,基于待工作的机械臂的关节参数,生成所述机械臂的工作区域。
在本发明实施例中,机械臂是机器人技术领域中最广泛应用的自动化机械装置,其广泛应用于工业制造、医学治疗、娱乐服务、军事、半导体制造以及太空探索等领域。尽管它们的形态各有不同,但它们都有一个共同的特点,就是能够接受指令,并根据指令精确地定位到三维(或二维)空间上的某一点进行作业。
一般来说,一个机械臂包括若干个关节,每个关节都具有关节参数,所述关节参数可包括关节类型、臂长(连接两个关节的连接臂的长度)、活动范围等。其中,所述关节类型可包括转动关节及滑动关节,转动关节可控制连接臂的转动,而滑动关节可实现连接臂的垂直滑动。通过不同关节的组合,即可控制所述机械臂的工作区域。具体地,可通过如下步骤来确定所述机械臂的工作区域:
S1011,根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系。
如图2所示,以SCARA(Selective Compliant Articulated Robot for Assembly)型机械臂为例,其具有4个关节J1,J2,J3,J4,其中J1,J2,J4为转动关节,且J1与J2,J2与J4通过相应的连接臂进行连接,而J3为滑动关节。当然,应当理解的是,本发明还可应用于其他类型的机械臂,在此不做赘述。
在确定上述关节后,需要针对每个关节建立坐标系,如图3所示,可基于DH(Denavit-Hartenberg)坐标系来建立每个关节的坐标系,其中转动关节Ji的转动轴与各自的zi轴(转动关节Ji的连接臂绕zi轴转动)互相平行,连接臂的臂长为αi,{i│i∈{1,2,4}};滑动关节J3的轴(z3轴)跟J4的轴(z4轴)平行。在确定出zi轴后,可用第一个关节指向第二个关节的方向作为xi方向,而yi的方向可基于右手定则来确定,如此,即生成了每个关节的坐标系。
S1012,根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
在本发明实施例中,在生成每个关节的坐标系后,根据每个关节的活动范围(对于转动关节,其活动范围为其连接臂转动的转动角范围,对于滑动关节,其活动范围为其连接臂的上下运动范围),即可生成所述机械臂的工作区域(如图4所示),此时,只需在平面进行投影即可生成如图5所示的俯视图。
S102,根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合。
具体的,在利用机械臂进行示教时,最常用的功能为用户通过手持设备发送指令,使得所述机械臂从预设的起点出发,并一直沿某个方向直线移动,直至到达到工作区域的边界(终点)。其中,所述机械臂在移动时需事先知道终点才能进行运动轨迹的规划,在本发明实施例中,为了获得所述终点,具体地,可包括:
S1021,将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程。
从图5中可以看出,所述机械臂的工作区域是由四段弧线所围成。而这四段弧线分别位于⊙O1,⊙O2,⊙O3,⊙O4四个圆上。圆心O1,O4与J1轴重合;O2和O3分别为J1轴转动到正负极限时J2轴的位置。和分别是轴Ji的正/负方向的最大活动范围,{ji|-π≤ji≤π}。
这四段弧线的详细参数可参照表1所示:
表1
其中:
S1022,根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点。
在本发明实施例中,假设起点为I,方向向量为n,||n||为方向向量n的单位向量。则此时射线可表示为R(u)=I+u·||n||。
如果起点I位于工作区域内,则射线R(u)必与某圆⊙Oi有交点
其中,在计算交点时,可通过将射线R(u)的方程依次与每个圆的方程进行联立,在利用参数方程法求解获得。
S1023,计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,确定所述交点位于所述弧线上,将所述交点存入预设的集合,生成交点集合。
在本发明实施例中,上述求得的交点中,有些虽然与圆相交,但是并没有位于弧线上,因而需要去除。具体地,如图6所示,射线IP分别与⊙O1相交于点N;与⊙O2相交于点K和点M;与⊙O4相交于点J和点L;与⊙O3没有交点。其中,点K,N虽然在圆上,但是并不在围成所述工作区域的弧线上,所以在得到交点后,还要查看所述交点的弧度角θi是否满足
具体地,假设点s(x,y)是⊙Oi上的一个点,则点s相对于⊙Oi的弧度角θi为:
通过上述公式就可以确定哪些交点是在弧线上,哪些不在。此时,将那些位于弧线上的交点存入预设的集合ξ={κi}中,生成交点集合。
需要说明的是,在本发明的其他实施例中,所述工作区域并不一定是由圆的弧线组成。例如,所述工作区域可能由椭圆的弧线组成或者由不同类型的几何形状的弧线混合组成,此时,同理,可获得这些弧线对应的几何形状的方程及角度范围,再通过上述的方法即可计算生成交点集合,这些技术方案均在本发明的保护范围之内,在此不做赘述。
S103,计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点。
在本发明实施例中,可通过欧拉公式计算得到每个交点与所述起点I的距离,然后对计算得到的每个距离进行比较,获取与最小距离对应的交点的坐标,并将所述交点标记为终点,此时,即得到所需的工作区域的边界。
S104,基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
在本发明实施例中,在获得与所述起点及所述移动方向对应的终点的坐标后,即可根据所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划。
例如,以典型的S型速度规划算法为例,其在接收到所述起点的坐标、所述终点的坐标后,即可规划得到七段运动过程,并通过这七段运动过程实现了将所述机械臂从所述起点(初速度为零)平稳快速的移动到所述终点(末速度也为零)。
综上所述,本发明实施例提供的机械臂的运动轨迹规划方法,通过生成所述机械臂的工作区域,再计算由预先输入的起点的坐标及移动方向生成的射线与工作区域的边界的交点,并获取与起点具有最小距离的交点的坐标,获得与所述起点及移动方向相应的终点,再根据所述起点以及所述终点的坐标进行运动轨迹的规划。本发明基于几何的方法来确定机械臂工作区域的边界因此机器人在运动前就可以提前知道终点的位置,方便机器人进行运动轨迹的规划。
为了便于对本发明的理解,下面将对本发明的一些优选实施例做进一步的描述。
优选地,针对步骤S1022,在生成所述射线后,可以使用传统的参数方程法求交点,也可以使用等提出的基于射线与圆相交测试的优化算法来计算所述射线与每个圆的交点。
具体地,如图7所示,设射线的参数方程为R(u)=I+u·||n||,其中||n||是单位长度。如图8(a)所示,首先计算出从起点I出发到圆心Oi的向量向量的长度以及向量沿着||n||方向的投影若且l<0,则说明起点位于⊙Oi外,且射线的方向沿远离⊙Oi方向延伸,因此所述射线与⊙Oi不相交(如图8(b)所示),此时完成第一次排除测试。否则,利用勾股定理计算出圆心Oi与投影之间距离的平方:m2=a2-l2,若则可以判定射线与圆Oi一定不相交,完成第二次排除测试。如果射线和⊙Oi经过两次排除测试,则就可以判定它们一定相交。接下来,计算射线与⊙Oi的交点:首先,计算出距离然后判断起点I是否位于⊙Oi内,若则说明起点I位于⊙Oi外,此时,所述射线与圆Oi有两个交点,分别为 以及(如图8(a)所示)。若则说明起点I位于圆Oi内,此时,所述射线与圆Oi有一个交点,为I+(l+q)·||n||(如图8(c)所示)。
本优选方案中,在计算射线与圆的交点之前,先通过两次测试判断射线与圆是否有交点,在计算时,仅计算与射线有交点的圆,而不需要对那些与射线没有交点的圆进行计算,如此,减小了计算量,提升了计算效率。
请一并参阅图9,本发明实施例还提供一种机械臂的轨迹规划装置100,其包括:
工作区域生成单元10,用于基于待工作的机械臂的关节参数,生成所述机械臂的工作区域。
交点集合生成单元20,用于根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;
终点标记单元30,用于计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;
运动轨迹规划单元40,用于基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
其中,优选地,所述机械臂为SCARA型机械臂。
其中,优选地,请一并参阅图10,所述工作区域生成单元10具体包括:
坐标系生成模块11,用于根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系。
工作区域生成模块12,用于根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
其中,优选地,请一并参阅图11,所述交点集合生成单元20具体包括:
工作区域分解模块21,用于将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程。
交点计算模块22,用于根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点。
其中,所述交点计算模块22在计算所述射线与每个圆的交点的时候,可直接将所述射线与每个圆进行联立计算得到,也可基于射线与圆相交测试的优化算法计算所述射线与每个圆的交点,本发明不做具体限定。
判断模块23,用于计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,确定所述交点位于所述弧线上,将所述交点存入预设的集合,生成交点集合。
综上所述,本发明实施例提供的机械臂的运动轨迹规划装置100,由所述工作区域生成单元10生成所述机械臂的工作区域,再由交点集合生成单元20计算由预先输入的起点的坐标及移动方向生成的射线与工作区域的边界的交点,并由所述终点标记单元30获取与起点具有最小距离的交点的坐标,获得与所述起点及移动方向相应的终点,最后由运动轨迹规划单元40根据所述起点以及所述终点的坐标进行运动轨迹的规划。本发明基于几何的方法来确定机械臂工作区域的边界因此机器人在运动前就可以提前知道终点的位置,方便机器人进行运动轨迹的规划。
以上所揭露的仅为本发明一种较佳实施例而已,当然不能以此来限定本发明之权利范围,本领域普通技术人员可以理解实现上述实施例的全部或部分流程,并依本发明权利要求所作的等同变化,仍属于发明所涵盖的范围。
本领域普通技术人员可以理解实现上述实施例方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成,所述的程序可存储于一计算机可读取存储介质中,该程序在执行时,可包括如上述各方法的实施例的流程。其中,所述的存储介质可为磁碟、光盘、只读存储记忆体(Read-Only Memory,ROM)或随机存储记忆体(Random AccessMemory,RAM)等。
Claims (10)
1.一种机械臂的轨迹规划方法,其特征在于,包括如下步骤:
基于待工作的机械臂的关节参数,生成所述机械臂的工作区域;
根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;
计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;
基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
2.根据权利要求1所述的机械臂的轨迹规划方法,其特征在于,所述机械臂为SCARA型机械臂。
3.根据权利要求1所述的机械臂的轨迹规划方法,其特征在于,
所述关节参数包括关节类型、关节之间的臂长及关节的活动范围;
则所述基于待工作的机械臂的关节参数,生成所述机械臂的工作区域,具体包括:
根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系;
根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
4.根据权利要求1所述的机械臂的轨迹规划方法,其特征在于,所述根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述述工作区域的边界的交点,生成交点集合,具体为:
将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程;
根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点;
计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,将所述交点存入预设的交点集合,生成交点集合。
5.根据权利要求4所述的机械臂的轨迹规划方法,其特征在于,所述根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点具体为:
根据预先输入的起点的坐标及移动方向生成一条射线,将所述射线方程与每个圆的方程进行联立,基于参数方程法计算所述射线与每个圆的交点。
6.根据权利要求4所述的机械臂的轨迹规划方法,其特征在于,所述根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点具体为:
根据预先输入的起点的坐标及移动方向生成一条射线,基于射线与圆相交测试的优化算法计算所述射线与每个圆的交点。
7.一种机械臂的轨迹规划装置,其特征在于,包括:
工作区域生成单元,用于基于待工作的机械臂的关节参数,生成所述机械臂的工作区域;
交点集合生成单元,用于根据预先输入的起点的坐标及移动方向生成一条射线,并计算所述射线与所述工作区域的边界的交点,生成交点集合;
终点标记单元,用于计算所述交点集合内的每个交点与所述起点的距离,获取与最小距离对应的交点的坐标,并将所述交点标记为终点;
运动轨迹规划单元,用于基于所述起点的坐标以及所述终点的坐标,对所述机械臂的运动轨迹进行规划,以控制所述机械臂根据规划的运动轨迹进行运动。
8.根据权利要求7所述的机械臂的轨迹规划装置,其特征在于,所述机械臂为SCARA型机械臂。
9.根据权利要求7所述的机械臂的轨迹规划装置,其特征在于,
所述关节参数包括关节类型、关节之间的臂长及关节的活动范围;
所述工作区域生成单元具体包括:
坐标系生成模块,用于根据机械臂的关节类型及关节之间的相对位置关系,基于DH坐标系建立生成每个关节的坐标系;
工作区域生成模块,用于根据每个关节的坐标系、每个关节的活动范围及关节之间的臂长,生成所述机械臂的工作区域。
10.根据权利要求7所述的机械臂的轨迹规划装置,其特征在于,所述交点集合生成单元具体包括:
工作区域分解模块,用于将所述工作区域分解为至少两段弧线,获取每段弧线的圆心、半径及圆心角范围,并生成与每段弧线对应的圆的方程;
交点计算模块,用于根据预先输入的起点的坐标及移动方向生成一条射线,计算所述射线与每个圆的交点;
判断模块,用于计算所述交点在所述交点所在的圆上的弧度角,并在所述弧度角位于所述圆心角范围内时,确定所述交点位于所述弧线上,将所述交点存入预设的集合,生成交点集合。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610452034.3A CN106041941B (zh) | 2016-06-20 | 2016-06-20 | 一种机械臂的轨迹规划方法及装置 |
PCT/CN2016/113194 WO2017219640A1 (zh) | 2016-06-20 | 2016-12-29 | 一种机械臂的轨迹规划方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610452034.3A CN106041941B (zh) | 2016-06-20 | 2016-06-20 | 一种机械臂的轨迹规划方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106041941A true CN106041941A (zh) | 2016-10-26 |
CN106041941B CN106041941B (zh) | 2018-04-06 |
Family
ID=57168726
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610452034.3A Active CN106041941B (zh) | 2016-06-20 | 2016-06-20 | 一种机械臂的轨迹规划方法及装置 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN106041941B (zh) |
WO (1) | WO2017219640A1 (zh) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106346478A (zh) * | 2016-11-09 | 2017-01-25 | 广州视源电子科技股份有限公司 | 机械臂的控制方法和装置 |
CN107457780A (zh) * | 2017-06-13 | 2017-12-12 | 广州视源电子科技股份有限公司 | 控制机械臂运动的方法及装置、存储介质和终端设备 |
WO2017219640A1 (zh) * | 2016-06-20 | 2017-12-28 | 广州视源电子科技股份有限公司 | 一种机械臂的轨迹规划方法及装置 |
CN108081270A (zh) * | 2017-12-15 | 2018-05-29 | 中国兵器装备集团自动化研究所 | 一种用于危险物品处理***及控制方法 |
WO2018192178A1 (zh) * | 2017-04-19 | 2018-10-25 | 广州视源电子科技股份有限公司 | 机器人点到点运动控制方法和*** |
CN109129470A (zh) * | 2018-08-02 | 2019-01-04 | 深圳市智能机器人研究院 | 机器人直线路径的规划方法及*** |
CN109285173A (zh) * | 2018-12-24 | 2019-01-29 | 常州节卡智能装备有限公司 | 一种安全防护方法、装置和计算机设备 |
CN109571478A (zh) * | 2018-12-17 | 2019-04-05 | 浙江大学昆山创新中心 | 一种串联多自由度机械臂末端循迹控制方法 |
CN111037551A (zh) * | 2019-12-05 | 2020-04-21 | 上海辛格林纳新时达电机有限公司 | 机器人测试空间的获取方法、装置及机器人*** |
CN112998863A (zh) * | 2021-03-12 | 2021-06-22 | 杭州柳叶刀机器人有限公司 | 机器人安全边界交互方法及装置、电子设备和存储介质 |
CN115153855A (zh) * | 2022-07-29 | 2022-10-11 | 中欧智薇(上海)机器人有限公司 | 一种微型机械臂的定位对准方法、装置及电子设备 |
CN116160141A (zh) * | 2023-03-24 | 2023-05-26 | 中国科学院西安光学精密机械研究所 | 一种零件激光加工干涉检查方法及零件激光加工方法 |
CN116252288A (zh) * | 2023-03-09 | 2023-06-13 | 南京智欧智能技术研究院有限公司 | 一种多自由度平面线控机器人及线控方法 |
CN117984334A (zh) * | 2024-04-03 | 2024-05-07 | 泓浒(苏州)半导体科技有限公司 | 一种自适应晶圆机械臂力矩调整***及方法 |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110456729B (zh) * | 2018-05-07 | 2021-09-28 | 苏州睿牛机器人技术有限公司 | 一种轨迹跟踪控制方法及轨迹跟踪*** |
CN111400891B (zh) * | 2020-03-11 | 2023-08-11 | 中煤航测遥感集团有限公司 | 管道巡检点偏差程度获取方法、装置、设备及存储介质 |
CN113399200B (zh) * | 2020-03-17 | 2022-08-30 | 深圳市腾盛精密装备股份有限公司 | 一种点胶方法及五轴联动点胶机 |
CN114687538B (zh) * | 2020-12-29 | 2023-08-15 | 广东博智林机器人有限公司 | 一种地坪漆涂敷设备的工作方法、装置、设备及介质 |
CN113182701A (zh) * | 2021-03-29 | 2021-07-30 | 大族激光科技产业集团股份有限公司 | 激光加工方法、装置、设备及存储介质 |
CN113989220A (zh) * | 2021-10-25 | 2022-01-28 | 无锡闻泰信息技术有限公司 | 产品运动轨迹计算方法、装置、设备及存储介质 |
CN114700960B (zh) * | 2022-03-02 | 2023-09-08 | 西北工业大学 | 一种阶次优化的远程操控行为轮廓规划方法 |
CN116901073B (zh) * | 2023-08-03 | 2024-07-05 | 南京云创大数据科技股份有限公司 | 多机械臂协同轨迹规划方法、装置、电子设备及存储介质 |
CN116901074A (zh) * | 2023-08-03 | 2023-10-20 | 南京云创大数据科技股份有限公司 | 机械臂轨迹规划方法、装置、存储介质及电子设备 |
CN117454060B (zh) * | 2023-12-22 | 2024-03-19 | 季华实验室 | 直线运动装置位置测量方法、装置、电子设备及存储介质 |
CN118106975B (zh) * | 2024-04-18 | 2024-08-02 | 北京天智航医疗科技股份有限公司 | 基于机器人的复杂空间边界控制方法、装置及机器人 |
CN118258634B (zh) * | 2024-05-30 | 2024-08-09 | 中国检验认证集团山东有限公司 | 基于大数据的橡胶制品取样位置智能定位***及方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4864205A (en) * | 1987-10-09 | 1989-09-05 | Hewlett-Packard Company | Method for coordinated control of motion devices |
JP2001096479A (ja) * | 1999-09-28 | 2001-04-10 | Tatsumo Kk | 水平多関節型産業用ロボット及びその制御方法 |
WO2004095520A3 (en) * | 2003-04-22 | 2005-08-18 | Berkeley Process Control Inc | System of path planning for robotic manipulators based on maximum acceleration and finite jerk constraints |
US7146242B2 (en) * | 2003-09-30 | 2006-12-05 | Rockwell Automation Technologies, Inc. | Method and system for generating multi-dimensional motion profiles |
JP2007042021A (ja) * | 2005-08-05 | 2007-02-15 | Denso Wave Inc | ロボット制御装置 |
CN103227133A (zh) * | 2012-01-31 | 2013-07-31 | 株式会社安川电机 | 传送*** |
CN105415375A (zh) * | 2016-01-02 | 2016-03-23 | 韩少卿 | 一种离线编程装置 |
US20160158936A1 (en) * | 2014-12-09 | 2016-06-09 | Toyota Jidosha Kabushiki Kaisha | Collision avoidance method, control device, and program |
Family Cites Families (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE102009023307A1 (de) * | 2009-05-29 | 2010-12-02 | Kuka Roboter Gmbh | Verfahren und Vorrichtung zur Steuerung eines Manipulators |
DE102012015437A1 (de) * | 2012-08-02 | 2014-05-15 | Kuka Roboter Gmbh | Verfahren und Programmiermittel zur Modifikation einer Roboterbahn |
US9352465B2 (en) * | 2013-11-12 | 2016-05-31 | Canon Kabushiki Kaisha | Control method for robot apparatus and robot apparatus |
EP2898996A1 (en) * | 2014-01-23 | 2015-07-29 | Plum Sp. z o.o. | Method of controlling a robotic system and a robotic system controller for implementing this method |
DE102014011012A1 (de) * | 2014-07-24 | 2016-01-28 | Kuka Roboter Gmbh | Verfahren und Mittel zum Auslegen und/oder Betreiben eines Roboters |
CN104457566A (zh) * | 2014-11-10 | 2015-03-25 | 西北工业大学 | 一种无须示教机器人***的空间定位方法 |
CN105922265B (zh) * | 2016-06-20 | 2018-08-24 | 广州视源电子科技股份有限公司 | 一种机械臂的运动轨迹规划方法、装置及机器人 |
CN106041941B (zh) * | 2016-06-20 | 2018-04-06 | 广州视源电子科技股份有限公司 | 一种机械臂的轨迹规划方法及装置 |
-
2016
- 2016-06-20 CN CN201610452034.3A patent/CN106041941B/zh active Active
- 2016-12-29 WO PCT/CN2016/113194 patent/WO2017219640A1/zh active Application Filing
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4864205A (en) * | 1987-10-09 | 1989-09-05 | Hewlett-Packard Company | Method for coordinated control of motion devices |
JP2001096479A (ja) * | 1999-09-28 | 2001-04-10 | Tatsumo Kk | 水平多関節型産業用ロボット及びその制御方法 |
WO2004095520A3 (en) * | 2003-04-22 | 2005-08-18 | Berkeley Process Control Inc | System of path planning for robotic manipulators based on maximum acceleration and finite jerk constraints |
US7146242B2 (en) * | 2003-09-30 | 2006-12-05 | Rockwell Automation Technologies, Inc. | Method and system for generating multi-dimensional motion profiles |
JP2007042021A (ja) * | 2005-08-05 | 2007-02-15 | Denso Wave Inc | ロボット制御装置 |
CN103227133A (zh) * | 2012-01-31 | 2013-07-31 | 株式会社安川电机 | 传送*** |
US20160158936A1 (en) * | 2014-12-09 | 2016-06-09 | Toyota Jidosha Kabushiki Kaisha | Collision avoidance method, control device, and program |
CN105415375A (zh) * | 2016-01-02 | 2016-03-23 | 韩少卿 | 一种离线编程装置 |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017219640A1 (zh) * | 2016-06-20 | 2017-12-28 | 广州视源电子科技股份有限公司 | 一种机械臂的轨迹规划方法及装置 |
CN106346478A (zh) * | 2016-11-09 | 2017-01-25 | 广州视源电子科技股份有限公司 | 机械臂的控制方法和装置 |
WO2018192178A1 (zh) * | 2017-04-19 | 2018-10-25 | 广州视源电子科技股份有限公司 | 机器人点到点运动控制方法和*** |
CN107457780B (zh) * | 2017-06-13 | 2020-03-17 | 广州视源电子科技股份有限公司 | 控制机械臂运动的方法及装置、存储介质和终端设备 |
CN107457780A (zh) * | 2017-06-13 | 2017-12-12 | 广州视源电子科技股份有限公司 | 控制机械臂运动的方法及装置、存储介质和终端设备 |
CN108081270A (zh) * | 2017-12-15 | 2018-05-29 | 中国兵器装备集团自动化研究所 | 一种用于危险物品处理***及控制方法 |
CN108081270B (zh) * | 2017-12-15 | 2020-05-19 | 中国兵器装备集团自动化研究所 | 一种用于危险物品处理***及控制方法 |
CN109129470A (zh) * | 2018-08-02 | 2019-01-04 | 深圳市智能机器人研究院 | 机器人直线路径的规划方法及*** |
CN109129470B (zh) * | 2018-08-02 | 2021-07-09 | 深圳市智能机器人研究院 | 机器人直线路径的规划方法及*** |
CN109571478B (zh) * | 2018-12-17 | 2021-07-27 | 浙江大学昆山创新中心 | 一种串联多自由度机械臂末端循迹控制方法 |
CN109571478A (zh) * | 2018-12-17 | 2019-04-05 | 浙江大学昆山创新中心 | 一种串联多自由度机械臂末端循迹控制方法 |
CN109285173A (zh) * | 2018-12-24 | 2019-01-29 | 常州节卡智能装备有限公司 | 一种安全防护方法、装置和计算机设备 |
CN111037551B (zh) * | 2019-12-05 | 2022-10-11 | 上海新时达机器人有限公司 | 机器人测试空间的获取方法、装置及机器人*** |
CN111037551A (zh) * | 2019-12-05 | 2020-04-21 | 上海辛格林纳新时达电机有限公司 | 机器人测试空间的获取方法、装置及机器人*** |
CN112998863A (zh) * | 2021-03-12 | 2021-06-22 | 杭州柳叶刀机器人有限公司 | 机器人安全边界交互方法及装置、电子设备和存储介质 |
CN115153855A (zh) * | 2022-07-29 | 2022-10-11 | 中欧智薇(上海)机器人有限公司 | 一种微型机械臂的定位对准方法、装置及电子设备 |
CN116252288A (zh) * | 2023-03-09 | 2023-06-13 | 南京智欧智能技术研究院有限公司 | 一种多自由度平面线控机器人及线控方法 |
CN116160141A (zh) * | 2023-03-24 | 2023-05-26 | 中国科学院西安光学精密机械研究所 | 一种零件激光加工干涉检查方法及零件激光加工方法 |
CN116160141B (zh) * | 2023-03-24 | 2024-01-30 | 中国科学院西安光学精密机械研究所 | 一种零件激光加工干涉检查方法及零件激光加工方法 |
CN117984334A (zh) * | 2024-04-03 | 2024-05-07 | 泓浒(苏州)半导体科技有限公司 | 一种自适应晶圆机械臂力矩调整***及方法 |
CN117984334B (zh) * | 2024-04-03 | 2024-05-28 | 泓浒(苏州)半导体科技有限公司 | 一种自适应晶圆机械臂力矩调整***及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN106041941B (zh) | 2018-04-06 |
WO2017219640A1 (zh) | 2017-12-28 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106041941A (zh) | 一种机械臂的轨迹规划方法及装置 | |
CN107995885A (zh) | 一种坐标系标定方法 、***及装置 | |
CN105922265B (zh) | 一种机械臂的运动轨迹规划方法、装置及机器人 | |
CN107116540B (zh) | 一种基于scs包围结构的机器人碰撞检测方法 | |
Xu et al. | Motion planning for steerable needles in 3D environments with obstacles using rapidly-exploring random trees and backchaining | |
CN103063213B (zh) | 一种焊接机器人与变位机位姿关系的标定方法 | |
Sun et al. | A review of robot control with visual servoing | |
KR20130127936A (ko) | 로봇암의 가능한 위치들을 결정하기 위한 방법 | |
CN105992900A (zh) | 用于计算装置的取向的***和方法 | |
US10513028B2 (en) | Composite work device using link operating device | |
Bi et al. | IoT-based system for communication and coordination of football robot team | |
CN102886592A (zh) | 双曲线轨迹定向切线恒速焊接机器人装置 | |
CN104021249A (zh) | 摆辗上模表面任意一点运动轨迹的精确计算方法 | |
CN110561419B (zh) | 臂型线约束柔性机器人轨迹规划方法及装置 | |
Dash et al. | Singularity-free path planning of parallel manipulators using clustering algorithm and line geometry | |
Yang et al. | A geometric method for kinematics of delta robot and its path tracking control | |
CN109278048A (zh) | 五轴焊接机器人的焊接路径规划方法及五轴焊接机器人 | |
CN108656108A (zh) | 四自由度关节型机器人逆运动学的求解方法 | |
CN104999463B (zh) | 一种基于构形平面的冗余机械臂运动控制方法 | |
CN108153707A (zh) | 一种基于空间变换原理的弧焊机器人直线摆焊方法 | |
CN207997306U (zh) | 一种适用于球面加工的三自由度并联机器人 | |
CN108663989B (zh) | 一种五轴治疗床的逆解工程及轨迹规划算法 | |
CN108189014A (zh) | 一种适用于球面加工的三自由度并联机器人 | |
Nuñez et al. | A design of an autonomous mobile robot base with omnidirectional wheels and plane-based navigation with Lidar sensor | |
Fares et al. | Omnidirectional platform for autonomous mobile industrial robot |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |