CN110653826B - 一种面向传送带目标跟随的机器人实时轨迹规划方法 - Google Patents

一种面向传送带目标跟随的机器人实时轨迹规划方法 Download PDF

Info

Publication number
CN110653826B
CN110653826B CN201911014355.5A CN201911014355A CN110653826B CN 110653826 B CN110653826 B CN 110653826B CN 201911014355 A CN201911014355 A CN 201911014355A CN 110653826 B CN110653826 B CN 110653826B
Authority
CN
China
Prior art keywords
robot
target object
interpolation
coordinate system
matrix
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
CN201911014355.5A
Other languages
English (en)
Other versions
CN110653826A (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.)
Suzhou Elite Robot Co Ltd
Original Assignee
Suzhou Elite Robot 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 Suzhou Elite Robot Co Ltd filed Critical Suzhou Elite Robot Co Ltd
Priority to CN201911014355.5A priority Critical patent/CN110653826B/zh
Publication of CN110653826A publication Critical patent/CN110653826A/zh
Application granted granted Critical
Publication of CN110653826B publication Critical patent/CN110653826B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

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

Landscapes

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

Abstract

本发明公开了一种面向传送带目标跟随的机器人实时轨迹规划方法，包括：首先得到目标物体在机器人基坐标系下的位姿矩阵；然后根据当前插补时刻的传送带速度预测出下一插补时刻目标物体的位姿矩阵，并计算出机器人的位姿矩阵；再根据运动学逆解计算出下一插补时刻的机器人关节角，并结合当前插补时刻的机器人关节角，得到机器人各关节角度增量，驱动机器人运动；最后计算出机器人与目标物体之间的直线距离L，并将其与容许位移误差em相比较，直到L小于em就判定机器人跟随上目标物体。本发明通过对机器人轨迹进行实时规划，能够解决因传送带速度实时变化而造成的跟随精度不准的问题，对传送带目标物体动态抓取、喷涂以及涂胶等领域具有重要意义。

Description

