多机器人的操控方法及操控系统的制作方法
【技术领域】
[0001]本发明涉及机器人领域，特别涉及多机器人的控制技术。
【背景技术】
[0002]随着社会生产技术的飞速发展，机器人的应用领域不断扩展。从自动化生产线到海洋资源的探索，乃至太空作业等领域，机器人可谓是无处不在。然而就目前的机器人技术水平而言，单机器人在信息的获取、处理及控制能力等方面都是有限的，对于复杂的工作任务及多变的工作环境，单机器人的能力更显不足。于是，由多个机器人协调、协作进行生产、探索活动的多机器人系统应运而生。
[0003]在多机器人控制中，通常使用者借助示教器，通过控制器对机器人进行动作操控，目前，一个示教器只能控制一个机器人，虽然已可以实现对多个机器人的操控，但需要多个示教器同时进行操作，使用非常不便。
【发明内容】
[0004]本发明的目的在于提供一种多机器人的操控方法及操控系统，实现一个示教器控制多个机器人。
[0005]为解决上述技术问题，本发明的实施方式提供了一种多机器人的操控方法，包含以下步骤:
[0006]利用示教器预先设置各机器人的动作控制程序;其中，动作控制程序中包含机器人的标识号和该机器人的执行动作；
[0007]通过示教器的人机交互界面，选择至少一个待操作的机器人，并将选择的机器人的标识号通知给控制器；
[0008]控制器控制选择的机器人执行设置的相应动作控制程序；
[0009]示教器周期性地从控制器中获取选择的机器人的反馈的状态，如果反馈的状态中指示机器人已自动停止操作，则通过人机交互界面通知给所述示教器的使用者。
[0010]本发明的实施方式还提供了一种多机器人的操控系统，包含:
[0011 ]示教器和与示教器通信连接的控制器；
[0012]其中，示教器包含:
[0013]程序设置模块，用于预先设置各机器人的动作控制程序;其中，动作控制程序中包含机器人的标识号和该机器人的执行动作；
[0014]选择模块，用于通过人机交互界面，选择至少一个待操作的机器人；
[0015]发送模块，用于将选择模块选择的机器人的标识号通知给控制器；
[0016]接收模块，用于周期性地从控制器中获取选择的机器人的反馈的状态；
[0017]通知模块，用于在反馈的状态指示机器人已自动停止操作时，通过人机交互界面通知给所述示教器的使用者。
[0018]本发明实施方式相对于现有技术而言，通过示教器的人机交互界面选择待操作的机器人，利用示教器预先设置各机器人的动作控制程序，并通过示教器周期性地获取选择的机器人的反馈的状态，将非常占据CPU的界面控制从控制器转移到示教器中，大大减轻了控制器的负担，从而实现一个控制器通过一个示教器控制多个机器人。
[0019]另外，在控制器控制选择的机器人执行设置的相应动作控制程序的步骤之前，还包含:示教器判断机器人的操控模式;如果操控模式为自动操控，则通知控制器禁止对选择的机器人进行参数和动作的设定。这可以防止出现多重控制命令以至于机器人接收到的动作控制程序混乱，进而造成机器人动作不可控的局面。
[0020]另外，示教器周期性地从控制器中获取选择的机器人的反馈的状态的步骤中，包含以下子步骤:如果选择的机器人的个数大于一个，则示教器周期性地以轮询方式从控制器中获取各机器人的反馈的状态。这使得示教器可以及时获得机器人的状态信息，便于有针对性地调整对机器人的动作操控。
[0021]另外，在控制器控制选择的机器人执行设置的相应动作控制程序的步骤后，还包含:如果控制器接收到来自示教器的速度修正指令，则根据该速度修正指令调整机器人的动作执行速度;其中，速度修正指令内携带待调整的机器人标识号、需调整的速度信息。这使得控制器对机器人的控制操作更加细致、准确。
【附图说明】
[0022]图1是根据本发明的第一实施方式的多机器人的操控方法的流程图；
[0023]图2是根据本发明的第二实施方式的多机器人的操控系统的结构示意图。
【具体实施方式】
[0024]为使本发明的目的、技术方案和优点更加清楚，下面将结合附图对本发明的各实施方式进行详细的阐述。然而，本领域的普通技术人员可以理解，在本发明各实施方式中，为了使读者更好地理解本申请而提出了许多技术细节。但是，即使没有这些技术细节和基于以下各实施方式的种种变化和修改，也可以实现本申请各权利要求所要求保护的技术方案。
[0025]本发明的第一实施方式涉及一种多机器人的操控方法。具体流程如图1所示。
[0026]在步骤101中，判断是否选择自动操控模式。若判断为是，则执行步骤102，若判断为否，则执行步骤106 ο具体地说，通过示教器选择使用自动操控模式还是手动操控模式，获得选择结果后，示教器将选择结果通知给控制器。
[0027]在步骤102中，通过示教器选择一个或多个待操控的机器人。具体地说，通过示教器的人机交互界面，选择至少一个待操作的机器人，示教器会记录被选中的所有机器人的标识号，用于接下来分配各被选中的机器人的动作控制程序。各机器人的动作控制程序可以是利用示教器预先设置好的，其中包含机器人的标识号和该机器人的执行动作。
[0028]在步骤103中，检测是否按下启动按键。若检测结果为是，则执行步骤104，若否，则返回等待。进入该步骤，说明已选择使用自动操控模式。示教器判断是否已完成预先设置的动作控制程序的加载，如果已完成，则检测启动按键是否被按下。当检测到启动按键被按下时，开始执行自动操控模式下的相关步骤，否则，返回继续等待。
[0029]在步骤104中，将选择的机器人的标识号通知给控制器。示教器通过以太网给主站(控制器)发送一个数据包，数据包中包含选择的机器人的标识号信息，即，要启动哪几个机器人。
[0030]在步骤105中，通知控制器禁止对选择的机器人进行参数和动作的设定。基于安全保护机制，在自动操控过程中，禁止控制器对被选中的机器人进行参数和动作设定，即禁止控制器对所选机器人进行一般动作控制，以防出现多重控制命令使得机器人接收到的动作控制程序混乱，进而造成机器人动作不可控的局面。
[0031]在步骤106中，控制器控制机器人执行相应动作控制程序。自动操控模式下，机器人执行的动作控制程序是预先设置好的。设置动作控制程序时，预先在示教器的手动模式下新建-激活(激活即是告诉控制器文件名)_编辑机器人动作控制程序，示教器先要读取ftp服务器(位于控制器)中的程序列表，可以新建或直接激活要运行的程序，通过本地编辑程序替换掉ftp服务器中的相应程序，或者，直接在ftp服务器中编辑。本步骤中，控制器读取本地文件(要执行的动作控制程序名称已经通过激活操作告知控制器了)，也就是说，控制器根据示教器通知的程序名称，获取选择的机器人需执行的动作控制程序。不同机器人可以有不同的动作控制程序。
[0032]另外，如果控制器接收到来自示教器的速度修正指令，则根据该速度修正指令调整机器人的动作执行速度;其中，速度修正指令内携带待调整的机器人标识号、需调整的速度信息。这使得控制器对机器人的控制操作更加细致、准确。
[0033]如果控制器检测到针对选择的机器人的急停命令或停止命令，则中止相应机器人的动作。这样有利于保证机器人操作过程中机器人自身以及周围环境的安全性。
[0034]在自动运行过程中也可以切换机器人，比如选中一个机器人做停止操作或查询状
??τ O
[0035]在步骤107中，通过示教器选择一个待操控的机器人。进入该步骤，说明已选择使用手动操控模式。此时出于安全考虑选择手动操控的机器人个数只能是一个。
[0036]在步骤108中，手动操控机器人。在做好前期设置后，可以开始通过示教器手动操控机器人执行各种动作。
[0037]在本实施方式中，手动模式下可以有两种子模式，一种是手动控制执行加工程序，另一种是控制单轴或XYZ方向的移动，不执行加工程序。
[0038]在步骤109中，判断是否达到预设查询周期。若判断结果为是，则执行步骤110，若否，在返回等待。比如，假设预设查询周期为100ms，那么每隔10ms执行一次步骤110，未到预设查询周期时则继续等待。
[0039]在步骤110中，从控制器获取机器人的反馈状态。示教器周期性地(比如每隔100ms)，向控制器发送状态请求消息，从控制器中获取选择的机器人的反馈的状态，如果选择的机器人的个数大于一个，则示教器周期性地以轮询方式从控制器中获取各机器人的反馈的