一种双机器人实时动态避障装置的制造方法
【技术领域】
[0001]本实用新型属于工业机器人控制领域，更具体地，涉及一种双机器人实时动态避障装置。
【背景技术】
[0002]目前，传统机器人行业使用的都是单臂机器人，也就是工作位置固定，机器人末端安装相应的工具，运动到工作位置来进行相应的搬运、装配、焊接、打磨等工作。而随着对加工效率的提高，一般在加工操作中都需要进行多个机器人的协同操作，而现有的双工业机器人协同工作时，每个机器人都由自己的控制器独立控制。为了防止发生碰撞，当一个单臂机器人要进入某一个共同工作区域时，必须实时发送碰撞信号到另外一台单臂机器人进行确认，并且必须待一个机器人退出该共同工作区域后，另外一台机器人才能进入工作，因此双机器人协作过程中存在等待，导致其工作效率存在很大的瓶颈。
[0003]基于智能避障系统的双臂机器人，可以实现一个机器人在搬运、装配、焊接或者打磨工件时，另一个机器人可以在同一区域进行加工操作，不存在碰撞等候区，更好地满足了工业生产过程的多机器人机协同工作能力。
[0004]目前现有技术中申请号为201010615758.8，公开号为CN 101512453 B，名称为“避免工业机器人与物体之间碰撞的方法和设备”的专利文献提供了机器人对碰撞预测的可能性，该技术的局限性体现在于，不能实现动态的避障，当预测到机器人与周围物体发生碰撞时，仅发信号给机器人让其停止运动，无法保证两机器人协同工作的连续性;另外一篇申请号201510079471.0，公开号CN 104760043 A，名称为“一种基于智能避障系统的双臂机器人控制器”，该技术解决了双臂机器人的无碰撞运动规划，该种避障技术的局限在于机器人必须按照预先离线编程规划好的路径工作，不能在实际工作过程中进行实时碰撞检测及动态避免碰撞。
【实用新型内容】
[0005]针对现有技术的以上缺陷或改进需求，本实用新型提供了一种双机器人实时动态避障装置及其避障方法，其目的在于减少避障过程中的机器人等待时间，实现实时动态避障，由此提高双机器人的工作效率。
[0006]为实现上述目的，按照本实用新型的一个方面，提供了双机器人实时动态避障装置，其特征在于，所述避障装置包括避障主控模块，所述避障主控模块包括依次相连的位置检测模块、碰撞检测模块以及动态避障模块，所述位置检测模块与所述双机器人本体的电机通信，实时采集所述双机器人本体的位置信息，所述碰撞检测模块接收所述位置检测模块发送的所述位置信息，并与所述双机器人本体发生碰撞的安全距离进行比较，所述动态避障模块接收所述碰撞检测模块的结果进行所述双机器人本体的避障路径规划，并将所述避障路径规划发送于所述双机器人本体的电机驱动器，驱动所述双机器人本体执行所述避障路径。
[0007]进一步地，所述安全距离的定义如下:对所述双机器人本体的大臂、小臂以及手腕进行包络体表达，所述包络体中间由圆柱体组成，所述包络体的两端由球体组成，所述安全距离由所述包络体的尺寸距离表达。
[0008]进一步地，所述安全距离为任何一所述双机器人本体的所述包络体不发生碰撞叠加。
[0009]进一步地，所述避障路径规划的执行可由其中之一的所述机器人本体完成或者由两者共同完成。
[0010]进一步地，所述位置信息包括角度信息和角速度信息。
[0011]总体而言，通过本实用新型所构思的以上技术方案与现有技术相比，能够取得下列有益效果:
[0012]本实用新型提供一种具有动态避障功能的双臂机器人控制装置，能够在2个机器人即将发生碰撞时及时规划出新的无碰撞路径，避免碰撞，而不是停止机器人，最大化提高了双机器人的高效性、安全性;此装置的优势在于具有前瞻性，可以提前检测到碰撞的风险，增强了检测到即将碰撞的机会。另外一个优势在于能够实现动态避障;利用具有动态避障功能的该控制装置直接控制两台具备6自由度的机器人，实现对机器人的实时动态避障；并且该避障装置的模块化使得其可以应用于各类安装在同一基座下的机器人，可以涉及的加工操作过程包括打磨、装配、喷涂、焊接等，具有非常广泛的应用范围。
【附图说明】
[0013]图1是按照本实用新型实现的动态避障装置与双机器人的配合安装示意图；
[0014]图2是按照本实用新型实现的对机器人进行外形包络体生成的示意图；
[0015]图3是按照本实用新型实现的两个机器人进行外形简化的示意图；
[0016]图4是按照本实用新型实现的实时动态避障装置的整体模块结构示意图；
[0017]图5是按照本实用新型实现的具有智能避障功能的机器人的控制方法流程示意图。
[0018]在所有附图中，相同的附图标记用来表示相同的元件或结构，其中:
[0019]1-位置检测模块2-碰撞检测模块3-动态避障模块4-动态避障主控模块5-通讯模块6-输入输出模块7-1,7-2-电机驱动器8-1,8-2-电机9-第一机器人本体10-电源模块11_第二机器人本体12_1，12_2-底座13_1，13-2-机器人大臂14_1，14_2_机器人小臂15-1，15-2-机器人手腕
【具体实施方式】
[0020]为了使本实用新型的目的、技术方案及优点更加清楚明白，以下结合附图及实施例，对本实用新型进行进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本实用新型，并不用于限定本实用新型。此外，下面所描述的本实用新型各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
[0021]如图1所示，首先对该避障装置如何与双机器人实现控制连接的进行说明，其中机器人9和机器人11是按照机器人的运动关节构成对双机器人进行了简化，如图3所示，输入输出模块6和通讯模块5，并且与输入输出模块6和通讯模块5相连的动态避障主控模块4，其中该避障装置通过输入输出模块6分别与两个机器人9和机器人11进行通信输出控制，并且还能通过通讯模块5以及输入输出模块6与外接的设备进行通信。
[0022]如图2所示，是按照现有技术中的机器人的运动关节来进行机器人的简化示意图，所述机器人包括两台机器人机械本体9和11、电机驱动器7，电机8，所述两台机器人机械本体分别具备6个自由度，所述机器人本体由两台安装在一个基座上的具备6个自由度的机器人组成，其中自由度包括底座12，大臂13，小臂14，手腕15旋转，手腕15摆动，手腕15回传，电机驱动模块7接收控制器的命令，驱动电机8转动，电机通8过机械传动驱动机器人机械本体9和11的轴转动，6自由度工业机器人按照结构分，可以分成底座12、大臂13、小臂14、手腕15共4个主要的部分，在这种情况下，对机器人大臂13、小臂14和手腕15都具有一定的几何形状和尺寸，根据这些参数，机器人的大臂13、小臂14和手腕15各自用一个封闭的包络体来表示，该包络体两端由球体组成，中间由圆柱体组成，圆柱体和球体的半径根据机器人的几何形状来确定，圆柱体可以用其中心线表示，球体用其球心表示，因此每个防护区就可以用一条线段来表示，机器人简化成一些列的线段，线段相连的地方为机器人的关节，如图3所不O
[0023]在运动过程中，底座12的位置是固定的，机器人发生碰撞取决于大臂13、小臂14、手腕15在空间中的相对位置，因此，机器人大臂13、小臂14和手腕15需要判断是否将发生碰撞。大臂13在空间中的位置与机器人前2个关节的角度Al和A2有关系，小臂14在空间中的位置与机器人的前3个关节的角度A1、A2、A3有关系，手腕15在空间中的位置与机器人6个关节的角度A1、A2、A3、A4、A5、A6均有关系，机器人大臂13、小臂14和手腕15都具有一定的几何形状和尺寸，根据这些参数以及上述的机器人包络体的抽象来进行实时避障的规划。
[0024]其中如图4所示，是对按照本实用新型实现的双机器人实时动态避障装置的整体模块结构示意图，首先该实时避障装置包括分别与第一及第二机器人的电机8-1、8-2相连的位置检测模块1，用于对电机的驱动操作下的机器人本体的位置进行实时的检测测量，其中碰撞检测模块2与位置检测模块I相连，对位置检测模块I采集到的位置信息进行是否发生碰撞的评估，其中动态避障运算模块3与碰撞检测模块2相连，用于接收碰撞检测模块2的信息，并且对第一和第二两个机器人的运动路径进行重新的避障规划，其中位置检测模块
1、碰撞检测模块2及动态避障运算模块3共同组成避障模块4，而通讯模块5通过避障模块4与第一及第二机器人的电机驱动器7进行信息通信，电机驱动器7-1，7-2驱动电机8-1，8-2对机器人进行避障规划路线之后的运动路线进行动作，由此实现动态实时的避障操作。
[0025]其中位置检测模块I通过检测机器人当前的位置和角速度，通过碰撞检测模块2判断2个机器人是否发生碰撞，如果将要发生碰撞，则启动避障算法，动态避障模块3规划出新的无碰撞路径，并发送给机器人;输入输出模块6允许接收外部指令和输出状态信息，通讯模块5实现与机器人以及外部网络设备的实时通讯，电源模块则为整个避障工作装置提供工作电源。
[0026]更为具体的实现方式，位置检测模块I包括角度传感器、角速度传感器，实时采集各关节的角度和角速度；
[0027]碰撞检测模块2，根据机器人的几何模型，机器人的位置信息以及机器人即将进行的未规避碰撞