CN103235595B - 一种室外微小型地面群机器人控制系统及控制方法 - Google Patents

一种室外微小型地面群机器人控制系统及控制方法 Download PDF

Info

Publication number
CN103235595B
CN103235595B CN201310151420.5A CN201310151420A CN103235595B CN 103235595 B CN103235595 B CN 103235595B CN 201310151420 A CN201310151420 A CN 201310151420A CN 103235595 B CN103235595 B CN 103235595B
Authority
CN
China
Prior art keywords
module
base station
robot
individual
wireless communication
Prior art date
Application number
CN201310151420.5A
Other languages
English (en)
Other versions
CN103235595A (zh
Inventor
吴亮红
曾照福
周少武
左词立
王汐
Original Assignee
湖南科技大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 湖南科技大学 filed Critical 湖南科技大学
Priority to CN201310151420.5A priority Critical patent/CN103235595B/zh
Publication of CN103235595A publication Critical patent/CN103235595A/zh
Application granted granted Critical
Publication of CN103235595B publication Critical patent/CN103235595B/zh

Links

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02PCLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P90/00Enabling technologies with a potential contribution to greenhouse gas [GHG] emissions mitigation
    • Y02P90/02Total factory control, e.g. smart factories, flexible manufacturing systems [FMS] or integrated manufacturing systems [IMS]

Abstract

本发明公开了一种室外微小型地面群机器人控制系统及控制方法,控制系统包括差分定位基站、上位监控计算机和构成群机器人系统的多个个体机器人,其中:差分定位基站,用于实时接收定位信号并与给定的基站参考坐标进行伪距差分计算,然后将差分修正数通过无线通信模块发送给群机器人系统中的个体机器人;个体机器人实时接收定位信号和基站发送的差分修正数,进行伪距差分计算后得到位置坐标;上位监控计算机通过无线通信模块接收个体机器人的位置信息以及发送指令以控制个体机器人的运行。该室外微小型地面群机器人控制系统及控制方法能提高个体机器人的定位精度,有利于实现群机器人的协作控制和联合目标搜索等复杂任务。

Description

-种室外微小型地面群机器人控制系统及控制方法

技术领域

[0001] 本发明属于自动化技术的机器人领域,设及一种室外微小型地面群机器人控制系 统及控制方法。

背景技术

[0002] 目前就机器人技术水平而言,单机器人在信息的获取、处理及控制能力等方面都 是有限的,对于复杂的工作任务及多变的工作环境,单机器人的能力更显不足。于是,借鉴 社会性昆虫的群体智能行为,人们考虑由多个机器人组成的群体系统通过协调、协作来完 成单机器人无法或难W完成的工作。群机器人通过共享资源(信息、知识等)弥补单机器 人能力的不足,扩大完成任务的能力范围,利用系统内机器人资源的冗余性提高完成任务 的可能性,增加系统的性能。

[0003] 群机器人在协作执行任务的过程中,个体机器人需要知道自身及周围相邻个体机 器人的位置信息。因此,个体机器人对自身W及相邻个体的快速准确定位是群机器人实现 协作控制和群体涌现的基础。个体机器人的定位技术主要有绝对定位和相对定位两类。传 统的多机器人定位技术大多通过卡尔曼滤波或粒子滤波等复杂运算将内部传感器和外部 传感器信息进行融合估计。运些定位技术在短时间内具有较好的精度和稳定性,但是测量 误差会随着时间的增加而不断积累,最终导致测量失效。

[0004] 因此,有必要设计一种室外微小型地面群机器人控制系统及控制方法。

发明内容

[0005] 本发明所要解决的技术问题是提供一种室外微小型地面群机器人控制系统及控 制方法,该室外微小型地面群机器人控制系统及控制方法能提高个体机器人的定位精度, 有利于实现群机器人的协作控制和联合目标捜索等复杂任务。

[0006] 发明的技术解决方案如下:

[0007] -种室外微小型地面群机器人控制系统,包括差分定位基站、上位监控计算机和 构成群机器人系统的多个个体机器人,其中:

[0008] 差分定位基站,用于实时接收定位信号(如GI^信号)并与给定的基站参考坐标 进行伪距差分计算,然后将差分修正数通过无线通信模块发送给群机器人系统中的个体机 器人;

[0009] 所述的个体机器人为微小型地面移动机器人,所有的个体机器人具有相同的硬件 系统,多个个体机器人之间通过无线通信连接组成一个机器人群体并实现相互协作;

[0010] 个体机器人实时接收定位信号(如GI^信号)和基站发送的差分修正数,进行伪 距差分计算后得到位置坐标;

[0011] 上位监控计算机通过无线通信模块接收个体机器人的位置信息W及发送指令W 控制个体机器人的运行。

[0012] 所述构成群机器人系统的个体机器人,根据任务分配和其它个体机器人的位置信 息并结合自身感知,进行行为决策和运动规划。

[0013] 所述差分定位基站包括基站AVR嵌入式控制器模块、基站定位信号接收模块和基 站甜ee无线通信模块,其中:

[0014] 基站定位信号接收模块(GPS/北斗信号接收模块)与基站AVR嵌入式控制器模块 相连接,基站AVR嵌入式控制器模块将基站参考位置坐标(基站位置坐标可W为绝对坐标 或相对坐标)通过第一串口(UART)发送给基站定位信号接收模块进行伪距差分计算,然后 将基站定位信号接收模块计算得到的差分修正数通过基站Xbee无线通信模块发送给群机 器人系统中的个体机器人;

[0015] 所述基站定位信号接收模块通过测量天线接收定位信号,通过第一串口扣ART) 接收基站AVR嵌入式控制器模块发送的基站位置坐标,并对接收的定位信号与基站位置坐 标进行伪距差分计算,然后将差分修正数通过第二串口 0JART)发送给基站AVR嵌入式控制 器模块;