一种面向传送带目标跟随的机器人实时轨迹规划方法
技术领域
本发明涉及机器人运动控制领域，特别涉及一种面向传送带目标跟随的机器人实时轨迹规划方法。
背景技术
在实际生产线上，通常需要运用机器人对传送带上的目标物体进行诸如拾取、喷涂以及涂胶等操作。对传送带上目标物体进行动态跟随，首要解决的问题就是如何合理的规划机器人跟随轨迹。由于目标物***置和速度均实时变化，动态轨迹规划不同于机器人传统的示教再现模式，需要根据机器人当前位姿以及下一插补时刻目标物体的位姿实时计算机器人的最优速度，并以最佳运动效果在较短时间内跟随上目标物体。
由于传送带在实际运行过程中并非匀速运动，其速度存在无规律的波动性，为了消除这种不稳定性，需要在一定的采样周期内通过对编码器数值进行处理重新计算传送带的速度，此能提高目标物体的位置预测精度。对于机器人跟随过程中的运动而言，为了保证机器人能够高速平滑运动，需要根据速度和加速度约束条件对其进行实时加减速规划，从而获取任意插补时刻的插补点信息。由于现有的目标物体跟随技术未考虑实际工程中传送带速度存在波动性的问题，因此需要运用一种面向传送带目标跟随的机器人实时轨迹规划方法对跟随轨迹的精度进行精确控制。
发明内容
本发明的目的在于克服现有技术存在的上述不足，提出一种面向传送带目标跟随的机器人实时轨迹规划方法，通过实时更新传送带的速度，更加精确的预测目标物体的位姿，并根据速度和加速度约束条件，对机器人进行实时加减速规划，进而计算出机器人跟随过程中的任意插补时刻的插补点位置信息，获得机器人高速平滑的跟随轨迹，并最终实现机器人快速的跟随上目标物体。本发明可以应用于传送带目标物体动态抓取、喷涂以及涂胶等领域。
为了实现上述发明目的，本发明提供了以下技术方案：
一种面向传送带目标跟随的机器人实时轨迹规划方法，包括以下步骤：
步骤一：将目标物体相对于传送带坐标系下的位姿矩阵，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵；
步骤二：根据当前插补时刻的传送带速度预测出下一插补时刻目标物体相对于传送带坐标系下的位姿矩阵，计算出机器人当前插补位移，得出下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵；
步骤三：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵通过运动学逆解计算出下一插补时刻的机器人关节角，再结合当前插补时刻的机器人关节角，得到机器人各关节角度增量之后，驱动机器人运动；
步骤四：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵和目标物体在机器人基坐标系下的位姿矩阵，计算出两者之间的直线距离L；
步骤五：将所述的L与用户设定的容许位移误差em相比较，判断是否跟随上，若所述的L小于em就判定机器人跟随上目标物体，否则返回步骤二。
进一步的，所述的步骤一中，过程如下：
令目标物体在传送带坐标系下的位姿为(x y z rx ry rz)T，通过欧拉角变换，获得目标物体在传送带坐标系下的位姿矩阵为convMobj，令传送带坐标系相对于机器人基坐标系的齐次变换矩阵为baseMconv，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵baseMobj如下：
baseMobj＝baseMconv*convMobj。
进一步的，所述的步骤二中，过程如下：
步骤1：计算当前插补时刻的传送带速度vconv；
令计算周期为Fe个单位采样周期，采样初始时刻编码器值为einit，采样结束时刻编码器值为eend，那么传送带速度计算如下：
Figure GDA0003569516500000021
其中，fs为传送带与编码器的比例因子，Tsample为单位采样周期对应的时间；
步骤2：根据传送带在单位插补周期内的位移，预测出下一插补时刻目标物体在机器人基坐标系下的位姿矩阵；
令当前插补时刻目标物体在机器人基坐标系下的位姿矩阵为baseMobj，传送带在单位插补周期内的位移为△Pconv＝(△x △y △z 0)T，其中△x，△y和△z分别为目标物体在传送带坐标系X，Y和Z轴正方向上的位移量，那么下一插补时刻目标物体在机器人基坐标系下的位姿矩阵计算如下：
Figure GDA0003569516500000022
其中，
Figure GDA0003569516500000023
步骤3：根据当前插补时刻的机器人位姿矩阵Mrobot和所述的下一插补时刻目标物体在机器人基坐标系下的位姿矩阵，计算出当前插补时刻机器人的插补位移△s；
当前插补时刻的机器人与下一插补时刻的目标物体之间的距离如下：
l＝||baseP′obj-Probot||
其中，矢量baseP′obj、Probot分别为矩阵baseM′obj和Mrobot的位置矢量；
令机器人最大速度为vm，最大加速度为am，机器人单位插补周期为△T，当前插补时刻速度和加速度分别为vc和ac，实时梯型加减速的匀加速段、匀速段和匀减速段中的速度和位移约束条件如下；
(4)匀加速段
机器人进入匀加速段需要满足的速度和位移约束条件如下：
Figure GDA0003569516500000031
其中：
Figure GDA0003569516500000032
la表示加速段位移，ld表示减速段位移；
(5)匀速段
机器人进入匀速段需要满足的位移约束条件如下：
Figure GDA0003569516500000033
(6)匀减速段
机器人进入匀减速段需要满足的位移约束条件如下：
|vc△T-0.5am△T2|≤l
通过上述约束条件，确定出机器人的运动状态，当前插补时刻机器人的插补位移△s为：
△s＝vc△T+0.5ac△T2
步骤4：根据当前插补时刻的插补位移，计算出机器人当前插补时刻的姿态转角θcur；
令机器人上一插补时刻的姿态转角为θa，根据步骤一所述的目标物体在机器人基坐标系下的位姿矩阵和初始状态下的机器人位姿矩阵计算出等效转轴矢量faxis和等效位姿转角θf以及两者之间的距离linit，那么机器人当前插补时刻的姿态转角θcur计算如下：
Figure GDA0003569516500000034
步骤5：根据当前插补时刻的机器人位姿矩阵、插补位移以及姿态转角计算出下一插补时刻机器人的位姿矩阵；
首先根据当前插补时刻的机器人位置矢量和下一插补时刻目标物体的位置矢量计算出两者之间的方向矢量如下：
Figure GDA0003569516500000035
下一插补时刻机器人的位姿矩阵计算如下：
Figure GDA0003569516500000036
其中，Rrobot为矩阵Mrobot的姿态部分，Rcur为根据等效转轴矢量faxis和当前插补时刻的姿态转角θcur计算出来的姿态旋转矩阵。
进一步的，所述的步骤三中，过程如下：
步骤1：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵通过运动学逆解计算出下一插补时刻的机器人关节角；
步骤2：根据下一插补时刻的机器人关节角和当前插补时刻的机器人关节角，得到机器人各关节角度增量之后，驱动机器人运动。
进一步的，所述的步骤四中，过程如下：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵和目标物体在机器人基坐标系下的位姿矩阵，计算出两者之间的直线距离L。
进一步的，所述的步骤五中，过程如下：将所述的L与用户设定的容许位移误差em相比较，判断是否跟随上，若所述的L小于em就判定机器人跟随上目标物体，否则返回步骤二。
本发明提出的面向传送带目标跟随的机器人实时轨迹规划方法，机器人跟随上目标物体的判断条件如下：若步骤四中所述的下一插补时刻机器人的位姿矩阵和目标物体之间的直线距离小于用户设定的容许位移误差，那么就判定机器人跟随上目标物体。
与现有技术相比，本发明的有益效果：
1、本发明通过在一定的采样周期内对编码器数值进行处理，重新计算传送带的速度，从而预测出目标物体的位姿，此有效地避免了传送带速度不规律的波动性，提高了目标物体的位置预测精度；
2、本发明考虑机器人速度和加速度约束条件，能够实时获得机器人最佳加减速状态；
3、本发明所提出的实时加减速控制方法能够应用于插补轨迹实时变化场合，并能够获得高速平滑的跟随轨迹；
4、本发明的传送带目标跟随技术能够适用于任意构型的机器人，并且可以应用于传送带目标物体动态抓取、喷涂以及涂胶等领域。
附图说明
图1是本发明方法的整体流程图；
图2是本发明传送带速度计算的流程图；
图3是本发明实时加减速规划流程图；
图4是本发明的机器人跟随空间轨迹曲线图；
图5是本发明的机器人跟随速度曲线图。
具体实施方式
下面结合试验例及具体实施方式对本发明作进一步的详细描述。但不应将此理解为本发明上述主题的范围仅限于以下的实施例，凡基于本发明内容所实现的技术均属于本发明的范围
结合附图对本发明的面向传送带目标跟随的机器人实时轨迹规划方法进行详细说明。
如图1所示，其为本发明的面向传送带目标跟随的机器人实时轨迹规划方法的整体流程图，具体步骤如下：
步骤一：将目标物体相对于传送带坐标系下的位姿矩阵，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵；
令目标物体在传送带坐标系下的位姿为(x y z rx ry rz)T，通过欧拉角变换，获得目标物体在传送带坐标系下的位姿矩阵为convMobj，令传送带坐标系相对于机器人基坐标系的齐次变换矩阵为baseMconv，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵baseMobj如下：
baseMobj＝baseMconv*convMobj
步骤二：根据当前插补时刻的传送带速度预测出下一插补时刻目标物体相对于传送带坐标系下的位姿矩阵，计算出机器人当前插补位移，得出下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵；
步骤二包含如下步骤：
步骤1：计算当前插补时刻的传送带速度vconv；
如图2所示，其为传送带速度计算整体流程图。令计算周期为Fe个单位采样周期，采样初始时刻编码器值为einit，采样结束时刻编码器值为eend，那么传送带速度计算如下：
Figure GDA0003569516500000051
其中，fs为传送带与编码器的比例因子，Tsample为单位采样周期对应的时间；
步骤2：根据传送带在单位插补周期内的位移，预测出下一插补时刻目标物体在机器人基坐标系下的位姿矩阵；
令当前插补时刻目标物体在机器人基坐标系下的位姿矩阵为baseMobj，传送带在单位插补周期内的位移为△Pconv＝(△x △y △z 0)T，其中△x，△y和△z分别为目标物体在传送带坐标系X，Y和Z轴正方向上的位移量，那么下一插补时刻目标物体在机器人基坐标系下的位姿矩阵计算如下：
Figure GDA0003569516500000052
其中，
Figure GDA0003569516500000053
步骤3：根据当前插补时刻的机器人位姿矩阵Mrobot和所述的下一插补时刻目标物体在机器人基坐标系下的位姿矩阵，计算出当前插补时刻机器人的插补位移△s；
当前插补时刻的机器人与下一插补时刻的目标物体之间的距离如下：
l＝||baseP′obj-Probot||
其中，矢量baseP′obj、Probot分别为矩阵baseM′obj和Mrobot的位置矢量；
令机器人最大速度为vm，最大加速度为am，机器人单位插补周期为△T，当前插补时刻速度和加速度分别为vc和ac，实时梯型加减速的匀加速段、匀速段和匀减速段中的速度和位移约束条件如下；
(7)匀加速段
机器人进入匀加速段需要满足的速度和位移约束条件如下：
Figure GDA0003569516500000061
其中：
Figure GDA0003569516500000062
la表示加速段位移，ld表示减速段位移；
(8)匀速段
机器人进入匀速段需要满足的位移约束条件如下：
Figure GDA0003569516500000063
(9)匀减速段
机器人进入匀减速段需要满足的位移约束条件如下：
|vc△T-0.5am△T2|≤l
通过上述约束条件，确定出机器人的运动状态，当前插补时刻机器人的插补位移△s为：
△s＝vc△T+0.5ac△T2
步骤4：根据当前插补时刻的插补位移，计算出机器人当前插补时刻的姿态转角θcur；
令机器人上一插补时刻的姿态转角为θa，根据步骤一所述的目标物体在机器人基坐标系下的位姿矩阵和初始状态下的机器人位姿矩阵计算出等效转轴矢量faxis和等效位姿转角θf以及两者之间的距离linit，那么机器人当前插补时刻的姿态转角θcur计算如下：
Figure GDA0003569516500000064
步骤5：根据当前插补时刻的机器人位姿矩阵、插补位移以及姿态转角计算出下一插补时刻机器人的位姿矩阵；
首先根据当前插补时刻的机器人位置矢量和下一插补时刻目标物体的位置矢量计算出两者之间的方向矢量如下：
Figure GDA0003569516500000065
下一插补时刻机器人的位姿矩阵计算如下：
Figure GDA0003569516500000066
其中，Rrobot为矩阵Mrobot的姿态部分，Rcur为根据等效转轴矢量faxis和当前插补时刻的姿态转角θcur计算出来的姿态旋转矩阵。
步骤三：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵通过运动学逆解计算出下一插补时刻的机器人关节角，再结合当前插补时刻的机器人关节角，得到机器人各关节角度增量之后，驱动机器人运动；
步骤三包括如下步骤：
步骤1：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵通过运动学逆解计算出下一插补时刻的机器人关节角；
步骤2：根据下一插补时刻的机器人关节角和当前插补时刻的机器人关节角，得到机器人各关节角度增量之后，驱动机器人运动。
步骤四：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵和目标物体在机器人基坐标系下的位姿矩阵，计算出两者之间的直线距离L；
步骤五：将所述的L与用户设定的容许位移误差em相比较，判断是否跟随上，若所述的L小于em就判定机器人跟随上目标物体，否则返回步骤二。
本发明提出的面向传送带目标跟随的机器人实时轨迹规划方法，机器人跟随上目标物体的判断条件如下：若步骤四中所述的下一插补时刻机器人的位姿矩阵和目标物体之间的直线距离小于用户设定的容许位移误差，那么就判定机器人跟随上目标物体。
为验证本发明所提的面向传送带目标跟随的机器人实时轨迹规划方法的有效性，现给出实验验证过程。
以直线型传送带目标跟随为例，令开始跟随时刻目标物体在传送带坐标系的位姿向量为(57.789070 84.626152 0 0 0 π/6.0)T，传送带坐标系相对于机器人基坐标系的齐次变换矩阵为：
Figure GDA0003569516500000071
那么通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵baseMobj。机器人在开始跟随时刻的位姿矩阵为：
Figure GDA0003569516500000072
传送带的速度为125mm/s，机器人最大指令速度vm为600mm/s。那么经过本发明提出的方法，经过826ms后机器人就可跟随上传送带上的目标物体，跟随响应快，并且如图4和5所示，机器人跟随轨迹曲线光顺平滑，且从速度曲线可知，机器人速度能够达到最大指令速度，且其匀速阶段为396ms，占总体跟随时间的47.941889％，说明跟随效率较高。
综上所述，本发明所提出的面向传送带目标跟随的机器人实时轨迹规划方法可以保证机器人在较短时间内跟随上传送带上的目标物体，并且机器人跟随轨迹曲线光顺平滑，跟随效率高，可适用于任意构型的机器人，并可应用于传送带目标物体动态抓取、喷涂以及涂胶等领域。

