基于无线网络的多机器人搬运控制系统的制作方法

文档序号:6285644阅读:299来源:国知局
专利名称:基于无线网络的多机器人搬运控制系统的制作方法
技术领域
本发明涉及多机器人协调控制系统,特别涉及基于无线网络的多机器人搬运控制系统。
背景技术
传统上6自由度机器人系统包括串联机构机器人和并联机构机器人两类。前者(图1)特点是采用开链式机构,作业空间大,但具有刚度低,承载能力低的缺点。后者(图2)的特点采用闭链式机构,具有刚度、承载能力大,精度高的优点,但是操作空间狭小(见黄真,孔令富,方跃法,“并联机器人机构学理论及控制”,机械工业出版社,1997)。在有些作业场合,比如大型船体分段的6自由度对接,即需要高达上千吨的承载能力,又需要能容纳下长达几米甚至几十米船体分段的操作空间,不论是串联机器人还是并联机器人目前都达不到这种要求。
图3是由多个3自由度移动机器人C1、C2、C3和C4等构成的6自由度多机器人搬运平台,这类系统不但具备了6自由度位姿自动调整功能,而且具有承载能力大、刚度大和作业空间大的优点。每个移动机器人具有沿X、Y和Z方向的3个运动自由度(图4),即dx、dy和dz。通过多机器人的协调运动可以完成被搬运物体的6自由度调整,即沿X、Y和Z轴的线位移px,py,pz和绕X、Y和Z轴的角位移φ,α,θ(图3)。对于图3所示的多机器人系统来说,保证各个机器人协调一致的动作是对该系统控制功能的基本要求,要达到这项要求,就需要控制系统的通讯具备良好的实时性和可靠性。目前还不存在针对图3所示的多机器人搬运平台专门设计的控制系统。

发明内容
本发明的目的是提供一种基于无线网络的多机器人搬运控制系统。
为实现上述目的,一种基于无线网络的多机器人搬运控制系统,包括上位机控制子系统,用于响应用户的操作命令、规划搬运任务并监控下位机控制子系统;多个下位机控制子系统,用于机器人关节运动轨迹规划、完成运动伺服并为上位机传递机器人运行状态参数;上位机控制子系统和下位机控制子系统通过无线网络相连。
本发明的系统可用于6自由度多机器人搬运平台的实时控制,给出的控制方案除具有实时性高,抗干扰性强的优点外,而且还可实现远程监控,易于信息自动化管理。