[0016] 所述基站甜ee无线通信模块与基站AVR嵌入式控制器模块连接,用于发送定位信 号接收模块计算得到的差分修正数给群机器人系统中的个体机器人。

[0017] 所述基站AVR嵌入式控制器模块包括:AVR处理器、SDRAM存储器、Flash存储器W 及复位电路;

[0018] 所述Flash存储器,用于存储初始化程序和应用程序;

[0019] 所述AVR处理器,用于发送基站坐标给定位信号接收模块,接收定位信号接收模 块发送的伪距差分修正数;通过所述基站甜ee无线通信模块将伪距差分修正数发送给群 机器人系统中的个体机器人;

[0020] 所述复位电路,用于整个群机器人基站控制系统的复位。

[0021] 所述构成机器人群体的个体机器人包括移动站AVR嵌入式控制器模块、移动站定 位信号接收模块(GPS/北斗信号接收模块)、移动站Xbee无线通信模块、传感器模块、电机 驱动模块、键盘与显示模块和电源管理模块,其中:

[0022] 所述移动站AVR嵌入式控制器模块,与移动站定位信号接收模块连接,将所述移 动站甜ee无线通信模块接收到的基站发送的差分修正数通过第一串口扣ART)传送给移 动站定位信号接收模块进行伪距差分计算,并通过移动站定位信号接收模块的第二串口 0JART)接收伪距差分定位结果;

[0023] 所述移动站AVR嵌入式控制器模块,与移动站甜ee无线通信模块连接,将所述移 动站定位信号接收模块通过第二串口扣ART)发送的伪距差分定位结果通过移动站甜ee无 线通信模块发送给其他个体机器人;

[0024] 所述移动站定位信号接收模块,通过测量天线接收定位信号(如GI^信号/北斗 信号),通过第一串口扣ART)接收基站发送的差分修正数,并对接收的定位信号与差分修 正数进行伪距差分计算,然后将伪距差分定位结果(也可W称为伪距差分定位信息)通过 第二串口扣ART)发送给移动站AVR嵌入式控制器模块;

[00巧]所述移动站甜ee无线通信模块,与移动站AVR嵌入式控制器模块连接,将移动站 定位信号接收模块计算得到的伪距差分定位结果发送给其他个体机器人;

[0026] 所述传感器模块,用于采集外部环境信息和个体机器人的位姿信息,W便机器人 进行行为决策和运动规划;

[0027] 所述电机驱动模块与移动站AVR嵌入式控制器模块连接,电机驱动模块驱动个体 机器人完成各种运动;

[0028] 所述电源管理模块包括电池组和所述各模块所需电源电压的转换电路;

[0029] 所述键盘与显示模块用于人机信息交互和复位操作。

[0030] 所述移动站AVR嵌入式控制器模块包括:AVR处理器、SDRAM存储器、Flash存储器 W及复位电路;

[0031] 所述Flash存储器,用于存储初始化程序和应用程序;

[0032] 所述AVR处理器,用于发送差分修正数给定位信号接收模块,接收移动站定位信 号接收模块发送的伪距差分定位结果;通过所述移动站Xbee无线通信模块将伪距差分定 位结果发送给其他个体机器人,接收差分定位基站发送的差分修正数和其他个体机器人发 送的信息,将个体机器人的位置信息发送给上位监控计算机,接收上位监控计算机的控制 指令控制个体机器人的运动;接收并处理各种传感器信息;对电机驱动模块发出信号,驱 动个体机器人完成各种运动控制;

[0033] 所述复位电路,用于整个个体机器人控制系统的复位。

[0034] 所述基站甜ee无线通信模块或移动站甜ee无线通信模块被配置为协调器、路由 器或终端。

[0035] 所述传感器模块包括:里程计、巧螺仪、数字罗盘、超声波传感器和摄像头,定位信 号接收模块为定位信号(如GI^信号/北斗信号)接收模块或北斗导航接收模块。基站与 个体机器人采用相同的控制器、定位信号接收模块和无线通信模块。