Claims (1)

1.一种面向传送带目标跟随的机器人实时轨迹规划方法，其特征在于，包括以下步骤：
步骤一：将目标物体相对于传送带坐标系下的位姿矩阵，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵，其中，齐次坐标变换过程如下：令目标物体在传送带坐标系下的位姿为(x y z rx ry rz)T，通过欧拉角变换，获得目标物体在传送带坐标系下的位姿矩阵为convMobj，令传送带坐标系相对于机器人基坐标系的齐次变换矩阵为baseMconv，通过齐次坐标变换，得到目标物体在机器人基坐标系下的位姿矩阵baseMobj如下：baseMobj＝baseMconv*convMobj；
步骤二：根据当前插补时刻的传送带速度预测出下一插补时刻目标物体相对于传送带坐标系下的位姿矩阵，计算出机器人当前插补位移，得出下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵；
步骤三：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵通过运动学逆解计算出下一插补时刻的机器人关节角，再结合当前插补时刻的机器人关节角，得到机器人各关节角度增量之后，驱动机器人运动；
步骤四：根据所述的下一插补时刻机器人末端执行器相对于机器人基坐标系的位姿矩阵和目标物体在机器人基坐标系下的位姿矩阵，计算出两者之间的直线距离L；
步骤五：将所述的L与用户设定的容许位移误差em相比较，判断是否跟随上，若所述的L小于em就判定机器人跟随上目标物体，否则返回步骤二,
其中，步骤二包括如下步骤：
步骤1：计算当前插补时刻的传送带速度vconv；
令计算周期为Fe个单位采样周期，采样初始时刻编码器值为einit，采样结束时刻编码器值为eend，那么传送带速度计算如下：
Figure FDA0003569516490000011
其中，fs为传送带与编码器的比例因子，Tsample为单位采样周期对应的时间；
步骤2：根据传送带在单位插补周期内的位移，预测出下一插补时刻目标物体在机器人基坐标系下的位姿矩阵；
令当前插补时刻目标物体在机器人基坐标系下的位姿矩阵为baseMobj，传送带在单位插补周期内的位移为△Pconv＝(△x △y △z 0)T，其中△x，△y和△z分别为目标物体在传送带坐标系X，Y和Z轴正方向上的位移量，那么下一插补时刻目标物体在机器人基坐标系下的位姿矩阵计算如下：
Figure FDA0003569516490000021
其中，
Figure FDA0003569516490000022
步骤3：根据当前插补时刻的机器人位姿矩阵Mrobot和所述的下一插补时刻目标物体在机器人基坐标系下的位姿矩阵，计算出当前插补时刻机器人的插补位移△s；
当前插补时刻的机器人与下一插补时刻的目标物体之间的距离如下：
l＝||baseP′obj-Probot||
其中，矢量baseP′obj、Probot分别为矩阵baseM′obj和Mrobot的位置矢量；
令机器人最大速度为vm，最大加速度为am，机器人单位插补周期为△T，当前插补时刻速度和加速度分别为vc和ac，实时梯型加减速的匀加速段、匀速段和匀减速段中的速度和位移约束条件如下；
①匀加速段
机器人进入匀加速段需要满足的速度和位移约束条件如下：
Figure FDA0003569516490000023
其中：
Figure FDA0003569516490000024
la表示加速段位移，ld表示减速段位移；
②匀速段
机器人进入匀速段需要满足的位移约束条件如下：
Figure FDA0003569516490000025
③匀减速段
机器人进入匀减速段需要满足的位移约束条件如下：
|vc△T-0.5am△T2|≤l
通过上述约束条件，确定出机器人的运动状态，当前插补时刻机器人的插补位移△s为：
△s＝vc△T+0.5ac△T2
步骤4：根据当前插补时刻的插补位移，计算出机器人当前插补时刻的姿态转角θcur；
令机器人上一插补时刻的姿态转角为θa，根据步骤一所述的目标物体在机器人基坐标系下的位姿矩阵和初始状态下的机器人位姿矩阵计算出等效转轴矢量faxis和等效位姿转角θf以及两者之间的距离linit，那么机器人当前插补时刻的姿态转角θcur计算如下：
Figure FDA0003569516490000031
步骤5：根据当前插补时刻的机器人位姿矩阵、插补位移以及姿态转角计算出下一插补时刻机器人的位姿矩阵；
首先根据当前插补时刻的机器人位置矢量和下一插补时刻目标物体的位置矢量计算出两者之间的方向矢量如下：
Figure FDA0003569516490000032
下一插补时刻机器人的位姿矩阵计算如下：
Figure FDA0003569516490000033
其中，Rrobot为矩阵Mrobot的姿态部分，Rcur为根据等效转轴矢量faxis和当前插补时刻的姿态转角θcur计算出来的姿态旋转矩阵。
CN201911014355.5A 2019-10-23 2019-10-23 一种面向传送带目标跟随的机器人实时轨迹规划方法 Active CN110653826B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911014355.5A CN110653826B (zh) 2019-10-23 2019-10-23 一种面向传送带目标跟随的机器人实时轨迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911014355.5A CN110653826B (zh) 2019-10-23 2019-10-23 一种面向传送带目标跟随的机器人实时轨迹规划方法

