一种工业机器人快速示教装置及其实现方法制造方法及图纸

本发明专利技术涉及一种工业机器人快速示教装置及其实现方法，包括工业机器人、机器人控制器、末端执行工具、示教模组、信号放大器、数据采集器以及计算机；所述末端执行工具固定于所述工业机器人的末端，所述示教模组固连于所述末端执行工具，所述信号放大器的一端连接至所述示教模组，另一端连接至所述数据采集器，所述数据采集器连接至所述计算机，所述计算机连接至所述机器人控制器，所述机器人控制器与工业机器人相连；所述示教模组包括六维力/力矩传感器、示教手柄以及按钮，所述示教手柄固连于所述六维力/力矩传感器，所述按钮安装于所述示教手柄上。此装置在无需对现有工业机器人软硬件升级的情况下能够完成快速示教，通用性强，可靠性高。

Rapid teaching device for industrial robot and implementation method thereof

The invention relates to a fast industrial robot teaching device and its implementation method, including industrial robot, robot controller, terminal execution tools, teaching module, signal amplifier, data acquisition and computer; at the end of the end effector tool is fixed on the industrial robot, the teaching module is fixedly connected to the at the end of the implementation of tools, one end of the signal amplifier is connected to the teaching module, the other end is connected to the data acquisition, the data collector is connected to the computer, the computer is connected to the robot controller, the robot controller is connected with the industrial robot; the teaching module includes six axis force / torque sensor, teach handle and button, the teaching of the handle is fixedly connected to the six axis force / torque sensor, the button is arranged on the show Teach the handle. The device can accomplish rapid teaching without the upgrading of the existing industrial robot hardware and software. The utility model has the advantages of high versatility and high reliability.