[0036]AVR处理器采用ATmega2560,基站定位信号接收模块或移动站定位信号接收模块 采用GPS信号接收模块犯MStar,测量天线采用单频外置测量天线HY-LRB01R,基站甜ee 无线通信模块或移动站甜ee无线通信模块采用甜eePROSeries2,电机驱动模块采用 L298P,巧螺仪采用L3G4200D,数字电子罗盘采用HMR3300,超声波传感器采用肥-SR04,电 池组采用裡聚合充电电池。

[0037] -种室外微小型地面群机器人控制方法,其特征在于,该控制方法基于前述的室 外微小型地面群机器人控制系统;

[0038](一)基站端的伪距差分定位执行流程为:

[0039] 步骤1 :对基站Xbee无线通信模块进行初始化,并对基站定位信号接收模块即定 位信号(如GI^信号)接收模块进行初始化,即对OEMStar的COM2进行波特率设置和差分 数据发送周期设置;

[0040] 启动犯MStar差分功能,使得伪距差分计算过程由犯MStar自动完成;

[0041] 步骤2:若基站甜ee无线通信模块收到差分修正数,则发送差分修正数到个体机 器人;

[0042](二)移动站即个体机器人端的伪距差分定位执行流程为:

[0043] 步骤1:对移动站甜ee无线通信模块进行初始化,并对移动站定位信号接收模块 即定位信号(如GI^信号)接收模块进行初始化,即对OEMStar的COM2进行波特率设置和 差分数据发送周期设置;

[0044]启动犯MStar差分功能,使得伪距差分计算过程由犯MStar自动完成;

[0045] 步骤2 :若移动站甜ee无线通信模块收到差分修正数,则发送差分修正数到移动 站端的定位信号接收模块;

[0046] 移动站端的定位信号接收模块对接收的GI^定位信号与差分修正数进行伪距差 分计算,然后将伪距差分定位结果即修正坐标发送给其他个体机器人和上位监控计算机。 更进一步,个体机器人根据本身的修正坐标、其他个体机器人坐标W及自身通过传感器感 知的信号进行行为决策和运动规划。

[0047] 在个体机器人的实际定位过程中,将个体机器人获得的大地坐标数据转换为平面 坐标数据,即采用高斯-克吕格投影算法将WGS-84大地坐标转换为对应于WGS-84楠球的 平面坐标,公式如下:

Figure CN103235595BD00081

[0052]式中,X-高斯-克吕格投影纵坐标,y-高斯-克吕格投影横坐标,B-大地缔度 1-距中央子午线经差,X-自赤道起算的子午线孤长,a为楠圆长半径,对于WGS-84楠球, a= 6378137. 0000m,= + ;为卯酉圈曲率半径,C-参考楠球极半径,对WGS-84楠 球,C= 6399593. 6258m,η2=e'2cos2B,e' 一参考楠球第二偏屯、率,对WGS-84 楠球,e'2 = 0. 00673949674227,t=tanB〇 [00閲有益效果:

[0054] 本发明的室外微小型地面群机器人控制系统及控制方法,由差分GI^基站接收 GI^信号并根据给定的基站坐标进行伪距差分计算,求得差分修正数后通过无线通信模块 发送给个体机器人;群机器人系统的个体机器人接收GI^信号和基站发送的差分修正数, 进行伪距差分计算后得到精度为1. 5米W上的精确位置坐标;将GI^定位信息与个体机器 人自身传感器获得的定位信息进行融合,实现个体机器人长时间的精确定位。本发明将伪 距差分GI^绝对定位和群机器人相对定位相结合,大大提高了室外环境下群机器人的协同 定位精度,GI^基站和个体机器人采用相同的控制器、GI^接收模块和无线通信模块等硬 件,简化了电路设计,节约了成本。

[00巧]本发明的有益效果有:

[0056] (1)本发明针对室外环境的特点,采用伪距差分GI^技术,大大提高了个体机器人 的绝对定位精度。

[0057] (2)将GI^绝对定位信息与个体机器人自身传感器获得的相对定位信息进行融 合,能实现个体机器人长时间的精确定位。

[0058] (3)差分GI^基站和个体机器人(移动站)采用相同的无线通信模块,无须额外的 差分GPS电台,简化了电路设计,降低了成本。

附图说明

[0059]图1是本发明所设及群机器人控制系统的示意图;

[0060] 图2是本发明中基站的一实施例结构示意图;

[0061] 图3是本发明中个体机器人一实施例结构示意图;

[0062] 图4是本发明中基站GI^伪距差分定位流程图;

[0063] 图5是本发明中个体机器人GI^伪距差分定位流程图;

[0064] 图6是本发明中个体机器人自身位置传感器信息与GI^数据进行联合定位的过程 图。

具体实施方式

[0065] 为使本发明的目的、技术方案和优点更加清楚明白,W下将结合图1~5和具体实 施例,对本发明作进一步详细说明。虽然本文可提供包含特定值的参数的示范,但应了解, 参数无需确切等于相应的值,而是在可接受的误差容限或设计约束内近似于所述值。

[0066] 实施例1:

[0067] 图1为本发明实施例室外微小型地面群机器人控制系统的示意图。如图1所示, 一种室外微小型地面群机器人控制系统包括差分GI^基站、微小型地面个体机器人和上位 监控计算机组成。其中,所述差分GI^基站,用于实时接收GI^信号并与给定的基站参考 坐标进行伪距差分计算,伪距差分计算是现有技术,由OEMStar自动计算完成,然后将差分 修正数通过无线通信模块发送给群机器人;所述构成群机器人系统的个体机器人,为微小 型地面移动机器人,具有相同的硬件,多个个体机器人之间通过无线通信组成一个机器人 群体并实现相互协作;所述构成群机器人系统的个体机器人,实时接收GI^信号和基站发 送的差分修正数,进行伪距差分计算后得到精度为1. 5米W上的精确位置坐标;构成群机 器人系统的个体机器人,将里程计、巧螺仪和电子罗盘等位置传感器获得相对定位信息,利 用卡尔曼滤波与GI^绝对定位信息进行融合,实现个体机器人未知环境下长时间的精确定 位;所述构成群机器人系统的个体机器人,根据任务分配和其它个体机器人发送的位置信 息并结合自身感知,进行行为决策和运动规划。所述上位监控计算机,通过无线通信模块接 收所述构成群机器人系统的个体机器人的位置信息W及发送指令控制个体机器人的运行。

[0068] 如图1所示,伪距差分GI^基站与个体机器人采用相同的控制器、GI^信号接收模 块、无线通信模块、键盘与显示模块和电源管理模块;GI^模块可采用相同定位精度的北斗 导航接收模块所替代。

[0069]图2为本发明实施例室外微小型地面群机器人系统差分GI^基站的结构示意图。 如图2所示,差分GI^基站由AVR嵌入式控制器模块、GI^信号接收模块、甜ee无线通信模 块等组成。其中,所述AVR嵌入式控制器模块与所述GI^信号接收模块和甜ee无线通信模 块相连接,将基站位置坐标(绝对或相对坐标均可)通过第一串口 0JART)发送给GI^信号 接收模块进行伪距差分计算,然后将GPS信号接收模块计算得到的差分修正数,通过甜ee 无线通信模块发送给群机器人系统中的个体机器人;所述GI^模块通过测量天线接收GPS 卫星信号,通过第一串口扣ART)接收AVR嵌入式控制器模块发送的基站位置坐标,并对接 收的GPS卫星信号与基站位置坐标进行伪距差分计算,然后将差分修正数通过第二串口 0JART)发送给AVR嵌入式控制器模块;所述甜ee无线通信模块,与AVR嵌入式控制器模块 连接,用于发送GI^信号接收模块计算得到的差分修正数给所述群机器人系统中的个体机 器人。

[0070] 本发明差分GI^基站的精确位置坐标可W给定为绝对坐标或相对坐标。

[0071] 本发明差分GPS基站中AVR嵌入式控制器模块包括:AVR处理器、SDRAM存储器、 Flash存储器W及复位电路:所述Flash存储器,用于存储初始化程序和应用程序;所述 AVR处理器,用于运行所述应用程序:发送基站坐标给GI^信号接收模块,接收GI^信号接 收模块发送的伪距差分修正数,通过所述甜ee无线通信模块将伪距差分修正数发送给群 机器人系统中的个体机器人;所述复位电路,用于整个群机器人基站控制系统的复位。

[0072] 图3为本发明实施例室外微小型地面群机器人系统个体机器人的结构示意图。如 图3所示,本发明构成机器人群体的个体机器人由AVR嵌入式控制器模块、GI^信号接收模 块、甜ee无线通信模块、传感器模块、电机驱动模块、键盘与显示模块和电源管理模块等组 成。其中,所述AVR嵌入式控制器模块与GI^信号接收模块连接,将所述甜ee无线通信模块 接收到的基站发送的差分修正数通过第一串口扣ART)传送给GPS模块进行伪距差分计算, 并通过第二串口扣ART)接收GI^模块发送的伪距差分定位结果;所述AVR嵌入式控制器模 块与甜ee模块连接,将所述GPS信号接收模块通过第二串口扣ART)发送的伪距差分定位 结果通过甜ee无线通信模块发送给其他个体机器人W及上位监控计算机;所述GI^信号接 收模块,通过测量天线接收GPS卫星信号,通过第一串口扣ART)接收AVR嵌入式控制器模 块发送的差分修正数,并对接收的GPS卫星信号与差分修正数进行伪距差分计算,然后将 伪距差分定位结果通过第二串口扣ART)发送给AVR嵌入式控制器模块;所述甜ee无线通 信模块,与AVR嵌入式控制器模块连接,将GI^信号接收模块计算得到的伪距差分定位结果 发送给其他个体机器人W及上位监控计算机;所述传感器模块包括:里程计、巧螺仪、数字 罗盘、超声波传感器、摄像头等,用于采集外部环境信息和实现个体机器人的相对定位,W 便机器人进行行为决策和运动规划,并根据不同的任务要求可选配不同的传感器;所述电 机驱动模块,与AVR嵌入式控制器模块连接,驱动所述群机器人中的个体机器人完成各种 运动;所述电源管理模块包括电池组和所述各模块所需电源电压的转换,为各模块提供相 应电压;所述键盘与显示模块,用于人机信息交互和复位等操作。

