CN204054037U - 一种带视觉系统的服务机器人 - Google Patents

Abstract

本实用新型公开了一种带视觉系统的服务机器人，包括机器人车体及安装在其上方机械手，所述机器人车体内装有机器人控制车体运动和机械手动作的控制系统，所述机器人车体内还装有嵌入式视觉跟踪系统和WIFI通信模块，视觉跟踪系统的摄像头通过云台安装在机械手上，WIFI通信模块实现控制系统、视觉跟踪系统与上位机的数据与指令的无线传输。本实用新型在服务机器人上采用嵌入式视觉跟踪系统，利用摄像头进行视觉跟踪，并利用WIFI通信模块与上位机实现视觉传输，以WIFI无线网络为数据传输载体，实现实时控制、音视频传输和图像采集等功能的智能系统，本实用新型所述的服务机器人可用于在反恐侦查、战场C4ISR系统、消防救灾、生命探测等民用及军事领域。

Description

一种带视觉系统的服务机器人

技术领域

本实用新型涉及服务机器人，特别涉及一种带视觉系统的服务机器人。

背景技术

针对目前服务机器人都是基于半自动模式下开展任务，这使得需要人的参与控制，这成了服务机器人发展的短板，尤其是高分辨率的物体识别技术一直困扰服务机器人进一步智能化的发展难题，以往一直是使用PC机的参与复杂的图像处理，再通过无线来控制机器人的动作，这样一来消耗了大量的传输时间和受到了距离的限制。

实用新型内容

为克服上述现有技术的缺陷与不足，本实用新型提供一种带视觉系统的服务机器人。

本实用新型所采用的技术方案是：

一种带视觉系统的服务机器人，包括机器人车体及安装在其上方机械手，所述机器人车体内装有机器人控制车体运动和机械手动作的控制系统，所述机器人车体内还装有嵌入式视觉跟踪系统和WIFI通信模块，视觉跟踪系统的摄像头通过云台安装在机械手上，WIFI通信模块实现控制系统、视觉跟踪系统与上位机的数据与指令的无线传输。

具体的，所述机器人车体装有四个车轮，每个车轮由一个直流电机驱动，四个直流电机由可充电电池供电。

优选的，所述云台包括两个数字舵机，摄像头可在云台上可水平0°～180°、上下0°～180°旋转。

优选的，所述机械手为五自由度机械手，由五个微伺服舵机组成，分别对应于臂、肩、肘、前腕和夹持器的五个旋转关节。

优选的，所述控制系统包括单片机及分别与其连接的直流电机驱动电路、舵机驱动电路、下载串口以及数据通信接口。

优选的，所述机器人车体上还装有受控制系统控制的灯光装置。

优选的，所述嵌入式视觉跟踪系统采用采用PropellerP8X32A八核32位芯片嵌入linux系统，在linux系统上运行OPENCV图像处理库驱动摄像头，完成视频采集，数据传输、转发。

进一步优选的，所述上位机采用数据包格式传送指令到机器人WIFI模块，WIFI模块通过解包机制把数据包解开，通过串口发送到单片机并通过各驱动模块执行灯光控制、拍照和机器人运动操作。

优选的、所述上位机的软件客户端包括主窗口和配置窗口，主窗口包括视频显示区及控制按钮，用于显示回传视频和控制机器人运动，配置窗口完成WIFI无线网络及机器人控制指令自定义键值的配置。

优选的，所述上位机利用无线网卡通过Socket发送数据包到WIFI模块。

本实用新型在服务机器人上采用嵌入式视觉跟踪系统，利用摄像头进行视觉跟踪，并利用WIFI通信模块与上位机实现视觉传输，以WIFI无线网络为数据传输载体，实现实时控制、音视频传输和图像采集等功能的智能系统，本实用新型所述的服务机器人可用于在反恐侦查、战场C4ISR系统、消防救灾、生命探测等民用及军事领域。

附图说明

图1是本实用新型所述的服务机器人的立体示意图；

图2是本实用新型所述的服务机器人的侧视图；

图3是本实用新型的系统整体实现框图；

图4是本实用新型的电机驱动电路的实施例原理图；

图5是本实用新型的舵机驱动电路的实施例原理图；

图6是本实用新型的软件系统体系结构示意图。

具体实施方式

为了便于本领域技术人员理解，下面将结合附图以及实施例对本实用新型进行进一步详细描述。

如图1、2和3所示，本实用新型所揭示的带视觉系统的服务机器人，包括机器人车体及安装在其上方的机械手，所述机器人车体内装有机器人控制车体运动和机械手动作的控制系统，所述机器人车体内还装有嵌入式视觉跟踪系统和WIFI通信模块，视觉跟踪系统的摄像头通过云台安装在机械手上，WIFI通信模块实现控制系统、视觉跟踪系统与上位机的数据与指令的无线传输。