图1为6自由度串联结构工业机器人示意图;图2为6自由度并联结构工业机器人示意图;图3为6自由度多机器人搬运平台示意图;图4为3自由度移动机器人示意图;图5为多机器人搬运平台控制系统的上位机模块连接图;图6为3自由度移动机器人控制系统的下位机模块连接图
具体实施例方式
本发明是针对多机器人搬运平台的基于无线通讯模式的离散控制系统,该系统由上位机控制子系统(图5)和多个下位机控制子系统(图6)构成。上位机控制子系统负责响应用户的操作命令、规划搬运任务并监控下位机控制子系统;下位机子系统负责机器人关节运动轨迹规划、完成运动伺服并为上位机传递机器人运行状态参数。上位机控制子系统和下位机控制子系统通过无线网络相连。由于无线网络采用了特殊的跳频和加密算法,使得系统的通讯速率、抗干扰能力比起常规的串行通讯大大提高,方便了系统的实时控制。另外,由于是无线传输,上位机和下位机在物理设备上是分离的,因此在通讯距离允许的范围内,上位机系统和下位机系统的位置可以随意调整,这一方面简化了系统的线路铺设,另一方面更便于系统的信息自动化管理。
图5为上位机控制子系统的模块图。其核心部件是工业PC机I1。通过PC总线,I1同无线网卡R1连接。R1通过无线载波与无线网桥(即无线网络接入点)AP相连。其工作原理如下工业计算机I1装有通用操作系统,应用软件提供友好的人机界面来响应用户操作。根据用户设置的搬运物体的位移量px、py、pz、Φ、α和β,应用软件根据特定算法计算各个机器人的的位移dx、dy和dz,通过连接在PC总线上的无线网卡R1发给无线网桥AP,再由AP下传到各个3自由度机器人的下位机控制子系统。同时,AP向R1发送由各个3自由度机器人上传的信息。
图6为下位机控制子系统的模块图。其核心部件是PC/104单元P1。通过PC/104总线,P1分别同多轴运动控制卡C2,以及无线网卡接入单元C1连接。其中,C1与无线网卡W1连接;C2分别连接机器人3个运动关节的伺服放大器A1、A2和A3;而A1、A2和A3分别连接对应的M1、M2和M3关节驱动器。其工作原理是PC/104单元P1装有实时操作系统,以使应用软件能及时响应外部事件。无线网卡W1从无线网桥AP(图5)获得上位机下传的机器人关节位移命令dx、dy和dz并发送给PC/104单元P1;P1再将命令传给多轴运动控制卡C2,C2完成关节轨迹规划并和伺服放大器A1、A2、A3一起控制M1,M2和M3完成各个关节位移;同时,P1把得到的控制系统信息通过W1上传给AP。
实施例在实施例中,按图4搭建了由四台CAS-II型3自由度移动机器人构成6自由度多机器人搬运平台,通过图5和图6所示的控制系统实现了对搬运平台的控制。其中,图5中工业计算机I1采用ADVANTECH-610,内装Windows 2000操作系统和上位机应用软件;无线网卡R1采用清华同方TFW1200-PCI;无线网桥AP采用清华同方TFW2000。图6中PC/104单元P1采用研华PCM-3345,内装RT-Linux嵌入式实时操作系统和下位机应用软件;无线网卡接入模块C1采用研华PCM-3110C;无线网卡W1采用清华同方TFW1000-PCMCIA;多轴控制卡C2采用美国Delta Tau公司的PMAC2A-PC/104;伺服放大器A1、A2和A3均采用日本安川YASKAWACACR-SR15SZ1SD-Y214型单轴驱动伺服包,用于驱动CAS-II型机器人的3个关节电机M1、M2和M3。经实际测定,从上位机控制子系统发出运动命令到下位机响应命令所需时间最多为15毫秒,能够满足本系统实时控制的要求;而关节控制精度为0.1毫米,满足本系统的运动精度控制要求。
权利要求
1.一种基于无线网络的多机器人搬运控制系统,其特征在于包括上位机控制子系统,用于响应用户的操作命令、规划搬运任务并监控下位机控制子系统;多个下位机控制子系统,用于机器人关节运动轨迹规划、完成运动伺服并为上位机传递机器人运行状态参数;上位机控制子系统和下位机控制子系统通过无线网络相连。
2.按权利要求1所述的系统,其特征在于所述上位机控制子系统包括工业PC机I1,通过PC总线,I1同无线网卡R1连接,R1通过无线载波与无线网桥AP相连。
3.按权利要求1所述的系统,其特征在于所述下位机控制子系统包括PC/104单元P1,通过PC/104总线,P1分别同多轴运动控制卡C2,以及无线网卡接入单元C1连接,其中,C1与无线网卡W1连接,C2分别连接机器人3个运动关节的伺服放大器A1、A2和A3,而A1、A2和A3分别连接对应的M1、M2和M3关节驱动器。
全文摘要
一种基于无线网络的多机器人搬运控制系统,包括上位机控制子系统,用于响应用户的操作命令、规划搬运任务并监控下位机控制子系统;多个下位机控制子系统,用于机器人关节运动轨迹规划、完成运动伺服并为上位机传递机器人运行状态参数;上位机控制子系统和下位机控制子系统通过无线网络相连。本发明的系统可用于6自由度多机器人搬运平台的实时控制,给出的控制方案除具有实时性高,抗干扰性强的优点外,而且还可实现远程监控,易于信息自动化管理。
文档编号G05D3/00GK1603068SQ0313929
公开日2005年4月6日 申请日期2003年9月29日 优先权日2003年9月29日
发明者景奉水, 谭民, 梁自泽, 徐德, 王跃 申请人:中国科学院自动化研究所
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1