[0073] 如图3所示,本发明个体机器人的AVR嵌入式控制器模块包括:AVR处理器、SDRAM 存储器、Flash存储器W及复位电路。其中,所述Flash存储器,用于存储初始化程序和应 用程序;所述AVR处理器,用于运行所述应用程序:发送差分修正数给GI^信号接收模块, 接收GI^信号接收模块发送的伪距差分GI^定位结果,通过所述甜ee无线通信模块将伪距 差分GI^定位结果发送给其他个体机器人W及上位监控计算机,接收基站发送的差分修正 数和其他个体机器人发送的信息,采集和处理传感器模块信息并进行行为决策,对电机驱 动模块发出信号,驱动个体机器人完成各种运动控制;所述复位电路,用于整个个体机器人 控制系统的复位。

[0074]如图3所示,本发明个体机器人的甜ee无线通信模块可根据需要通过程序配置为 协调器、路由器或终端。

[007引如图2和图3所示,本发明实例室外微小型地面群机器人控制系统中,AVR处理 器采用ATmega2560,GPS信号接收模块采用犯MStar,测量天线采用单频外置测量天线 HY-LRB01R,甜ee无线通信模块采用甜eePROSeries2,电机驱动模块采用L298P,巧螺仪 采用L3G4200D,数字电子罗盘采用HMR3300,超声波传感器采用肥-SR04,电池组采用裡聚 合充电电池。

[0076] 图4为本发明实施例基站GI^伪距差分定位流程图。其中,GI^模块初始化是指 对犯MStar的COM2进行波特率设置和差分数据发送周期设置;启动犯MStar差分功能后, 伪距差分计算过程由犯MStar自动完成。

[0077] 图5为本发明实施例移动站(个体机器人)GI^伪距差分定位流程图。其中,GPS 模块初始化是指对犯MStar的COM2进行波特率设置;启动犯MStar差分功能后,伪距差分 计算过程由犯MStar自动完成。

[007引如图4和5所示,GPS接收模块犯MStar采集到的定位数据为WGS-84坐标系统下 的大地坐标(经缔度数据),给定给基站的参考坐标也为WGS-84经缔度数据。在机器人的 实际定位过程中,我们需要将大地坐标转换为平面坐标,本发明采用高斯-克吕格投影算 法将WGS-84大地坐标转换为对应于WGS-84楠球的平面坐标,其转换算法如式(1) - (4)所 /J、- 0

Figure CN103235595BD00111

[0082]

Figure CN103235595BD00121

(4)

[0083] 式中,X-局斯-克吕格投影纵坐标,y-局斯-克吕格投影横坐标,B-大地缔度 1-距中央子午线经差,X-自赤道起算的子午线孤长,a为楠圆长半径对于WGS-84楠球a =6378137. 0000m,,.ν=(.ψ-f^,卯酉圈曲率半径,C-参考楠球极半径,对WGS-84楠 球C= 6399593. 6258m,η2=e'2cos2B,e' 一参考楠球第二偏屯、率,对WGS-84 楠球e'2 = 0. 00673949674227,t=tanB〇

[0084] 表1为本发明实施例个体机器人在四个已知参考坐标节点(定位精度在10cmW 内)进行GI^实测定位的结果。由表1可知,不采用差分GI^定位时,四个已知点横坐标X 的最大定位误差为10. 1796米,最小定位误差为7. 8658米;而采用伪距差分定位之后,四个 已知点横坐标X的最大定位误差为1. 2769米,最小定位误差为0. 67885米,其定位精度得 到了显著提高。

[0085] 表1定位结果实例

[0086]

Figure CN103235595BD00122

[0087] 图6为本发明实施例个体机器人自身位置传感器与GI^伪距差分定位数据进行联 合定位的过程。如图6所示,首先将里程计和巧螺仪相融合,提高里程计的精度;然后,为了 修正巧螺仪的累积误差,将融合后的定位信息与电子罗盘相融合,进一步提高里程计航向 角精度;最后,为了修正里程计的位置推算累积误差,将融合的位置信息与伪距差分GI^相 融合,消除输出波动,实现机器人长时间较高精度的定位。

[0088] 如图6所示,当GI^因建筑物遮挡等失去信号而导致定位结果不稳定时,卡尔曼滤 波器根据GI^定位结果的不同状态,选取不同的系统量测噪声协方差矩阵,使算法可W自 动适应GI^定位状态的变化,从而提高个体机器人定位方法的可靠性。

Claims (7)

1. 一种室外微小型地面群机器人控制系统,其特征在于,包括差分定位基站、上位监控 计算机和构成群机器人系统的多个个体机器人,其中: 差分定位基站,用于实时接收定位信号并与给定的基站参考坐标进行伪距差分计算, 然后将差分修正数通过无线通信模块发送给群机器人系统中的个体机器人; 所述的个体机器人为微小型地面移动机器人,所有的个体机器人具有相同的硬件系 统,多个个体机器人之间通过无线通信连接组成一个机器人群体并实现相互协作; 个体机器人实时接收定位信号和基站发送的差分修正数,进行伪距差分计算后得到位 置坐标; 上位监控计算机通过无线通信模块接收个体机器人的位置信息W及发送指令W控制 个体机器人的运行; 所述差分定位基站包括基站AVR嵌入式控制器模块、基站定位信号接收模块和基站 甜ee无线通信模块,其中: 基站定位信号接收模块与基站AVR嵌入式控制器模块相连接,基站AVR嵌入式控制器 模块将基站参考位置坐标通过第一串口发送给基站定位信号接收模块进行伪距差分计算, 然后将基站定位信号接收模块计算得到的差分修正数通过基站Xbee无线通信模块发送给 群机器人系统中的个体机器人; 所述基站定位信号接收模块通过测量天线接收定位信号,通过第一串口接收基站AVR嵌入式控制器模块发送的基站位置坐标,并对接收的定位信号与基站位置坐标进行伪距差 分计算,然后将差分修正数通过第二串口发送给基站AVR嵌入式控制器模块; 所述基站甜ee无线通信模块与基站AVR嵌入式控制器模块连接,用于发送定位信号接 收模块计算得到的差分修正数给群机器人系统中的个体机器人; 所述构成机器人群体的个体机器人包括移动站AVR嵌入式控制器模块、移动站定位信 号接收模块、移动站Xbee无线通信模块、传感器模块、电机驱动模块、键盘与显示模块和电 源管理模块,其中: 所述移动站AVR嵌入式控制器模块,与移动站定位信号接收模块连接,将所述移动站 甜ee无线通信模块接收到的基站发送的差分修正数通过第一串口传送给移动站定位信号 接收模块进行伪距差分计算,并通过移动站定位信号接收模块的第二串口接收伪距差分定 位结果; 所述移动站AVR嵌入式控制器模块,与移动站甜ee无线通信模块连接,将所述移动站 定位信号接收模块通过第二串口发送的伪距差分定位结果通过移动站甜ee无线通信模块 发送给其他个体机器人; 所述移动站定位信号接收模块,通过测量天线接收定位信号,通过第一串口接收基站 发送的差分修正数,并对接收的定位信号与差分修正数进行伪距差分计算,然后将伪距差 分定位结果通过第二串口发送给移动站AVR嵌入式控制器模块; 所述移动站甜ee无线通信模块,与移动站AVR嵌入式控制器模块连接,将移动站定位 信号接收模块计算得到的伪距差分定位结果发送给其他个体机器人; 所述传感器模块,用于采集外部环境信息和个体机器人的位姿信息; 所述电机驱动模块与移动站AVR嵌入式控制器模块连接,电机驱动模块驱动个体机器 人完成各种运动; 所述电源管理模块包括电池组和所述各模块所需电源电压的转换电路; 所述键盘与显示模块用于人机信息交互和复位操作; 所述传感器模块包括:里程计、巧螺仪、数字罗盘、超声波传感器和摄像头,定位信号接 收模块为GI^信号接收模块或北斗导航接收模块。
2. 根据权利要求1所述的室外微小型地面群机器人控制系统,其特征在于,所述基站 AVR嵌入式控制器模块包括:AVR处理器、SDRAM存储器、Flash存储器W及复位电路; 所述Flash存储器,用于存储初始化程序和应用程序; 所述AVR处理器,用于发送基站坐标给定位信号接收模块,接收定位信号接收模块发 送的伪距差分修正数;通过所述基站甜ee无线通信模块将伪距差分修正数发送给群机器 人系统中的个体机器人; 所述复位电路,用于整个群机器人基站控制系统的复位。
3. 根据权利要求2所述的室外微小型地面群机器人控制系统,其特征在于,所述移动 站AVR嵌入式控制器模块包括:AVR处理器、SDRAM存储器、Flash存储器W及复位电路; 所述Flash存储器,用于存储初始化程序和应用程序; 所述AVR处理器,用于发送差分修正数给定位信号接收模块,接收移动站定位信号接 收模块发送的伪距差分定位结果;通过所述移动站Xbee无线通信模块将伪距差分定位结 果发送给其他个体机器人,接收差分定位基站发送的差分修正数和其他个体机器人发送的 信息,将个体机器人的位置信息发送给上位监控计算机,接收上位监控计算机的控制指令 控制个体机器人的运动;接收并处理各种传感器信息;对电机驱动模块发出信号,驱动个 体机器人完成各种运动控制; 所述复位电路,用于整个个体机器人控制系统的复位。
4. 根据权利要求3所述的室外微小型地面群机器人控制系统,其特征在于,所述基站 甜ee无线通信模块或移动站甜ee无线通信模块被配置为协调器、路由器或终端。
5. 根据权利要求1至4中任一项所述的室外微小型地面群机器人控制系统,其特征在 于,AVR处理器采用ATmega2560,基站定位信号接收模块或移动站定位信号接收模块采用 GPS信号接收模块犯MStar,测量天线采用单频外置测量天线HY-LRB01R,基站甜ee无线通 信模块或移动站甜ee无线通信模块采用甜eePROSeries2,电机驱动模块采用L298P,巧 螺仪采用L3G4200D,数字电子罗盘采用HMR3300,超声波传感器采用肥-SR04,电池组采用 裡聚合充电电池。
6. -种室外微小型地面群机器人控制方法,其特征在于,该控制方法基于权利要求5 所述的室外微小型地面群机器人控制系统; (一) 基站端的伪距差分定位执行流程为: 步骤1 :对基站甜ee无线通信模块进行初始化,并对基站定位信号接收模块即定位信 号接收模块进行初始化,即对OEMStar的COM2进行波特率设置和差分数据发送周期设置; 启动犯MStar差分功能,使得伪距差分计算过程由犯MStar自动完成; 步骤2 :若基站Xbee无线通信模块收到差分修正数,则发送差分修正数到个体机器 人; (二) 移动站即个体机器人端的伪距差分定位执行流程为: 步骤1 :对移动站甜ee无线通信模块进行初始化,并对移动站定位信号接收模块即定 位信号接收模块进行初始化,即对OEMStar的COM2进行波特率设置和差分数据发送周期设 置; 启动犯MStar差分功能,使得伪距差分计算过程由犯MStar自动完成; 步骤2 :若移动站甜ee无线通信模块收到差分修正数,则发送差分修正数到移动站端 的定位信号接收模块; 移动站端的定位信号接收模块对接收的GI^定位信号与差分修正数进行伪距差分计 算,然后将伪距差分定位结果即修正坐标发送给其他个体机器人和上位监控计算机。
7.根据权利要求6所述的室外微小型地面群机器人控制方法,其特征在于,在个体机 器人的实际定位过程中,将个体机器人获得的大地坐标数据转换为平面坐标数据,即采用 高斯-克吕格投影算法将WGS-84大地坐标转换为对应于WGS-84楠球的平面坐标,公式如 下:
Figure CN103235595BC00041
式中,X-局斯-克吕格投影纵坐标,y-局斯-克吕格投影横坐标,B-大地缔度1- 距中央子午线经差,X-自赤道起算的子午线孤长,a为楠圆长半径,对于WGS-84楠球,a = 6378137. 0000m,,v- =C(U/:/:);为卯酉圈曲率半径,C-参考楠球极半径,对WGS-84楠 球,C= 6399593. 6258m,η2=e'2cos2B,e' 一参考楠球第二偏屯、率,对WGS-84 楠球,e'2 = 0. 00673949674227,t=tanB〇
CN201310151420.5A 2013-04-27 2013-04-27 一种室外微小型地面群机器人控制系统及控制方法 CN103235595B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201310151420.5A CN103235595B (zh) 2013-04-27 2013-04-27 一种室外微小型地面群机器人控制系统及控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201310151420.5A CN103235595B (zh) 2013-04-27 2013-04-27 一种室外微小型地面群机器人控制系统及控制方法

Publications (2)

Publication Number Publication Date
CN103235595A CN103235595A (zh) 2013-08-07
CN103235595B true CN103235595B (zh) 2016-03-16

Family

ID=48883641

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201310151420.5A CN103235595B (zh) 2013-04-27 2013-04-27 一种室外微小型地面群机器人控制系统及控制方法

Country Status (1)

Country Link
CN (1) CN103235595B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104238418A (zh) * 2014-07-02 2014-12-24 北京理工大学 一种交互现实系统和方法
CN104201470A (zh) * 2014-08-26 2014-12-10 浙江金波电子有限公司 一种数字式自动定位跟踪天线系统
CN104898575A (zh) * 2015-06-01 2015-09-09 中国人民解放军装甲兵工程学院 多机器人协同控制系统
CN106908820A (zh) * 2015-12-22 2017-06-30 深圳市科卫泰实业发展有限公司 一种无人机高精度定位系统及方法
WO2017177951A1 (zh) * 2016-04-13 2017-10-19 苏州宝时得电动工具有限公司 差分全球定位系统及其定位方法
CN106295793A (zh) * 2016-08-30 2017-01-04 吉林大学 基于生物觅食行为的群机器人混合搜索方法
CN106329665B (zh) * 2016-10-31 2018-11-23 江苏理工学院 机器人群协同工作方法
CN106569493B (zh) * 2016-11-03 2020-02-14 中国科学院深圳先进技术研究院 一种基于脉冲超宽带技术的agv集群定位方法及agv调度方法
CN106707316A (zh) * 2016-12-13 2017-05-24 益阳市首航电子科技有限公司 采用基准校准修正方法的北斗高精度航标灯定位系统
CN107422637B (zh) * 2017-05-02 2019-06-07 华中科技大学 一种集群智能控制系统和方法
CN108700666A (zh) * 2017-06-16 2018-10-23 华为技术有限公司 一种定位方法、设备及系统
CN108919308A (zh) * 2018-07-09 2018-11-30 北京市燃气集团有限责任公司 一种基于北斗差分定位的燃气数据采集系统
CN109782226A (zh) * 2019-01-24 2019-05-21 成都优艾维智能科技有限责任公司 一种基于网络rtk的无人机自主循迹定位系统及方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6188958B1 (en) * 1997-07-19 2001-02-13 Honeywell International Inc. Satellite navigation
CN101082493A (zh) * 2007-06-28 2007-12-05 华南农业大学 一种农业机械导航的组合定位方法
CN101917464A (zh) * 2010-07-28 2010-12-15 中国科学院自动化研究所 一种网络化多机器人系统
CN102033536A (zh) * 2010-12-22 2011-04-27 大连理工大学 一种多机器人系统的调度组织协作系统及方法
CN102707675A (zh) * 2012-04-23 2012-10-03 深圳市中科鸥鹏智能科技有限公司 群机器人控制器、群机器人控制方法及控制器终端
CN203275971U (zh) * 2013-04-27 2013-11-06 湖南科技大学 一种室外地面群机器人控制系统

Family Cites Families (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20050162312A1 (en) * 2004-01-28 2005-07-28 Delorme Publishing Co. Method and device for processing raw GPS data
US7656352B2 (en) * 2005-09-20 2010-02-02 Novariant, Inc. Troposphere corrections for ground based positioning systems

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6188958B1 (en) * 1997-07-19 2001-02-13 Honeywell International Inc. Satellite navigation
CN101082493A (zh) * 2007-06-28 2007-12-05 华南农业大学 一种农业机械导航的组合定位方法
CN101917464A (zh) * 2010-07-28 2010-12-15 中国科学院自动化研究所 一种网络化多机器人系统
CN102033536A (zh) * 2010-12-22 2011-04-27 大连理工大学 一种多机器人系统的调度组织协作系统及方法
CN102707675A (zh) * 2012-04-23 2012-10-03 深圳市中科鸥鹏智能科技有限公司 群机器人控制器、群机器人控制方法及控制器终端
CN203275971U (zh) * 2013-04-27 2013-11-06 湖南科技大学 一种室外地面群机器人控制系统

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
GPS相位平滑伪距差分定位技术的研究及应用;杨永平;《中国优秀硕士学位论文全文数据库基础科学辑》;20050815;第20-22页 *

Also Published As

Publication number Publication date
CN103235595A (zh) 2013-08-07

Similar Documents

Publication Publication Date Title
Deng et al. Situation and development tendency of indoor positioning
US10281922B2 (en) Method and system for mobile work system confinement and localization
KR101784860B1 (ko) 이동 단말 및 이동 단말 위치 정보를 취득하는 방법
CN102519450B (zh) 一种用于水下滑翔器的组合导航装置及方法
CN102419180B (zh) 一种基于惯性导航系统和wifi的室内定位方法
US8896442B1 (en) System and method for collaborative resource tracking
CN106556854B (zh) 一种室内外导航系统及方法
CN104655137B (zh) 行人航迹推测辅助的Wi‑Fi信号指纹定位算法
CN102830402B (zh) 水下传感器网络目标跟踪系统及方法
Tuna et al. Unmanned aerial vehicle-aided wireless sensor network deployment system for post-disaster monitoring
CN100424521C (zh) 无线传感器网络三角滤波凸规划定位方法
CN102869090B (zh) 一种基于auv协助的水下无线传感器网络定位方法
CN103925923A (zh) 一种基于自适应粒子滤波器算法的地磁室内定位系统
Wu et al. Human mobility enhances global positioning accuracy for mobile phone localization
CN103363988B (zh) 一种利用智能手机传感器实现地磁室内定位导航的方法
WO2016197986A1 (zh) 一种无人机高精度自主避障飞行方法
CN102636166B (zh) 基于航向角的wsn/ins组合导航系统的控制方法
CN104390643A (zh) 基于多信息融合实现室内定位的方法
Pugh et al. Relative localization and communication module for small-scale multi-robot systems
CN102692223B (zh) 用于wsn/ins组合导航的多级非线性滤波器的控制方法
CN105547305A (zh) 一种基于无线定位和激光地图匹配的位姿解算方法
DK2549286T3 (en) Navigation system for the investigation and / or monitoring of an unknown and / or difficult environment
CN104396322A (zh) 用于确定接入点的位置的方法和设备
US10136576B2 (en) Navigation for a robotic working tool
Fu et al. An indoor navigation system for autonomous mobile robot using wireless sensor network

Legal Events

Date Code Title Description
PB01 Publication
C06 Publication
SE01 Entry into force of request for substantive examination
C10 Entry into substantive examination
GR01 Patent grant
C14 Grant of patent or utility model