所述车体采用全铝合金钣金模型，面板上设计有多用途固定孔，满足以后升级的扩展，表面为氧化磨砂处理，可以起到抗氧化生锈等，车体装有4个车轮，内部主要由4个12V/120转直流电机和电池组构成，电机两两并联，相当于驱动两个电机，增大机器人的运载能力和爬坡能力。为方便电池充放电，设计了充放电电路，只需拨动开关即可实现充放电操作。电池组电源12V，可多个并联使用，为机器人提高持久动力。

机械手采用五自由度铝合金机械手，由五个精确的微伺服舵机组成，分别对应于臂、肩、肘、前腕、夹持器五个旋转关节，每个关节可在规定的范围内活动，其可安装到移动平台用于工作人员可视作业，实时修改控制指令，随时精确地完成每一项任务。机械手的总体架构使用铝合金钣金材料磨砂氧化处理机械件加角度舵机构成，角度舵机的控制方式为高脉冲控制信号控制，对应的有32路舵机控制器。

摄像头选择高质量高清摄像头进行监控，摄像头满足0°～180°水平，0°～180°上下旋转，可以远程打开或关闭。摄像头型号为索尼PS2，通讯接口为USB协议。云台由2个MG995数字舵机及其他辅助材料构成。

WIFI模块采用TP—LINK全新推出的150Mbit.s-1迷你型3G无线路由器。该路由器具有尺寸小，供电电压低的特点。其供电电压只有5V，且支持OpenWrt。OpenWrt是一个基于Linux的开源路由固件，提供了一个完全可写的文件系统及软件包管理，对支持OpenWrt的路由器刷机后，其相当于一个Linux小系统。路由器选择OpenWrt作为操作系统，将USB摄像头采集的现场图片发给远端的PC控制终端，并将上位机发出的命令通过串口转发给单片机控制系统。

控制系统主要包括电源模块、电机驱动、舵机驱动、下载串口、单片机电路、红外壁障、车灯控制以及数据通信接口等。电机驱动采用英飞凌公司的BTS7960直流电刷电机驱动芯片，其具有大电流MOSFET半桥结构。芯片具有较高的集成度和足够的输出能力，并在能耗方面具有优势。在集成化和小型化的电机控制系统中，适合作为理想的电机驱动芯片。

图4为BTS7960与单片机组成的H电机驱动单元。由于所采用驱动芯片是半桥，因此需要采用两片以构成全桥实现电机的正反转。单片机产生2路PWM输出作为两片BTS7960的控制信号，同时要求PWM0、PWM1不能同时为高电平。采用定时器输出硬件PWM脉冲，使得单片机CPU只在改变PWM占空比时参与运算，这样可大幅减轻系统运算负担和PWM软件编程成本。

图5为舵机驱动方案电路图。为保证较高的电源利用率，舵机驱动采用LM2596开关型稳压芯片实现，它可以提供3A以上电流，驱动强劲。由于舵机型号为MG995，其工作电压为5.0V～7.0V.因此舵机驱动芯片选择了可调LM2596-ADJ芯片，其输出电压Vout=Vref（1.0+R2/R1），其中，Vref=1.23V为芯片内部参考电压。

嵌入式视觉跟踪系统采用parallax公司的Propeller P8X32A八核32位芯片嵌入linux系统，在linux系统上运行OPENCV图像处理库驱动OV7665摄像头来实现，把常用的算法全部以函数的方式写好，外部可以通过串口总线来调用指令来调用模块中的功能模块，这样做可以把视觉处理等复杂功能可以内置在一个集成模块中。

WIFI视觉传输是以WIFI无线网络为数据传输载体，实现实时控制、音视频传输和图像采集等功能的智能系统。经测试，该机器人可用于在反恐侦查、战场C4ISR系统、消防救灾、生命探测等民用及军事领域。

操作员在操作终端通过WIFI无线网络连接到小车内置的WIFI模块上，并向其发出相关操作指令，WIFI模块接收指令并传递给内置的单片机，单片机通过控制电路让机器人执行相应的指令；同时，安装在机器人上的各种传感器和摄像头可以通过WIFI网络将数据反向传递给操作终端，从而实现上下行控制及双向通信，以便操作员实时了解机器人周围的环境，并根据环境情况发出指令控制机器人执行特定的任务，实现交互式操作。

本实用新型的软件系统体系结构如图6所示，操作系统采用OpenWrt，此部分在路由器刷机部分完成，主要完成视频采集、数据传输、转发等功能。上位机软件控制灯光控制、拍照、实时控制机器人运动等行为。下位机软件通过接收来自上位机的命令，从而执行相应操作。而连接上位机和下位机之间的纽带就是通信协议，软件部分包括通信协议，客户端控制软件和下位机软件。在此主要介绍通信协议和上位机的开发。

