CN113134831B - 一种scara动态贴盒功能实现方法 - Google Patents
一种scara动态贴盒功能实现方法 Download PDFInfo
- Publication number
- CN113134831B CN113134831B CN202110282335.7A CN202110282335A CN113134831B CN 113134831 B CN113134831 B CN 113134831B CN 202110282335 A CN202110282335 A CN 202110282335A CN 113134831 B CN113134831 B CN 113134831B
- Authority
- CN
- China
- Prior art keywords
- conveyor belt
- point
- robot
- speed
- mechanical arm
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 230000033001 locomotion Effects 0.000 claims abstract description 72
- 230000001360 synchronised effect Effects 0.000 claims abstract description 36
- 230000008569 process Effects 0.000 claims abstract description 7
- 238000001914 filtration Methods 0.000 claims description 19
- 230000001133 acceleration Effects 0.000 claims description 12
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 238000000926 separation method Methods 0.000 claims description 4
- 230000009471 action Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000007599 discharging Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 claims description 3
- 230000001815 facial effect Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 3
- 230000001960 triggered effect Effects 0.000 claims description 3
- 238000004806 packaging method and process Methods 0.000 description 4
- 230000000007 visual effect Effects 0.000 description 4
- 230000005540 biological transmission Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000005299 abrasion Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000000123 paper Substances 0.000 description 1
- 239000011087 paperboard Substances 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation 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/1694—Programme controls characterised by use of sensors other than normal servo-feedback from position, speed or acceleration sensors, perception control, multi-sensor controlled systems, sensor fusion
- B25J9/1697—Vision controlled systems
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
- Y02P90/00—Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
- Y02P90/02—Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Manipulator (AREA)
Abstract
本发明属于工业机器人控制技术领域，尤其是一种SCARA动态贴盒功能实现方法，包括SCARA机器人动态贴盒方案、机械臂、盒子、相机模块、编码器、传送带、待贴礼品盒、动力线缆和编码器线缆，所述SCARA机器人动态贴盒方案包括机器人‑传送带位置标定模块、传送带速度滤波模块、待机点‑目标点轨迹规划模块、机械臂‑传送带同步运动轨迹规划模块、动态跟踪完毕后脱离轨迹规划以及误差补偿模型建立模块。本发明提出一种位置叠加的方案，将动态贴盒过程分解成传送带方向的同步运动和待机点到贴盒点的点到点运动，为了使机械手和传送带在跟随段时达到较理想的跟踪精度，建立一个同步运动位置补偿模型，补偿跟随段的位置偏差。
Description
技术领域
本发明涉及工业机器人控制技术领域，尤其涉及一种SCARA动态贴盒功能实现方法。
背景技术
随着国民生活水平的提高，对礼品盒、包装盒等需求量也越来越大。在实际使用中，需要将盒子的外表皮和纸板内衬贴到一起，目前的包装企业，采取的主要是人工贴盒和视觉静态贴盒方案。人工贴盒增加了人力成本，效率也不高，且盒子的一致性不好，非熟练工人很难贴的精准。而视觉静态贴盒，需要传送带完全停止后才可以完成贴盒操作，这样频繁启停，加大了电机、传送带磨损，且此方案需要和前端送纸工序，后端盒子成型工序配合，系统出错风险大。
经检索，中国专利公开号为CN108674922A的专利，公开了PID跟随算法，需要根据传送带速度调PID参数，否则跟随精度不理想。
上述专利还存在有以下不足之处：利用PID跟随算法，使得应用场景受限，大大限制了包装厂家贴盒系统的升级改造，一些动态贴盒方案使用相机实时拍照，视觉系统计算出点位后传给机器人，这种办法对相机的要求比较高，对图像的采集环境比较苛刻，图像处理算法也很复杂，此种方法在工程上很难应用。
发明内容
基于背景技术中提出的利用PID跟随算法，使得应用场景受限，大大限制了包装厂家贴盒系统的升级改造，一些动态贴盒方案使用相机实时拍照，视觉系统计算出点位后传给机器人，这种办法对相机的要求比较高，对图像的采集环境比较苛刻，图像处理算法也很复杂，此种方法在工程上很难应用的技术问题，本发明提出了一种SCARA动态贴盒功能实现方法。
本发明提出的一种SCARA动态贴盒功能实现方法，包括SCARA机器人动态贴盒方案、机械臂、盒子、相机模块、编码器、传送带、待贴礼品盒、动力线缆和编码器线缆，所述SCARA机器人动态贴盒方案包括机器人-传送带位置标定模块、传送带速度滤波模块、待机点-目标点轨迹规划模块、机械臂-传送带同步运动轨迹规划模块、动态跟踪完毕后脱离轨迹规划以及误差补偿模型建立模块，所述SCARA机器人动态贴盒方案还包括以下步骤：
S1：在开始作业前，完成机器人-传送带位置标定，不移动机器的情况下，标定参数一直有效；
S2：系统启动后，首先通过速度滤波模块获取了传送带运行速度，当盒子通过光电开关后，拍照获取目标点位置，然后完成待机点-目标点轨迹规划以及机械臂-传送带同步运动轨迹规划，则当待机点-目标点运动完毕后，机械臂末端跟随到盒子上方，此时可以完成吸放等工作；
S3：作业完毕后，进入脱离段，进行脱离轨迹规划，机械臂从跟踪点运动到跟踪点上方后，返回待机点。
优选地，所述机器人-传送带位置标定主要是通过在传送带上加装编码器，然后记录传动带上某点位P对应的机器人坐标位置以及编码器脉冲值，开启传送带，在机器人行程范围内运动一段路程，移动机器人，使得末端继续运动到P点，记录此时刻机器人位置坐标P1以及编码器的脉冲值，由两个点位机器人坐标差值和编码器脉冲差值的比例，计算出传送带的比例因子R，由两个点位机器人X、Y方向坐标差值比例，计算出传送带相对于机器人X方向的偏转角θ，由此，可根据编码器脉冲反馈值，获得传送带的运行速度，根据偏转角θ获得传送带的运行方向。
优选地，所述传送带速度滤波模块主要是将每个周期计算的传送带速度进行滤波，首先在每个插补周期中，根据编码器反馈的脉冲值，差分计算当前脉冲速度，然后乘以传动带比例因子R，求得传动带实际运行速度V0，由于速度波动方向分布较为均匀，故使用算术平均滤波法即可取得较好效果，取N个采样周期内的速度平均值，以作为机械手和传动带同步速度规划值，机械臂和编码器连接有动力线缆和编码器线缆。
优选地，所述待机点-目标点轨迹规划模块是规划用户设定的待机点P2到相机模块拍照时刻得到的盒子坐标位置P3的轨迹，此过程使用机器人逆运动学，由点位坐标得到机器人关节角，在关节坐标系下使用五次多项式曲线进行轨迹规划，计算对应插补周期的关节角度，下发到伺服系统中，伺服系统驱动电机运动到目标角度，从而实现P2到P3点的运动。
优选地，所述机械臂-传送带同步运动轨迹规划模块用于规划同步段轨迹，以相机拍照时刻得到的盒子坐标位置P3作为规划起点，沿传送带运动方向规划一个加速曲线，相邻两个插补周期，使用机器人逆运动学计算出两点对应的关节角度，计算它们的关节角度差下发至伺服系统，加速度到规划速度后，进入匀速段，则每个插补周期规划的位移为固定值，同样的使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中。当机械臂进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂末端和工件同步运动，此时可关闭吸嘴气阀，放置盒子，完成贴盒操作。
优选地，所述脱离轨迹规划用于跟踪作业完毕后，机械臂停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故可以对Z方向规划一个点到点运动，Z轴抬高高度由用户设定。传送带运行方向，以传送带速度规划一个减速段运动，如此，机械臂脱离跟随，停在了传送带上方，再规划一个传送带上方到待机点的运动，机械臂运动到了待机点。
优选地，还包括以下计算步骤：
S11、首先完成机械手-传送带参数标定，在标定前确定传送带平面和机器人平面平行，则标定时只需考虑X、Y方向，在机器人行程范围内找到一点P，移动机器人末端到该点位，记录对应的机器人坐标位置以及编码器脉冲值，开启传送带运动一段路程，移动机器人末端到P点，记录对应坐标位置以及编码器脉冲值，计算比例因子R，偏转角θ；
S12：为了简化操作步骤，方便操作人员快速标定，制作了一个标定软件，按步骤操作后，软件自动读取点位，计算标定结果，并写入控制器；
S13：传送带的实时速度可由编码器反馈值差分计算出来，速度滤波模块，记录最近N个插补周期的速度值，使用算术平均滤波法，求得经过滤波后的速度；
S14：传送带运行时，盒子跟随传动带运动，当光电开关检测到盒子到位后，触发相机拍照，相机将图像传入视觉系统中，视觉系统经过运算给出面纸目标位置P2，根据用户设定的待机点位置P2，运用机器人逆运动学，得到P2、P3关节角度q2、q3，在关节空间内进行轨迹规划，使用九次多项式拟合运动轨迹，九次多项式曲线表达式如下：
每个插补周期可根据该表达式，EtherCAT主站向机器人发送角度位置控制机器人的运动；
S15：为了实现机械臂跟随传送运动，需要在上述轨迹规划的基础上叠加一段同步运动轨迹，以相机拍照时刻得到的盒子坐标位置P3(X3,Y3)作为规划起点，首先以测得的传动带速度为最大速度，使用九次多项式曲线规划一个加速段，根据插补时间，得到相应插补周期规划的位移S,则每个插补周期规划的位置坐标为P4(X3+,Y3+)，使用机器人逆运动学计算出P3、P4对应的关节角度，然后计算它们的差值，在每个插补周期里，将该角度输出到伺服系统中。加速度到规划速度后，进入匀速段，则每个插补周期规划的位移S为固定值，其中，为系统每周期的插补时间，同样的，使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中，当机械臂进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂末端和工件同步运动，此时可关闭吸嘴气阀，放置盒子，完成贴盒操作；
S16：脱离轨迹规划用于跟踪作业完毕后，机械臂停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故可以对Z方向规划一个点到点运动，Z轴抬高高度由用户设定，传送带运行方向，以传送带速度规划一个减速段运动，如此，机械臂脱离跟随，停在了传送带上方，再规划一个传送带上方到待机点的运动，机械臂运动到了待机点，SCARA动态贴盒动作完成，完成一整个循环，等待待贴礼品盒到位。
本发明中的有益效果为：
1、该SCARA动态贴盒功能实现方法，通过提出一种位置叠加的方案，将动态贴盒过程分解成传送带方向的同步运动和待机点到贴盒点的点到点运动。为了实现机械手和传送带的同步运动，需要完成传动带测速模块。为了获取贴盒点坐标位置，需要完成相机和机械臂的手眼标定、传送带和机械臂的位置标定。为了使机械手和传送带在跟随段时达到较理想的跟踪精度，建立一个同步运动位置补偿模型，补偿跟随段的位置偏差。
2、该SCARA动态贴盒功能实现方法，关键在于将动态运动分解为一个点到点的运动和一个传送带方向的同步运动。实现原理通俗易懂，算法处理效率高，可以较好地保证机器人快速跟踪上目标物体，且可以达到较好的跟踪精度，同时也避免了繁琐的参数调整。使用该方法，各关节速度曲线平滑，避免了由于目标物体的变化引起的关节速度剧烈变化，从而出现末端振动的现象。
该装置中未涉及部分均与现有技术相同或可采用现有技术加以实现。
附图说明
图1为本发明提出的一种SCARA动态贴盒功能实现方法的各模块执行流程图图；
图2为本发明提出的一种SCARA动态贴盒功能实现方法的动态贴盒系统布局图；
图3为本发明提出的一种SCARA动态贴盒功能实现方法的ROB2S-40型机器人示意图；
图4为本发明提出的一种SCARA动态贴盒功能实现方法的机械臂-传送带参数标定软件界面；
图5为本发明提出的一种SCARA动态贴盒功能实现方法的传送带运行方向和机器人坐标系关系图。
图中：1机械臂、2盒子、3相机模块、4编码器、5传送带、6待贴礼品盒、7动力线缆、8编码器线缆。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。
在本发明的描述中，需要理解的是，术语“上”、“下”、“前”、“后”、“左”、“右”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本发明和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本发明的限制。
2、参照图1-5，一种SCARA动态贴盒功能实现方法，包括SCARA机器人动态贴盒方案、机械臂1、盒子2、相机模块3、编码器4、传送带5、待贴礼品盒6、动力线缆7和编码器线缆8，SCARA机器人动态贴盒方案包括机器人-传送带位置标定模块、传送带速度滤波模块、待机点-目标点轨迹规划模块、机械臂-传送带同步运动轨迹规划模块、动态跟踪完毕后脱离轨迹规划以及误差补偿模型建立模块，SCARA机器人动态贴盒方案还包括以下步骤：
S1：在开始作业前，完成机器人-传送带位置标定，不移动机器的情况下，标定参数一直有效；
S2：系统启动后，首先通过速度滤波模块获取了传送带运行速度，当盒子2通过光电开关后，拍照获取目标点位置，然后完成待机点-目标点轨迹规划以及机械臂-传送带同步运动轨迹规划，则当待机点-目标点运动完毕后，机械臂1末端跟随到盒子2上方，此时可以完成吸放等工作；
S3：作业完毕后，进入脱离段，进行脱离轨迹规划，机械臂1从跟踪点运动到跟踪点上方后，返回待机点。
本发明中，机器人-传送带位置标定主要是通过在传送带5上加装编码器4，然后记录传动带5上某点位P对应的机器人坐标位置以及编码器脉冲值，开启传送带5，在机器人行程范围内运动一段路程，移动机器人，使得末端继续运动到P点，记录此时刻机器人位置坐标P1以及编码器的脉冲值，由两个点位机器人坐标差值和编码器脉冲差值的比例，计算出传送带的比例因子R，由两个点位机器人X、Y方向坐标差值比例，计算出传送带相对于机器人X方向的偏转角θ，由此，可根据编码器脉冲反馈值，获得传送带5的运行速度，根据偏转角θ获得传送带5的运行方向。
本发明中，传送带速度滤波模块主要是将每个周期计算的传送带速度进行滤波，首先在每个插补周期中，根据编码器4反馈的脉冲值，差分计算当前脉冲速度，然后乘以传动带比例因子R，求得传动带实际运行速度V0，由于速度波动方向分布较为均匀，故使用算术平均滤波法即可取得较好效果，取N个采样周期内的速度平均值，以作为机械手和传动带5同步速度规划值，机械臂1和编码器4连接有动力线缆7和编码器线缆8。
本发明中，待机点-目标点轨迹规划模块是规划用户设定的待机点P2到相机模块3拍照时刻得到的盒子2坐标位置P3的轨迹，此过程使用机器人逆运动学，由点位坐标得到机器人关节角，在关节坐标系下使用五次多项式曲线进行轨迹规划，计算对应插补周期的关节角度，下发到伺服系统中，伺服系统驱动电机运动到目标角度，从而实现P2到P3点的运动。
本发明中，机械臂-传送带同步运动轨迹规划模块用于规划同步段轨迹，以相机拍照时刻得到的盒子2坐标位置P3作为规划起点，沿传送带5运动方向规划一个加速曲线，相邻两个插补周期，使用机器人逆运动学计算出两点对应的关节角度，计算它们的关节角度差下发至伺服系统，加速度到规划速度后，进入匀速段，则每个插补周期规划的位移为固定值，同样的使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中。当机械臂1进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂1末端和工件同步运动，此时可关闭吸嘴气阀，放置盒子2，完成贴盒操作。
本发明中，脱离轨迹规划用于跟踪作业完毕后，机械臂1停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故可以对Z方向规划一个点到点运动，Z轴抬高高度由用户设定。传送带5运行方向，以传送带5速度规划一个减速段运动，如此，机械臂1脱离跟随，停在了传送带5上方，再规划一个传送带5上方到待机点的运动，机械臂1运动到了待机点。
本发明中，还包括以下计算步骤：
S11、首先完成机械手-传送带参数标定，在标定前确定传送带平面和机器人平面平行，则标定时只需考虑X、Y方向，在机器人行程范围内找到一点P，移动机器人末端到该点位，记录对应的机器人坐标位置以及编码器脉冲值，开启传送带运动一段路程，移动机器人末端到P点，记录对应坐标位置以及编码器脉冲值，计算比例因子R，偏转角θ；
S12：为了简化操作步骤，方便操作人员快速标定，制作了一个标定软件，按步骤操作后，软件自动读取点位，计算标定结果，并写入控制器；
S13：传送带5的实时速度可由编码器4反馈值差分计算出来，速度滤波模块，记录最近N个插补周期的速度值，使用算术平均滤波法，求得经过滤波后的速度；
S14：传送带5运行时，盒子2跟随传动带5运动，当光电开关检测到盒子2到位后，触发相机拍照，相机将图像传入视觉系统中，视觉系统经过运算给出面纸目标位置P2，根据用户设定的待机点位置P2，运用机器人逆运动学，得到P2、P3关节角度q2、q3，在关节空间内进行轨迹规划，使用九次多项式拟合运动轨迹，九次多项式曲线表达式如下：
每个插补周期可根据该表达式，EtherCAT主站向机器人发送角度位置控制机器人的运动；
S15：为了实现机械臂1跟随传送运动，需要在上述轨迹规划的基础上叠加一段同步运动轨迹，以相机拍照时刻得到的盒子坐标位置P3X3,Y3作为规划起点，首先以测得的传动带速度为最大速度，使用九次多项式曲线规划一个加速段，根据插补时间，得到相应插补周期规划的位移S,则每个插补周期规划的位置坐标为P4X3+,Y3+，使用机器人逆运动学计算出P3、P4对应的关节角度，然后计算它们的差值，在每个插补周期里，将该角度输出到伺服系统中。加速度到规划速度后，进入匀速段，则每个插补周期规划的位移S为固定值，其中，为系统每周期的插补时间，同样的，使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中，当机械臂1进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂1末端和工件同步运动，此时可关闭吸嘴气阀，放置盒子，完成贴盒操作；
S16：脱离轨迹规划用于跟踪作业完毕后，机械臂1停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故可以对Z方向规划一个点到点运动，Z轴抬高高度由用户设定，传送带运行方向，以传送带速度规划一个减速段运动，如此，机械臂1脱离跟随，停在了传送带5上方，再规划一个传送带5上方到待机点的运动，机械臂1运动到了待机点，SCARA动态贴盒动作完成，完成一整个循环，等待待贴礼品盒6到位。
以上所述，仅为本发明较佳的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，根据本发明的技术方案及其发明构思加以等同替换或改变，都应涵盖在本发明的保护范围之内。
Claims (6)
1.一种SCARA动态贴盒功能实现方法，包括SCARA机器人动态贴盒方案、机械臂(1)、盒子(2)、相机模块(3)、编码器(4)、传送带(5)、待贴礼品盒(6)、动力线缆(7)和编码器线缆(8)，其特征在于，所述SCARA机器人动态贴盒方案包括机器人-传送带位置标定模块、传送带速度滤波模块、待机点-目标点轨迹规划模块、机械臂-传送带同步运动轨迹规划模块、动态跟踪完毕后脱离轨迹规划以及误差补偿模型建立模块，所述SCARA机器人动态贴盒方案还包括以下步骤：
S1：在开始作业前，完成机器人-传送带位置标定，不移动机器的情况下，标定参数一直有效；
S2：系统启动后，首先通过速度滤波模块获取了传送带运行速度，当盒子(2)通过光电开关后，拍照获取目标点位置，然后完成待机点-目标点轨迹规划以及机械臂-传送带同步运动轨迹规划，则当待机点-目标点运动完毕后，机械臂(1)末端跟随到盒子(2)上方，此时能够完成吸放工作；
S3：作业完毕后，进入脱离段，进行脱离轨迹规划，机械臂(1)从跟踪点运动到跟踪点上方后，返回待机点；
所述机器人-传送带位置标定是通过在传送带(5)上加装编码器(4)，然后记录传送带(5)上某点位P对应的机器人坐标位置以及编码器脉冲值，开启传送带(5)，在机器人行程范围内运动一段路程，移动机器人，使得末端继续运动到P点，记录此时刻机器人位置坐标P1以及编码器的脉冲值，由两个点位机器人坐标差值和编码器脉冲差值的比例，计算出传送带的比例因子R，由两个点位机器人X、Y方向坐标差值比例，计算出传送带相对于机器人X方向的偏转角θ，由此，能够根据编码器脉冲反馈值，获得传送带(5)的运行速度，根据偏转角θ获得传送带(5)的运行方向。
2.根据权利要求1所述的一种SCARA动态贴盒功能实现方法，其特征在于，所述传送带速度滤波模块是将每个周期计算的传送带速度进行滤波，首先在每个插补周期中，根据编码器(4)反馈的脉冲值，差分计算当前脉冲速度，然后乘以传送带比例因子R，求得传送带实际运行速度V0，由于速度波动方向分布较为均匀，故使用算术平均滤波法即能够取得较好效果，取N个采样周期内的速度平均值，以作为机械手和传送带(5)同步速度规划值，机械臂(1)和编码器(4)连接有动力线缆(7)和编码器线缆(8)。
3.根据权利要求2所述的一种SCARA动态贴盒功能实现方法，其特征在于，所述待机点-目标点轨迹规划模块是规划用户设定的待机点P2到相机模块(3)拍照时刻得到的盒子(2)坐标位置P3的轨迹，此过程使用机器人逆运动学，由点位坐标得到机器人关节角，在关节坐标系下使用五次多项式曲线进行轨迹规划，计算对应插补周期的关节角度，下发到伺服系统中，伺服系统驱动电机运动到目标角度，从而实现P2到P3点的运动。
4.根据权利要求3所述的一种SCARA动态贴盒功能实现方法，其特征在于，所述机械臂-传送带同步运动轨迹规划模块用于规划同步段轨迹，以相机拍照时刻得到的盒子(2)坐标位置P3作为规划起点，沿传送带(5)运动方向规划一个加速曲线，相邻两个插补周期，使用机器人逆运动学计算出两点对应的关节角度，计算它们的关节角度差下发至伺服系统，加速度到规划速度后，进入匀速段，则每个插补周期规划的位移为固定值，同样的使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中；当机械臂(1)进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂(1)末端和工件同步运动，此时能够关闭吸嘴气阀，放置盒子(2)，完成贴盒操作。
5.根据权利要求4所述的一种SCARA动态贴盒功能实现方法，其特征在于，所述脱离轨迹规划用于跟踪作业完毕后，机械臂(1)停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故能够对Z方向规划一个点到点运动，Z轴抬高高度由用户设定；传送带(5)运行方向，以传送带(5)速度规划一个减速段运动，如此，机械臂(1)脱离跟随，停在了传送带(5)上方，再规划一个传送带(5)上方到待机点的运动，机械臂(1)运动到了待机点。
6.根据权利要求1所述的一种SCARA动态贴盒功能实现方法，其特征在于，还包括以下计算步骤：
S11、首先完成机械手-传送带参数标定，在标定前确定传送带平面和机器人平面平行，则标定时只需考虑X、Y方向，在机器人行程范围内找到一点P，移动机器人末端到该点位，记录对应的机器人坐标位置以及编码器脉冲值，开启传送带运动一段路程，移动机器人末端到P点，记录对应坐标位置以及编码器脉冲值，计算比例因子R，偏转角θ；
S12：为了简化操作步骤，方便操作人员快速标定，制作了一个标定软件，按步骤操作后，软件自动读取点位，计算标定结果，并写入控制器；
S13：传送带(5)的实时速度能够由编码器(4)反馈值差分计算出来，速度滤波模块，记录最近N个插补周期的速度值，使用算术平均滤波法，求得经过滤波后的速度；
S14：传送带(5)运行时，盒子(2)跟随传送带(5)运动，当光电开关检测到盒子(2)到位后，触发相机拍照，相机将图像传入视觉系统中，视觉系统经过运算给出面纸目标位置P2，根据用户设定的待机点位置P2，运用机器人逆运动学，得到P2、P3关节角度q2、q3，在关节空间内进行轨迹规划，使用九次多项式拟合运动轨迹，九次多项式曲线表达式如下：
每个插补周期能够根据该表达式，EtherCAT主站向机器人发送角度位置控制机器人的运动；
S15：为了实现机械臂(1)跟随传送运动，需要在上述轨迹规划的基础上叠加一段同步运动轨迹，以相机拍照时刻得到的盒子坐标位置P3(X3,Y3)作为规划起点，首先以测得的传送带速度为最大速度，使用九次多项式曲线规划一个加速段，根据插补时间，得到相应插补周期规划的位移S,则每个插补周期规划的位置坐标为P4，使用机器人逆运动学计算出P3、P4对应的关节角度，然后计算它们的差值，在每个插补周期里，将该角度输出到伺服系统中；加速度到规划速度后，进入匀速段，则每个插补周期规划的位移S为固定值，其中，为系统每周期的插补时间，同样的，使用机器人逆运动学计算机器人相邻两个插补周期对应的关节角度，计算差值，输入到伺服系统中，当机械臂(1)进入同步运动段且待机点-目标点规划轨迹运动完成后，机械臂(1)末端和工件同步运动，此时能够关闭吸嘴气阀，放置盒子，完成贴盒操作；
S16：脱离轨迹规划用于跟踪作业完毕后，机械臂(1)停止运动，并回到待机点的轨迹规划，由于同步运动时Z方向位置不变，故能够对Z方向规划一个点到点运动，Z轴抬高高度由用户设定，传送带运行方向，以传送带速度规划一个减速段运动，如此，机械臂(1)脱离跟随，停在了传送带(5)上方，再规划一个传送带(5)上方到待机点的运动，机械臂(1)运动到了待机点，SCARA动态贴盒动作完成，完成一整个循环，等待待贴礼品盒(6)到位。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110282335.7A CN113134831B (zh) | 2021-03-16 | 2021-03-16 | 一种scara动态贴盒功能实现方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202110282335.7A CN113134831B (zh) | 2021-03-16 | 2021-03-16 | 一种scara动态贴盒功能实现方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN113134831A CN113134831A (zh) | 2021-07-20 |
| CN113134831B true CN113134831B (zh) | 2024-02-09 |
Family
ID=76811358
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202110282335.7A Active CN113134831B (zh) | 2021-03-16 | 2021-03-16 | 一种scara动态贴盒功能实现方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN113134831B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113858213B (zh) * | 2021-11-09 | 2023-07-25 | 南京埃斯顿机器人工程有限公司 | 一种用于目标同步的机器人动态轨迹规划方法 |
| CN115741679B (zh) * | 2022-11-03 | 2024-06-28 | 北京立迈胜控制技术有限责任公司 | 一种基于高阶平滑规划和速度叠加的动态抓取算法 |
Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110653826A (zh) * | 2019-10-23 | 2020-01-07 | 苏州艾利特机器人有限公司 | 一种面向传送带目标跟随的机器人实时轨迹规划方法 |
| CN111026037A (zh) * | 2019-11-26 | 2020-04-17 | 西安航天精密机电研究所 | 基于windows平台工业机器人运动控制器及控制方法 |
| CN111347423A (zh) * | 2020-01-19 | 2020-06-30 | 天津大学 | 工业机器人传送带动态跟踪涂胶方法 |
| CN112465864A (zh) * | 2020-11-26 | 2021-03-09 | 深圳众为兴技术股份有限公司 | 目标跟随的轨迹规划方法和装置、电子设备、存储介质 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106647282B (zh) * | 2017-01-19 | 2020-01-03 | 北京工业大学 | 一种考虑末端运动误差的六自由度机器人轨迹规划方法 |
-
2021
- 2021-03-16 CN CN202110282335.7A patent/CN113134831B/zh active Active
Patent Citations (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110653826A (zh) * | 2019-10-23 | 2020-01-07 | 苏州艾利特机器人有限公司 | 一种面向传送带目标跟随的机器人实时轨迹规划方法 |
| CN111026037A (zh) * | 2019-11-26 | 2020-04-17 | 西安航天精密机电研究所 | 基于windows平台工业机器人运动控制器及控制方法 |
| CN111347423A (zh) * | 2020-01-19 | 2020-06-30 | 天津大学 | 工业机器人传送带动态跟踪涂胶方法 |
| CN112465864A (zh) * | 2020-11-26 | 2021-03-09 | 深圳众为兴技术股份有限公司 | 目标跟随的轨迹规划方法和装置、电子设备、存储介质 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN113134831A (zh) | 2021-07-20 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN113134831B (zh) | 一种scara动态贴盒功能实现方法 | |
| CN110842928B (zh) | 一种复合机器人视觉引导定位方法 | |
| JP7314475B2 (ja) | ロボット制御装置、及び、ロボット制御方法 | |
| CN108674922A (zh) | 一种用于机器人的传送带同步跟踪方法、装置及系统 | |
| CN111347423B (zh) | 工业机器人传送带动态跟踪涂胶方法 | |
| JP6470763B2 (ja) | 生産システム | |
| CN105045098B (zh) | 一种机器人喷涂轨迹自动生成系统的控制方法 | |
| CN111921788A (zh) | 高精度动态跟踪点胶方法及其装置 | |
| CN111347431A (zh) | 一种手持工具示教的机器人示教喷涂方法和装置 | |
| CN101623867A (zh) | 一种使机器人高精度跟踪指定路径的设备和方法 | |
| CN111946340B (zh) | 基于视觉导航的煤矿悬臂式掘进机截割控制方法及系统 | |
| CN104965516A (zh) | 一种基于视觉和力反馈的四旋翼飞行器进行空中抓取作业的控制方法 | |
| WO2022179179A1 (zh) | 一种面向异构特性大型装备多智能体协同自主转运系统 | |
| US11230005B2 (en) | Following robot and work robot system | |
| CN111002306B (zh) | 一种基于电子凸轮的机器人运动控制方法及控制系统 | |
| CN108638052A (zh) | 一种闭链式多臂机器人柔顺控制方法 | |
| CN110125944A (zh) | 一种机械臂示教系统和方法 | |
| WO2020173111A1 (zh) | 一种 3d 微涂覆机器人及其涂覆方法 | |
| CN113246142B (zh) | 一种基于激光引导的测量路径规划方法 | |
| CN106777876A (zh) | 一种用于机器人的旋转电弧焊缝跟踪系统信息处理方法 | |
| JPH04226883A (ja) | ロボットを作動するための方法及びこのための装置 | |
| CN108656104B (zh) | 利用工业机器人自动给轧辊轴承补油和涂油的方法 | |
| Lachmayer et al. | Contour tracking control for mobile robots applicable to large-scale assembly and additive manufacturing in construction | |
| JP7093881B1 (ja) | システム、及び自動搬送車 | |
| US20230224450A1 (en) | Imaging device for acquiring three-dimensional information of workpiece surface and two-dimensional image of workpiece |
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 |