【技术实现步骤摘要】
一种工业机器人快速示教装置及其实现方法
本专利技术涉及机器人控制及示教加工领域，特别是涉及一种工业机器人快速示教装置及其实现方法。
技术介绍
随着科技的不断发展，越来越多的工业机器人运用于工业生产领域，机器人在工业生产中主要用于完成装配、打磨、焊接等领域。完成指定的工序需要给机器人规划轨迹，这一条轨迹最常见的方式就是通过机器人的示教器进行机器人的移动，然后记录下示教点，然后编写运动程序完成示教，目前市面上的工业机器人绝大部分源代码都是封闭的，很难进行底层的代码开发，因此示教点的采集都是通过示教器进行编程完成。通过示教器进行示教，对于操作者要求较高，需要对工业机器人很熟悉，这样才能够保证操作安全，示教器进行示教效率较低，而且如果对于比较复杂的曲面采用示教器进行示教，难度会更大。目前许多高校机械类专业都有开设与机器人相关的课程，课程学习中一个重要的环节就是认识学习工业机器人，由于每次参与实践的人数较多，学生对于工业机器人的示教器使用不熟悉，如果采用示教器进行示教学习，则会大大的降低实验效率，在操作机器人的过程中可能会出现误碰撞，带来安全隐患。基于此开发一种基于现有机器人平台的直接示教装置很有实际应用意义，可不通过示教器进行移动机器人到示教点，直接拖动示教模组进行移动，这样可以快捷准确的到达示教点，此方法不需要操作者对机器人的运动学以及控制原理的了解，只需要在基于六维力/力矩快速示教模式下，直接拖动示教模组进行示教点选取，此方法简单安全。可广泛的应用于工业机器人示教加工环节。专利CN105583824A提出基于力实现对多自由度机械臂的力控牵引和摆位的控制，可以实现在力的作用下实现对机械臂进行拖动，但是没有实现示教还原功能，不具有通用性，在实际使用过程中没有对力/力矩传感器起保护作用，不能够运用于工业机器人的示教加工任务。
技术实现思路
有鉴于此，本专利技术的目的是提供一种工业机器人快速示教装置及其实现方法，该装置具有通用性可运用于多自由度工业机器人的示教及实际生产中。本专利技术采用以下方案实现：一种工业机器人快速示教装置，其特征在于：包括一工业机器人、一机器人控制器、一末端执行工具、一示教模组、一信号放大器、一数据采集器以及一计算机；所述末端执行工具固定于所述工业机器人的末端，所述示教模组固连于所述末端执行工具，所述信号放大器的一端连接至所述示教模组，另一端连接至所述数据采集器，所述数据采集器连接至所述计算机，所述计算机连接至所述机器人控制器，所述机器人控制器与工业机器人相连；所述示教模组包括一六维力/力矩传感器、一示教手柄以及一按钮，所述示教手柄固连于所述六维力/力矩传感器，所述按钮安装于所述示教手柄上。其中，末端执行工具与示教模组相互独立安装，在示教点采集完成后，可以对六维力/力矩传感器快速装拆，保证六维力力/力矩传感器的安全使用，末端执行工具根据不同的加工任务进行更换，根据计算机储存的示教点进行示教还原，可运用实际生产加工任务中如焊接、码垛等任务。进一步地，所述六维力/力矩传感器信号经过数据采集器后进行滤波、放大及AD转换处理后发给计算机，所述计算机根据力/力矩信号控制工业机器人是否移动从而完成示教点采集。进一步地，所述示教模组相对于末端执行工具独立安装，示教点采集完成后可拆除示教模组。进一步地，所述末端执行工具可根据不同的示教加工任务选取不同的执行工具。进一步地，该装置在X、Y、Z、Rx、Ry、Rz六个方向的示教行程与所述六维力/力矩传感器检测到的纯净力信号相关，其算法为：移动步长计算公式：其中Fi代表x、y、z三个方向的力值，3代表力的最小的阀值，当力的绝对值大于3N时才会执行移动，其中kx是移动系数，根据实际应用进行设定，进行运算之前设定一个力最大阀值，当超过一定的最大限值后移动步长不再随之而增加，而是定值；转动步长计算公式：其中Ti代表三个x、y、z方向的力矩值，2代表力矩的最小的阀值，当力矩的绝对值大于2时才会执行转动，其中kθ是转动系数，根据实际应用进行设定，进行运算之前设定一个力最大阀值，当超过一定的最大限值后转动步长不再随之而增加，而是定值；速度的计算公式：速度的计算采用Sigmoid型函数，当力大于某值时速度达到极限值不再增加。进一步地，所述纯净力信号是通过对所述六维力/力矩传感器进行重力补偿而得到，所述重力补偿算法为：计算初始位置手持器重力在基坐标系下的向量大小并记录：当机器人位姿改变时，重力在传感器坐标系下的三个方向分力计算：其中，是程序启动时传感器坐标系相对于机器人基坐标系的位姿矩阵，是程序启动时手持器重力在力传感器坐标系下的分力表示，是末端手持器重力分力在基坐标系下的矩阵表示，是传感器相对于基坐标系的实时的位姿矩阵的逆，是重力随位姿改变后末端手持器重力在工具坐标系下的分力表示，其随机器人的位姿改变而实时刷新，从而完成对重力补偿的计算；手持器重力矩补偿算法为：重力矩的补偿重要的是对重心位置的确定，从而快速确定重力引起的三个分力矩的大小；由于实际使用过程中，末端手持器形状是不规则的特点，因此无法运用物体的中心就是重心的性质，可通过如下算法进行计算：在末端手持器作用力前，使用该计算方法，求解出重心相对于传感器中心的位置矩阵表达式：[dx,dy,dz]T，然后保存用于补偿重力分力产生的重力矩，求解出重心的位置矩阵。本专利技术还采用以下方法实现：一种工业机器人快速示教装置的实现方法，示教步骤如下：步骤S01：根据不同的示教加工任务选取适合的执行工具，选取完成后和示教模组一起安装于工业机器人末端，完成安装后，装置上电，所述计算机完成对六维力/力矩传感器及程序的初始化，所述工业机器人回到初始化程序起点，判断六维力/力矩传感器及工业机器人初始化是否完成，未完成继续等待，等待初始化完成后力/力矩传感器开始工作；步骤S02：所述六维力/力矩传感器采集末端的力及力矩信息，通过信号放大器将采集的信号放大以便于采集；步骤S03：所述数据采集模块采集放大器的模拟量，对采集信号进行滤波、整形并完成模拟信号与数字信号的转换；步骤S04：所述计算机建立六维力/力矩传感器坐标系与工具坐标系之间的转换，完成对末端执行件重力引起的重力分力以及重力分力矩补偿，将补偿完成后的六维力/力矩传感器力信息实时显示在人机界面上；步骤S05：所述计算机将补偿后的力以及力矩信息通过移动算法得出工业机器人末端执行工具端点的移动量以及旋转量，实现机器人的移动示教，当工业机器人到达示教点后，按下手持器的开关按钮，通过数据采集模块检测开关是否按下，如按下则通过计算机储存示教点信息；步骤S06：所述示教模组示教完成后可以进行快速拆卸，拆卸完成后末端执行工具可以根据之前示教储存的点数据完成示教加工任务，保证在示教加工过程中六维力/力矩传感器的安全使用，同时拆卸下的力/力矩传感器可用于下一台机器人快速示教工作。相较于现有技术，本专利技术具有以下有益效果：在不需对当前工业机器人系统进行硬件升级的前提下，可以直接拖拽与六维力/力矩传感器固定连接的手持器，实现工业机器人的运动，从而实现示教点的选取；在数据点采集完成后，可以对示教模组进行拆卸，示教模组安装与末端执行工具相互独立，末端执行工具可根据示教储存的点进行示教还原，示教还原过程也可以进行实际的工业生产，如本文档来自技高网...

