基于机器视觉的机器人关节形变传感器、机械臂及方法与流程

1.本发明属于机器人传感器领域，具体涉及一种基于机器视觉的机器人关节形变传感器、机械臂及方法。


背景技术：

2.机器人在工业生产中有着广泛的应用。在机器人的使用过程中，由于人为失误、零件故障、控制系统失效等意外导致运动轨迹偏离、工件偏移，从而导致机器人在工作过程中产生碰撞的情况时有发生。如果没有第一时间发现碰撞并停止机器人的运动，可能会造成机器人系统、末端贵重工具或者贵重工件的损坏，甚至产生更严重的安全问题。产生以上事故的原因是现有的机器人在防碰撞系统上存在一定的不足，没有建立起有效的主动预防机制。机器人难以第一时间预测或检测到碰撞，并主动采取中断或避让措施，也无法在碰撞解除后及时恢复工作位置，从而继续进行被中断的作业。对此，越来越多的工业机器人企业投入研发碰撞自动检测识别和姿态自恢复系统，试图解决机器人碰撞问题。
3.现有方案主要集中在对于碰撞本身的预防和防护上，而碰撞解除后机械臂能迅速回归到碰撞发生前的位置，继续被中断的作业同样是非常重要的需求。通过控制系统的运行状态和记录，可以调取到触发碰撞信号时，机械臂理论上的位置。但是机械臂真实的中止位置又受到信号延迟、关节的变形等因素影响，难以被精确定位。


技术实现要素：

