位移装置、机器人及机器人奇异点处理方法
【技术领域】
[0001] 本发明涉及机器人技术领域，特别涉及一种位移装置、机器人及机器人奇异点处 理方法。
【背景技术】
[0002] 工业机器人是工业自动化系统中重要的部件之一。工业机器人奇异点的处理方法 就是机器人应用技术中最主要的技术之一。奇异点问题是工业机器人必然遇到的技术点， 一旦机器人遇到奇异点的状态，机器人就会发生关节运动速度骤然变大的现象，从而导致 机器人停机甚至带来生产安全问题，所以机器人的控制技术需要规避或处理奇异点。
[0003] 奇异点状态不仅仅在奇异点位置上，在奇异点周围区域都会产生关节运动速度过 大的问题。距离奇异点位置越近，关节运动速度越大。在机器人运行过程中，关节运动速度 过快的情况时，机器人需要做出减速动作，甚至需要停机处理，影响较大。
[0004] 目前，常用的奇异点过渡方法为DLS (Damped least-squares，阻尼最小方差）方 法，在奇异点过渡过程中，不可避免的会带来积累误差，降低了机器人工作的精度。而申请 号为CN103802114A的专利文件，公布了一种工业机器人奇异点处理方法及装置。但是，当 机器人运动到奇异点周围区域而未运动至奇异点阈值时，仍然存在因速度过快而导致停机 出错的问题。
[0005] 因此，如何提高精确度，避免在奇异点处出现速度过快的问题，是本技术领域人员 亟待解决的问题。
【发明内容】
[0006] 有鉴于此，本发明提供了一种位移装置，提高精确度，避免在奇异点处出现速度过 快的问题。本发明还公开了一种具有上述位移装置的机器人及机器人奇异点处理方法。
[0007] 为实现上述目的，本发明提供如下技术方案：
[0008] -种位移装置，包括：用于连接机器人的末端法兰且使所述末端法兰沿其线性运 动的第一位移杆；沿所述第一位移杆作线性运动的第二位移杆；沿所述第二位移杆作线性 运动，用于连接机器人主体的驱动末端的第三位移杆；
[0009] 所述末端法兰相对于所述第一位移杆的线性运动方向、所述第一位移杆相对于所 述第二位移杆的线性运动方向及所述第二位移杆相对于所述第三位移杆的线性运动方向 相互垂直。
[0010] 优选地，上述位移装置中，所述第三位移杆、所述第二位移杆及所述第一位移杆中 的两个为滑轨，剩余一个为直线伸缩装置。
[0011] 优选地，上述位移装置中，所述第三位移杆及所述第二位移杆为滑轨；所述第二位 移杆滑动设置于所述第三位移杆上；
[0012] 所述第一位移杆为直线伸缩装置，其滑动设置于所述第二位移杆上，其驱动端与 所述末端法兰连接。
[0013] 优选地，上述位移装置中，所述直线伸缩装置为直线电机或气缸。
[0014] 本发明还提供了一种机器人，包括机器人主体及末端法兰，还包括如上述任一项 所述的位移装置；
[0015] 所述末端法兰与所述第一位移杆连接，所述机器人主体的驱动末端与所述第三位 移杆连接。
[0016] 优选地，上述机器人中，所述机器人主体包括依次通过关节连接的基座、第一连 杆、第二连杆、第三连杆、第四连杆及第五连杆；
[0017] 所述第五连杆远离所述第四连杆的一端为所述机器人主体的驱动末端。
[0018] 优选地，上述机器人中，所述末端法兰上设置有用于安装工具的多个安装孔。
[0019] 本发明还提供了一种机器人奇异点处理方法，应用如上述任一项所述的位移装 置，包括步骤：
[0020] 1)将机器人的关节转动至初始角度位置，开始运行机器人直线运动程序指令；
[0021] 2)判断所述机器人是否进入奇异点区域，如果是，进入下一步；如果否，所述机器 人继续正常运动；
[0022] 3)在不考虑所述位移装置的前提下，使用奇异点过渡算法计算所述机器人转动关 节下一插补周期需要运动的角度：
[0023] 求解得出所述机器人的末端由当前运动位置？1到预定位置？2之间的运动向量I。
[0024] 4)计算机器人的末端从初始位置Pi到运动目标位置p 3需要进行直线运动的运动 向量/7补偿运动的运动向量为
[0025] 将f分解为三个相互垂直的方向的运动距离 ：e
[0026] 控制所述位移装置的第一位移杆、第二位移杆及第三位移杆分别作线性运动，运 动距离分别为d7、(18和d 9;
[0027] 根据插补周期及插补算法进行轨迹规划，并发送插补信号至执行器进行运动；
[0028] 5)判断机器人是否离开奇异点区域：如果没有离开奇异点区域，则进入步骤3); 如果离开奇异点区域，则进入下一步；
[0029] 6)结束奇异点处理。
[0030] 优选地，上述机器人奇异点处理方法中，所述步骤5)与所述步骤6)之间还包括步 骤 56):
[0031] 在机器人离开奇异点区域进行正常运动后，设置所述位移装置上的移动距离归 零。
[0032] 优选地，上述机器人奇异点处理方法中，所述位移装置上的移动距离归零方法 为：
[0033] 561)根据第一位移杆、第二位移杆及第三位移杆上直线导轨的运动距离
[0034] 562)从当前运动位置p5到运动目标位置p 6的运动向量|d在不考虑位移装置的 前提下机器人的末端运动位置p4到位置P 6的运动向量为
[0035] 563)根据插补周期及插补算法进行轨迹规划，并发送插补信号至执行器进行运 动。
[0036] 从上述的技术方案可以看出，本发明提供的位移装置，通过设置第一位移杆、第二 位移杆及第三位移杆，使其具有三个相互垂直的线性运动方向，达到空间位移方式，以便于 达到对机器人在奇异点过渡过程中进行补偿运动，提高了机器人工作的精确度，并且，避免 了机器人在奇异点处出现速度过快的问题。
[0037] 本发明还提供了一种机器人及其机器人奇异点处理方法，具有与上述位移装置同 样的技术效果，在此不再详细介绍。
【附图说明】
[0038] 为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现 有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本 发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以 根据这些附图获得其他的附图。
[0039] 图1为本发明实施例提供的机器人的结构示意图；
[0040] 图2为本发明实施例提供的机器人奇异点处理方法的流程示意图；
[0041] 图3为本发明实施例提供的补偿运动的结构示意图；
[0042] 图4为本发明实施例提供的补偿运动的运动向量的分解示意图；
[0043] 图5为本发明实施例提供的位移装置归零运动的结构示意图。
【具体实施方式】
[0044] 本发明公开了一种位移装置，提高精确度，避免在奇异点处出现速度过快的问题。 本发明还公开了一种具有上述位移装置的机器人及机器人奇异点处理方法。
[0045] 下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完 整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于 本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他 实施例，都属于本发明保护的范围。
[0046] 请参考图1，图1为本发明实施例提供的机器人的结构示意图。
[0047] 本发明实施例提供了一种位移装置，包括：用于连接机器人的末端法兰9且使末 端法兰9沿其线性运动的第一位移杆8 ;沿第一位移杆8作线性运动的第二位移杆7 ;沿第 二位移杆7作线性运动，用于连接机器人主体的驱动末端的第三位移杆6 ;末端法兰9相对 于第一位移杆8的线性运动方向、第一位移杆8相对于第二位移杆7的线性运动方向及第 二位移杆7相对于第三位移杆6的线性运动方向相互垂直。
[0048] 本发明实施例提供的位移装置，通过设置第一位移杆8、第二位移杆7及第三位移 杆6,使其具有三个相互垂直的线性运动方向，达到空间位移方式，以便于达到对机器人在 奇异点过渡过程中进行补偿运动，提高了机器人工作的精确度，并且，避免了机器人在奇异 点处出现速度过快的问题。
[0049] 在本实施例中，第三位移杆6、第二位移杆7及第一位移杆8中的两个为滑轨，剩 余一个为直线伸缩装置。通过上述设置，使得两个滑轨运动方向与另一个直线伸缩装置的 伸缩运动方向相互垂直，避免了三个方向的线向运动相互干涉。当然，也可以将第三位移杆 6、第二位移杆7及第一位移杆8均设置为滑轨；或，均设置为直线伸缩装置；或，其中的两 个设置为直线伸缩装置，剩余的一个为滑轨。
[0050] 第三位移杆6及第二位移杆7为滑轨；第二位移杆7滑动设置于第三位移杆6上； 第一位移杆8为直线伸缩装置，其滑动设置于第二位移杆7上，其驱动端与末端法兰9连 接。即，第二位移杆7可滑动的设置于第三位移杆6上，第一位移杆8可滑动的设置于第二 位移杆7上，末端法兰9在第一位移杆8的带动下沿第一位移杆8的延伸方向伸缩运动。通 过上述设置，进一步避免了第三位移杆6、第二位移杆7及第一位移杆8相互干涉的情况。 也可以使第二位移杆7及第一位移杆8设置为滑轨，而第三位移杆6设置为直线伸缩装置； 或者，第三位移杆6及第一位移杆8设置为滑轨，而第二位移杆7设置为直线伸缩装置。在 此不再详细介绍且均在保护范围之内。
[0051] 优选地，直线伸缩装置为直线电机或气缸。通过上述设置，自动调节直线伸缩装置 的伸缩运动，有效提高了自动化程度及方便程度。也可以设置为伸缩杆，通过外置驱动器实 现其伸缩，完成沿其延伸方向运动的效果。
[0052] 本发明实施例还提供了一种机器人，包括机器人主体及末端法兰9,还包括如上述 任一种位移装置；末端法兰9与第一位移杆8连接，机器人主体的驱动末端与第三位移杆6 连接