【技术保护点】
一种工业机器人快速示教装置，其特征在于：包括一工业机器人、一机器人控制器、一末端执行工具、一示教模组、一信号放大器、一数据采集器以及一计算机；所述末端执行工具固定于所述工业机器人的末端，所述示教模组固连于所述末端执行工具，所述信号放大器的一端连接至所述示教模组，另一端连接至所述数据采集器，所述数据采集器连接至所述计算机，所述计算机连接至所述机器人控制器，所述机器人控制器与工业机器人相连；所述示教模组包括一六维力/力矩传感器、一示教手柄以及一按钮，所述示教手柄固连于所述六维力/力矩传感器，所述按钮安装于所述示教手柄上。

【技术特征摘要】
1.一种工业机器人快速示教装置，其特征在于：包括一工业机器人、一机器人控制器、一末端执行工具、一示教模组、一信号放大器、一数据采集器以及一计算机；所述末端执行工具固定于所述工业机器人的末端，所述示教模组固连于所述末端执行工具，所述信号放大器的一端连接至所述示教模组，另一端连接至所述数据采集器，所述数据采集器连接至所述计算机，所述计算机连接至所述机器人控制器，所述机器人控制器与工业机器人相连；所述示教模组包括一六维力/力矩传感器、一示教手柄以及一按钮，所述示教手柄固连于所述六维力/力矩传感器，所述按钮安装于所述示教手柄上。2.根据权利要求1所述的一种工业机器人快速示教装置，其特征在于：该装置在X、Y、Z、Rx、Ry、Rz六个方向的示教行程与所述六维力/力矩传感器检测到的纯净力信号相关，其算法为：移动步长计算公式：其中Fi代表x、y、z三个方向的力值，3代表力的最小的阀值，当力的绝对值大于3N时才会执行移动，其中kx是移动系数，根据实际应用进行设定，进行运算之前设定一个力最大阀值，当超过一定的最大限值后移动步长不再随之而增加，而是定值；转动步长计算公式：其中Ti代表x、y、z三个方向的力矩值，2代表力矩的最小的阀值，当力矩的绝对值大于2时才会执行转动，其中kθ是转动系数，根据实际应用进行设定，进行运算之前设定一个力最大阀值，当超过一定的最大限值后转动步长不再随之而增加，而是定值；速度的计算公式：速度的计算采用Sigmoid型函数，当力大于某值时速度达到极限值不再增加。3.根据权利要求2所述的一种工业机器人快速示教装置，其特征在于：所述纯净力信号是通过对所述六维力/力矩传感器进行重力补偿而得到，所述重力补偿算法为：计算初始位置手持器重力在基坐标系下的向量大小并记录：当机器人位姿改变时，重力在传感器坐标系下的三个方向分力计算：其中是程序启动时传感器...

【专利技术属性】
技术研发人员：吴海彬，黄青红，高裕强，
申请(专利权)人：福州大学，
类型：发明
国别省市：福建,35