4.为解决现有技术中的机械臂碰撞后难以精确定位的问题，本发明提供了一种基于机器视觉的机器人关节形变传感器、机械臂及方法。
5.本发明采用了以下技术方案：
6.一种基于机器视觉的机器人关节形变传感器，装设在机器人关节内，所述机器人关节内包括相对设置的第一安装部和第二安装部以及连接并支撑所述第一安装部和第二安装部的支撑部，所述机器人关节形变传感器包括一个或多个摄像装置和一个或多个标记物；
7.所述摄像装置固定在所述第一安装部朝向所述第二安装部的一面；所述标记物设置在所述第二安装部朝向所述第一安装部的一面，所述摄像装置与所述机器人的控制器电连接，所述摄像装置对所述标记物拍照以记录所述标记物的位置变化。
8.在一些实施例中，所述位置变化包括六个自由度的变化。
9.在一些实施例中，所述标记物上设有标记原点和至少一个目标点，所述目标点与所述标记原点的距离为已知值。
10.一种机械臂，包括至少两个机械臂段和连接在两所述机械臂段之间的机器人关节，每一所述机器人关节内设有如上所述的基于机器视觉的机器人关节形变传感器。
11.在一些实施例中，所述机器人关节还包括围绕所述第一安装部和第二安装部设置的外壳。
12.在一些实施例中，所述机械臂包括三个依次连接的机械臂段，相邻的机械臂段之间通过所述机器人关节连接。
13.一种碰撞后的机械臂末端位置的确定方法，采用如上所述机械臂，所述方法包括以下步骤：
14.s1.碰撞前，所述摄像装置对所述标记物拍摄获得第一图像，所述控制器根据所述第一图像获得标记物的第一位置数据；
15.s2.碰撞后所述机器人暂停运动；
16.s3.所述摄像装置对所述标记物拍摄获得第二图像，所述控制器根据所述第二图像获得标记物的第二位置数据；
17.s4.将所述第二位置数据与所述第一位置数据对比，获得碰撞后相对于碰撞前的标记物的位移变化量；
18.s5.根据预存的机械人的各机械臂段的长度数据，结合与所述机械臂段连接的机器人关节内的标记物的所述位移变化量，计算并获得机器臂末端的碰撞后位置数据。
19.在一些实施例中，还包括步骤s6.以所述碰撞后位置数据作为所述机器臂末端的位置数据，对所述机械臂进行复位。
20.与现有技术相比，本发明的有益效果为：
21.本发明的基于机器视觉的机器人关节形变传感器中，在机器人关节内设置摄像装置和标记物，可通过摄像装置拍摄标记物的图像，比较碰撞前后的标记物的位置变化，从而确定碰撞后的机器人关节的形变数据，进而确定碰撞后的位置。
22.本发明的机械臂和碰撞后的机械臂末端位置的确定方法中，采用了上述的基于机器视觉的机器人关节形变传感器，依靠该摄像装置拍摄的图像，可确定关节的变形量，再结合预存的机械臂段的长度数据，可以确定机械臂碰撞后的机械臂末端的位置。
附图说明
23.下面结合附图和具体实施方式对本发明的技术作进一步地详细说明：
24.图1是本发明的机器人关节形变传感器安装在机器人关节内的示意图；
25.图2是机械臂与障碍物碰撞前后的示意图；
26.图3是摄像装置拍摄的第一图像、第二图像以及二者比较的示意图；
27.图4是本发明方法的步骤图。
28.附图标记：
29.1-机器人关节；11-第一安装部；12-第二安装部；13-支撑部；14-外壳；
30.2-摄像装置；
31.3-标记物；31-标记原点；32-目标点；
32.4-机械臂段；
33.5-障碍物。
具体实施方式
34.以下将结合实施例和附图对本发明的构思、具体结构及产生的技术效果进行清楚、完整的描述，以充分地理解本发明的目的、方案和效果。需要说明的是，在不冲突的情况
下，本技术中的实施例及实施例中的特征可以相互组合。附图中各处使用的相同的附图标记指示相同或相似的部分。
35.需要说明的是，如无特殊说明，当某一特征被称为“固定”、“连接”在另一个特征，它可以直接固定、连接在另一个特征上，也可以间接地固定、连接在另一个特征上。此外，本发明中所使用的上、下、左、右等描述仅仅是相对于附图中本发明各组成部分的相互位置关系来说的。
36.参照图1至图3，一种基于机器视觉的机器人关节形变传感器，装设在机器人关节1内。所述机器人关节1形变传感器包括一个或多个摄像装置2和一个或多个标记物3。在一个实施例中，摄像装置2和标记物3都为一个。在另一个实施例中，摄像装置2和标记物3都为三个。
37.其中，所述机器人关节1内包括相对设置的第一安装部11和第二安装部12以及连接并支撑所述第一安装部11和第二安装部12的支撑部13。在一个实施例中，第一安装部11和第二安装部12为机器人关节1的两个法兰盘，支撑部13为支撑轴。可以理解的，该机器人关节1可以是普通关节，也可以是柔性关节。
38.所述摄像装置2固定在所述第一安装部11朝向所述第二安装部12的一面；所述标记物3设置在所述第二安装部12朝向所述第一安装部11的一面。即摄像装置2和标记物3均位于关节内部并相对设置，以便于摄像装置2对标记物3进行拍照。
39.所述摄像装置2与所述机器人的控制器电连接，所述摄像装置2对所述标记物3拍照以记录所述标记物3的位置变化。如果发生碰撞，控制器将碰撞前后拍摄的照片进行对比，可以获得标记物3在碰撞后相对于碰撞前的位置变化，可根据标记物3的尺寸变化计算出标记物3相对于摄像装置2的偏移和/或偏转，获得最后的位置数据(包括移动数据和转动数据)。例如控制器从碰撞前拍摄的照片中获得的数据，标记物3在的位置，碰撞后，拍摄照片，获得标记物3在碰撞后图片中的位置，将两个位置对比获得偏移量，从而确定了变形量的大小，从而为确定机械臂碰撞后的位置提供了计算基础。
40.其中，所述位置变化包括六个自由度的变化，由于是在三维空间中发生的碰撞，各种碰撞都可能发生，碰撞后的形变也是各式各样，有可能碰撞后因单一方向偏移或旋转，也可能是多方向的偏移和旋转。
41.所述标记物3上设有标记原点31(图3中a的圆形)和至少一个目标点32(图3中a的三角形)，所述目标点32与所述标记原点31的距离为已知值。可以通过碰撞前后标记原点31的位置确定平面方向上的平移，通过整体尺寸关系的变化确定与摄像装置2之间距离的变化，通过标记原点31与目标点32之间连线的角度变化确定整体的旋转。通过设置标记图像，可以进一步方便位置数据变化的计算。其中，当目标点32的数量为多个时，各目标点32的形状可以全部相同，也可以全部不同，也可以部分相同。
42.一种机械臂，包括至少两个机械臂段4和连接在两所述机械臂段4之间的机器人关节1，每一所述机器人关节1内设有如上所述的基于机器视觉的机器人关节1形变传感器。机械臂上的每一个关节都采用上述的机器人关节1形变传感器，从而才发生碰撞后，通过多个机器人关节1形变传感器活动的形变量进行计算处理，从而计算出整个机械臂在碰撞后的偏移，从而确定机械臂碰撞后的位置。在一个实施例中，机械臂具有两个机械臂段4，二者之间为机器人关节1。在另一个实施例中，机械臂具有三个机械臂段4，共有两个机器人关节1。
43.在一些实施例中，所述机器人关节1还包括围绕所述第一安装部11和第二安装部12设置的外壳14，以保护内部的摄像装置2和标记物3，避免碰撞过程中将二者损坏，导致失效。其中，该外壳14呈筒状，整个机器人关节1呈圆柱状。
44.在一个实施例中，如图2所示，图2中虚线部分为碰到障碍物5前的机械臂，图2中实线部分为碰撞后形变并停止的机械臂段4，所述机械臂包括三个依次连接的机械臂段4，相邻的机械臂段4之间通过所述机器人关节1连接，机械臂的一端固定，另一端为工作端，在碰撞后，机械臂末端(即工作端)位置发生变化，相邻机械臂的角度关系也发生变化。通过每一个关节碰撞前后的位置对比，从而可以计算出角度的变化和偏移，从而最终确定机械臂末端的位置。
45.一种碰撞后的机械臂末端位置的确定方法，采用如上所述机械臂，所述方法包括以下步骤：
46.s1.碰撞前，所述摄像装置2对所述标记物3拍摄获得第一图像，所述控制器根据所述第一图像获得标记物3的第一位置数据。在实际的使用中，难以预判什么时候才会发生碰撞，因此，可以在机械臂运行时，摄像装置2持续进行拍摄，拍摄出的照片与时间记录对应。当发生碰撞后，机器人关节发生形变，拍摄到的照片与之前的照片相比，标记物的位置数据发生了变化，据此判断发生了碰撞，从而发出警报。当然也可以依靠机械臂自身的碰撞探测传感器(压力或其它形式的传感器)检测碰撞，发出警报，将警报时间前的拍摄的照片作为第一图像，如图3中(a)。
47.s2.碰撞后所述机器人暂停运动。发生碰撞后，机器人关节发生形变，从而被基于机器视觉的机器人关节形变传感器检测到，控制器控制各个驱动器暂停工作，避免进一步造成损伤。
48.s3.所述摄像装置2对所述标记物3拍摄获得第二图像，所述控制器根据所述第二图像获得标记物3的第二位置数据。在发生碰撞的过程中以及机械臂暂停运动后，摄像装置2都持续在拍摄照片，可以获得整个关节形变过程中不同时刻的数据，通过在后拍摄的照片与前一张照片的位置数据对比，可以得知标记物在形变时的移动过程，如图3中(b)。可以理解的，当后面拍摄的图像不再发生变化时，说明机械臂已经暂停运行，可将此时的照片作为第二图像。
49.s4.将所述第二位置数据与所述第一位置数据对比，如图3中(c)，获得碰撞后相对于碰撞前的标记物3的位移变化量。对比碰撞前后的位置数据，确定位置变化量。
50.s5.根据预存的机械人的各机械臂段4的长度数据，结合与所述机械臂段4连接的机器人关节1内的标记物3的所述位移变化量，计算并获得机器臂末端的碰撞后位置数据。当第一个关节发生形变，与其连接的机械臂段4的长度会将该形变进一步放大，因此需要结合机械臂段4的长度来确定第一关节变形后，在后面的第二关节的整体偏移数据，然后再根据第二关节的变形量确定第三臂段的偏移量，最终获得其末端的位置数据。
51.s6.以所述碰撞后位置数据作为所述机器臂末端的位置数据，对所述机械臂进行复位，以进行后续的工作。
52.本发明所述的基于机器视觉的机器人关节形变传感器、机械臂及方法的其它内容参见现有技术，在此不再赘述。
53.以上所述，仅是本发明的较佳实施例而已，并非对本发明作任何形式上的限制，故
凡是未脱离本发明技术方案内容，依据本发明的技术实质对以上实施例所作的任何修改、等同变化与修饰，均仍属于本发明技术方案的范围内。