Publications (2)

Publication Number Publication Date
CN110653826A CN110653826A (zh) 2020-01-07
CN110653826B true CN110653826B (zh) 2022-06-14

Family

ID=69041592

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911014355.5A Active CN110653826B (zh) 2019-10-23 2019-10-23 一种面向传送带目标跟随的机器人实时轨迹规划方法

Country Status (1)

Country Link
CN (1) CN110653826B (zh)

Families Citing this family (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113134829B (zh) * 2020-01-17 2022-10-18 北京配天技术有限公司 机器人跟踪传送带上的工件的方法以及机器人跟踪***
CN111496798B (zh) * 2020-05-18 2022-06-14 北京配天技术有限公司 机器人传送带跟踪方法、设备及存储装置
CN111905983B (zh) * 2020-07-17 2021-06-29 深圳市华成工业控制股份有限公司 基于视觉跟随的点胶轨迹修正方法、装置、***及介质
CN113134831B (zh) * 2021-03-16 2024-02-09 无锡信捷电气股份有限公司 一种scara动态贴盒功能实现方法
CN115525045B (zh) * 2021-06-09 2024-01-16 北京小米移动软件有限公司 机器人及其控制方法、控制装置、电子设备和存储介质
CN113246096B (zh) * 2021-06-28 2021-09-24 佛山冠博机械科技发展有限公司 一种基于自适应巡航技术的分拣机械手及其控制方法
CN113858213B (zh) * 2021-11-09 2023-07-25 南京埃斯顿机器人工程有限公司 一种用于目标同步的机器人动态轨迹规划方法
CN115741679B (zh) * 2022-11-03 2024-06-28 北京立迈胜控制技术有限责任公司 一种基于高阶平滑规划和速度叠加的动态抓取算法
CN115946121B (zh) * 2023-01-31 2023-06-27 北京立迈胜控制技术有限责任公司 一种用于机械臂基于动态规划的传送带跟踪方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106346486A (zh) * 2016-11-04 2017-01-25 武汉海默自控股份有限公司 一种六轴协作机器人多回路控制***及其控制方法
CN106965180A (zh) * 2017-04-13 2017-07-21 北京理工大学 流水线上瓶子的机械臂抓取装置与方法
CN107618030A (zh) * 2016-07-16 2018-01-23 深圳市得意自动化科技有限公司 基于视觉的机器人动态跟踪抓取方法及***
CN108674922A (zh) * 2018-05-16 2018-10-19 广州视源电子科技股份有限公司 一种用于机器人的传送带同步跟踪方法、装置及***
CN109911549A (zh) * 2019-01-25 2019-06-21 东华大学 一种易损物品的机器人动态跟踪抓取***及方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107618030A (zh) * 2016-07-16 2018-01-23 深圳市得意自动化科技有限公司 基于视觉的机器人动态跟踪抓取方法及***
CN106346486A (zh) * 2016-11-04 2017-01-25 武汉海默自控股份有限公司 一种六轴协作机器人多回路控制***及其控制方法
CN106965180A (zh) * 2017-04-13 2017-07-21 北京理工大学 流水线上瓶子的机械臂抓取装置与方法
CN108674922A (zh) * 2018-05-16 2018-10-19 广州视源电子科技股份有限公司 一种用于机器人的传送带同步跟踪方法、装置及***
CN109911549A (zh) * 2019-01-25 2019-06-21 东华大学 一种易损物品的机器人动态跟踪抓取***及方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
工业机器人实时高精度路径跟踪与轨迹规划;谭冠政等;《中南大学学报(自然科学版)》;20050226;第36卷(第01期);第102-107页 *

Also Published As

Publication number Publication date
CN110653826A (zh) 2020-01-07

Similar Documents

Publication Publication Date Title
CN110653826B (zh) 一种面向传送带目标跟随的机器人实时轨迹规划方法
CN112757306B (zh) 一种机械臂逆解多解选择和时间最优轨迹规划算法
CN109159151A (zh) 一种机械臂空间轨迹跟踪动态补偿方法和***
JP5327722B2 (ja) ロボットの負荷推定装置及び負荷推定方法
CN101402199B (zh) 基于视觉的手眼式低伺服精度机器人抓取移动目标的方法
CN110948504B (zh) 机器人加工作业法向恒力跟踪方法和装置
CN110561440B (zh) 一种冗余度机械臂加速度层多目标规划方法
CN110228067B (zh) 一种基于激光跟踪仪的双臂机器人组合操作测试方法
CN113601512B (zh) 一种机械臂奇异点的通用规避方法与***
CN108189038A (zh) 一种实用的工业六轴机械臂直线运动轨迹规划方法及***
CN101116968A (zh) 六维力传感器装配机械手姿态及力的控制方法
CN104647379A (zh) 一种驱动器非线性条件下的双臂机器人运动控制方法
WO2020173111A1 (zh) 一种 3d 微涂覆机器人及其涂覆方法
CN109901518B (zh) 一种恒力约束条件下的数控机床加减速速度规划方法
CN111580453A (zh) 基于plc的提高二维圆弧插补轨迹精度的实现方法
CN111515928B (zh) 机械臂运动控制***
CN113334385A (zh) 一种自驱动关节臂测量机直线轨迹间平滑过渡的规划方法
CN111427308A (zh) 一种用于数控平台轨迹规划的误差补偿综合控制方法
Wang et al. Error estimation and cross-coupled control based on a novel tool pose representation method of a five-axis hybrid machine tool
JP2006260010A (ja) ロボット制御装置，ロボット制御方法，コンピュータプログラム
CN109848995B (zh) 一种工业机器人碰撞反应方法
CN116117796B (zh) 一种工业机器人姿态轨迹过渡与速度规划方法及***
CN109648563B (zh) 串联机器人运动控制方法及计算机存储介质
CN114378830B (zh) 一种机器人腕关节奇异规避方法及***
CN113485370A (zh) 一种并联机器人动态拾放轨迹规划方法及***

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
CB02 Change of applicant information

Address after: 215000 east half of bell Park industrial building b1-1f \ b0-1f, No. 259, Changyang street, Suzhou Industrial Park, China (Jiangsu) pilot Free Trade Zone, Suzhou, Jiangsu

Applicant after: SUZHOU ELITE ROBOT Co.,Ltd.

Address before: 215000 Suzhou Industrial Park and 28 Heshun Road, Jiangsu Province

Applicant before: SUZHOU ELITE ROBOT Co.,Ltd.

CB02 Change of applicant information
GR01 Patent grant
GR01 Patent grant