通信协议上位机采用数据包格式传送指令，也可以采用单字符的形式发送，由于单字符通信方式干扰较大，因此采用数据包格式传送指令，包头用OXFF，包尾用OXFF，无校验位。上位机利用无线网卡通过Socket发送数据包到路由器，路由器通过解包机制把数据包解开，通过串口发送到单片机并通过控制模块执行相关操作。其协议规定如表1所示。

表1通信协议规定

数据位	功能	数据位	功能
				0x00	停止	0x05	舵机上
0x01	前进	0x06	舵机下
				0x02	后退	0x07	舵机左
0x03	电机左转	0x08	舵机右
				0x04	电机右转

对于控制平台，采用一种基于Windows CE.net技术的方法，文中使用Visual Studio2010编写C#上位机客户端。采用TCP/IP协议，利用Socket发送数据包到路由器。客户端包括两个窗口：主窗口和配置窗口。主窗口包括视频显示区及控制按钮区，主要用于显示回传视频和实现机器人运动控制。配置窗口主要完成WIFI无线网络及机器人控制指令自定义键值的配置。

根据表1的通信协议，上位机通过Socket以Byte打包的方式向机器人发送控制命令，同时接收摄像头回传视频流并在视频显示区实时显示。视频部分也可将摄像头拍摄的视频分解成一张张独立的jpg图片发送到客户端，客户端再将图片组合成视频。对于Socket数据发送，首先创建Socket对象的实例，创建Socket实例后上位机即可通过Connect方法连接到路由器，并通过Send方法路由器发送数据。数据发送完成后用Close方法关闭Socket以释放资源。

除此之外，采用配置文件的方式来存取上一次配置的数据，以免重复配置，并通过定义8个键盘值，便于观察事件的执行，以此可方便地通过键盘的触发事件实现电机和舵机的全方位移动，且增加了拍照和车灯控制命令，经测试上位机软件运行良好。

下位机软件驱动板采用arduino2560控制器。基于arduino2560的嵌入式控制系统提供了一种灵活性高且成本低的方案。下位机程序主要包括：外部中断、舵机PWM中断、定时器、串口中断、初始化等。下位机程序接收来自路由器转发的上位机命令，实现数据接收、摄像头云台全方位控制、电机转向、车灯控制、电池电量指示、红外壁障等功能。

在目前所设计小型服务机器人可是实现移动搬运物体(加载多自由度机械臂)、目标跟踪、GPS定位、超声波测距、外网控制等，则可实现全方位、超远距离控制，并广泛应用于助老服务、险情探测服务、图像采集服务、目标定位服务、无线通信等领域。

以上为本实用新型的其中具体实现方式，其描述较为具体和详细，但并不能因此而理解为对本实用新型专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本实用新型构思的前提下，还可以做出若干变形和改进，这些显而易见的替换形式均属于本实用新型的保护范围。

Claims (9)

1.一种带视觉系统的服务机器人，包括机器人车体及安装在其上方的机械手，所述机器人车体内装有机器人控制车体运动和机械手动作的控制系统，其特征在于：所述机器人车体内还装有嵌入式视觉跟踪系统和WIFI通信模块，视觉跟踪系统的摄像头通过云台安装在机械手上，WIFI通信模块实现控制系统、视觉跟踪系统与上位机的数据与指令的无线传输。 

2.根据权利要求1所述的带视觉系统的服务机器人，其特征在于：所述机器人车体装有四个车轮，每个车轮由一个直流电机驱动，四个直流电机由可充电电池供电。 

3.根据权利要求2所述的带视觉系统的服务机器人，其特征在于：所述云台包括两个数字舵机，摄像头可在云台上可水平0°～180°、上下0°～180°旋转。 

4.根据权利要求3所述的带视觉系统的服务机器人，其特征在于：所述机械手为五自由度机械手，由五个微伺服舵机组成，分别对应于臂、肩、肘、前腕和夹持器的五个旋转关节。 

5.根据权利要求4所述的带视觉系统的服务机器人，其特征在于：所述控制系统包括单片机及分别与其连接的直流电机驱动电路、舵机驱动电路、下载串口以及数据通信接口。 

6.根据权利要求5所述的带视觉系统的服务机器人，其特征在于：所述机器人车体上还装有受控制系统控制的灯光装置。 

7.根据权利要求6所述的带视觉系统的服务机器人，其特征在 于：所述嵌入式视觉跟踪系统采用Propeller P8X32A八核32位芯片嵌入linux系统，在linux系统上运行OPENCV图像处理库驱动摄像头，完成视频采集，数据传输、转发。 

8.根据权利要求7所述的带视觉系统的服务机器人，其特征在于：所述上位机采用数据包格式传送指令到机器人WIFI模块，WIFI模块通过解包机制把数据包解开，通过串口发送到单片机并通过各驱动模块执行灯光控制、拍照和机器人运动操作。 

9.根据权利要求8所述的带视觉系统的服务机器人，其特征在于：所述上位机利用无线网卡通过Socket发送数据包到WIFI模块。