CN102566572B - 一种基于贝叶斯方法的多软件机器人演化定位方法 - Google Patents

一种基于贝叶斯方法的多软件机器人演化定位方法 Download PDF

Info

Publication number
CN102566572B
CN102566572B CN201110400351.8A CN201110400351A CN102566572B CN 102566572 B CN102566572 B CN 102566572B CN 201110400351 A CN201110400351 A CN 201110400351A CN 102566572 B CN102566572 B CN 102566572B
Authority
CN
China
Prior art keywords
theta
robot
mobile
target
positioning
Prior art date
Legal status (The legal status 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 status listed.)
Expired - Fee Related
Application number
CN201110400351.8A
Other languages
English (en)
Other versions
CN102566572A (zh
Inventor
樊建聪
阮久宏
刘强
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shandong Jiaotong University
Original Assignee
Shandong Jiaotong University
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 Shandong Jiaotong University filed Critical Shandong Jiaotong University
Priority to CN201110400351.8A priority Critical patent/CN102566572B/zh
Publication of CN102566572A publication Critical patent/CN102566572A/zh
Application granted granted Critical
Publication of CN102566572B publication Critical patent/CN102566572B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Manipulator (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于贝叶斯方法的多软件机器人演化定位方法。基于贝叶斯方法的多软件机器人演化定位算法是一种自动化的定位方法,包括以下步骤:1)定位机器人根据移动目标(移动机器人)的历史位置信息分析计算目标的移动规律;2)定位机器人根据移动规律使用贝叶斯方法构造建立移动目标的运动预测模型,估计移动规律;3)定位机器人根据移动目标的新的移动信息,使用贝叶斯演化模型对移动目标的预测模型进行更新,得到更准确的移动规律和目标位置。本发明方法能够保证移动目标始终处于捕获定位的可视范围之内,可以确保对移动目标的位置估计准确度。

Description

一种基于贝叶斯方法的多软件机器人演化定位方法
技术领域
本发明涉及一种方法,尤其是一种基于贝叶斯方法的多软件机器人演化定位方法。
背景技术
软件机器人之间的捕获定位问题主要研究如何控制一群机器人定位一个或几个其它机器人及相关问题的领域,典型的例子包括搜索与营救行动,追捕敌军任务等,也可以推广到其它领域,如通过用户留下的上网痕迹和记录,获取用户兴趣特征、机器人追赶移动的目标,抓捕网络入侵者等。移动目标跟踪也是软件机器人领域的一个重要且富有挑战性的研究方向,尤其是当移动目标的运动路径、方向、速度等参数未知的情况下,利用以概率估计为核心的贝叶斯方法是解决这一不确定问题的有效技术。同时由于移动目标的运动突变性和社会性,演化技术也是解决该问题的有用方法。进行基于贝叶斯方法的多机器人演化定位时必须考虑并完成两项关键任务:一是获取先验信息,建立移动目标的运动模型,预测移动目标将来的运动趋势;二是利用演化计算过程,迭代调整移动目标的精确运行模型。
发明内容
本发明的目的是为克服上述现有技术的不足,提供一种基于贝叶斯方法的多软件机器人演化定位方法,该方法使用移动目标的历史位置信息作为先验信息,利用贝叶斯方法预测移动目标的未来移动信息,建立了一种运动预测模型,并且在持续的移动过程中利用演化方法动态修正预测模型,以使得机器人能够更精确的捕捉定位到移动目标。
为实现上述目的,本发明采用下述技术方案:
一种基于贝叶斯方法的多软件机器人演化定位方法,首先根据移动目标的当前位置和历史位置信息,利用贝叶斯原理构造移动目标的运动预测模型,并利用此模型对移动目标的将来移动趋势进行预测,在连续的目标移动过程中,软件机器人自行计算移动目标的演化移动过程,运用设计的贝叶斯演化迭代运动模型对运动预测模型进行动态更新与调整,最后能够使得软件机器人准确地预测和捕获定位到移动目标;
包括以下具体步骤:
1)使用移动目标的当前位置信息和历史位置信息估计历史运动模型,根据贝叶斯预测模型(3)和(4),计算下一步的出现位置概率,从而能够快速定位软件机器人的位置。本发明有两个重要特点,也是需要满足的两个条件:一是信息不对称,即事先无法确定软件机器人的实际运动模型,无法获取在任意时刻软件机器人的移动速度、转移角度、移动方向;二是软件机器人的运动具有目的性,是要去完成某一个任务的运动过程。定位软件机器人的主要作用就是跟踪其运动状态,获取软件机器人完成任务的相关信息。在上述两个条件下,利用贝叶斯预测过程,一是解决在信息不对称情况下的信息获取问题,二是使用移动目标的历史移动模型预测具有特定任务的移动软件机器人的运动控制模型;
定位机器人利用移动目标的历史位置信息作为先验信息,通过式(1)所示的贝叶斯基本原理来预测移动目标的下一步移动方向和移动曲线,当预测结果与移动目标的真实移动数据之间的Bhattacharyya平均距离值较大时,利用式(2)所示的贝叶斯迭代基本原理进行移动模型的更新;
T表示移动目标所经过的历史位置;
Ti表示第i个移动目标到达的位置;
j为正整数,表示移动目标的第j次移动;
θP表示定位机器人的移动方向,转移角度,移动速度等信息;
θE表示移动目标的移动方向,转移角度,移动速度等信息。
2)使用软件机器人之间的运动模型,利用已知软件机器人的运动函数模型与预测软件机器人的运动函数模型之间的Bhattacharyya距离判断预测模型的准确性,Bhattacharyya距离定义为
其中q(x)表示已知的软件机器人的运动函数模型,p(x)表示要求解的软件机器人的预测运动函数模型。令ρ越大,则DB越小,两个模型p(x)和q(x)越相似。
3)利用式(4)的贝叶斯迭代过程,即利用软件机器人第1至k步的移动位置、移动方向、移动角度预测第k+1步移动位置、移动方向、移动角度,直至要求解的目标软件机器人的运动模型与已知的定位软件机器人的运动模型之间的Bhattacharyya距离在一个较小的阈值范围内时预测运行过程终止;
本发明方法根据移动目标的历史位置信息分析计算目标的移动规律,根据移动规律使用贝叶斯方法构造建立移动目标的运动预测模型,估计移动规律,根据移动目标的新的移动信息,使用贝叶斯演化模型对移动目标的预测模型进行更新,得到更准确的移动规律和目标位置。本发明方法能够保证移动目标始终处于捕获定位的可视范围之内,可以确保对移动目标的位置估计准确度。
附图说明
图1为本发明的算法的具体流程图;
图2为要预测的软件机器人在运动过程中下一步的运动信息;
图3为已知软件机器人的运动过程中预测要求解的软件机器人的运动模型;
图4为贝叶斯预测模型随软件机器人运动空间的增大而预测正确的时间;
图5为贝叶斯预测横型随软件机器人运动空间的增大而预测正确的次数;
图6为贝叶斯预测模型随软件机器人运动空间的增大而耗用的迭代次数。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
一种基于贝叶斯方法的多软件机器人演化定位方法,流程图如图1所示。首先构造基于移动目标当前位置信息和历史位置信息的历史运动模型,再根据贝叶斯迭代预测模型,计算下一步的出现位置概率,从而能够快速定位软件机器人的位置。把定位机器人P和移动机器人E的活动区域投影为一个二维坐标平面,P和E以软件智能体的形式在某一环境中移动。P和E的位置以坐标的形式表示。将坐标离散化为边长为ε(ε>0)的正方形区域,P和E都在相邻按的区域间移动,把这种移动称为二维随机移动。在定位机器人定位移动机器人过程中,定位机器人的运动模型首先确定为目标函数F0,通过移动机器人的运动轨迹确定其移动函数作为侯选函数F1。设时间步长为T,即从时刻0开始,每间隔时间T就跟据移动机器人已经过的运动轨迹计算定位机器人与移动机器人的Bhattacharyya距离。若距离小于某个阈值,则追捕者调整追捕策略,向看Bhattacharyya距离值更小的分布函数调整。
在定位移动软件机器人过程中,定位机器人的移动函数首先确定为目标函数q0,通过移动机器人的移动轨迹确定其移动模型作为候选函数p0,如图2所示。设时间步长为T,即从时刻0开始,每间隔时间T定位机器人就根据移动机器人已存在的移动轨迹计算两者的Bhattacharyya距离DB。若距离大于某个阈值,则定位机器人调整定位策略,如图3所示,向着DB值更小的分布函数调整。
根据下述移动机器人移动方程,
f(X(Ti+1t))=f(X(Ti-)+1)
f(X(Tnt))=f(X(Tmt))+(n-m)
其中,移动机器人所经过的位置具有标记T,T=<Token,t>,其中Token是标记符,t表示时间,称为时间戳,Tn.t>Ts.t。将定位机器人P和移动机器人E的移动模型作为演化个体,令q是定位机器人的移动函数,f是移动机器人的移动函数,pj(x)表示第j次迭代中移动函数相似的概率。DB(q,f)表示移动函数q和f的巴氏距离。
假设每一次迭代的种群规模为n,取正整数ξ,从一代种群中选取所有Dj≤ξ的个体(设为m个),按以下方案进行处理:
(1)如果m=1,选符合条件的个体作为新的种群,并从此个体开始进行新的移动;
(2)当m=2,如果是连续的两次移动,则取这两次连续轨迹为新的种群继续移动;否则,任取一个符合条件的个体按照第(1)步进行处理;
(3)当m=3,如果是连续的三次移动,则取这三次连续轨迹为新的种群继续移动;否则,按照第(2)步进行处理;
(4)当m=k,如果是连续的k次移动,则取这k次连续轨迹为新的种群继续移动;否则,按照第(k-1)步进行处理;
当进行第k+1次演化迭代时,利用式(4)的贝叶斯迭代过程,即利用移动软件机器人第1至k步的移动位置、移动方向、移动角度预测第k+1步移动位置、移动方向、移动角度,直至要求解的目标软件机器人的运动模型与已知的定位软件机器人的运动模型之间的Bhattacharyya距离在一个较小的阈值范围内时预测运行过程终止。
在上述过程中有几点需要说明,一是种群中最优个体分布概率的计算,利用公式(5)进行计算
其中,j∈{1,2,…,n},t表示第t代种群。二是ξ具有动态变化性,当Pt(x)<Pt+1(x),即第t+1代相似函数出现的概率大于第t代时,ξ值下降,下降的幅度根据DB(q,f)的值确定。
基于贝叶斯方法的多软件机器人演化定位算法是一种自动化的定位方法,定位机器人通过获取移动机器人的移动轨迹,对移动机器人的移动规律进行建模。定位机器人根据移动机器人的历史移动轨迹所建立的模型,定位机器人自身依照这一模型进行运动,直至定位机器人与移动机器人的运动模型相等或者近似相等为止。
图4、图5和图6给出了定位空间在5000×5000空间中(横坐标)的定位算法性能情况。图4给出了定位机器人50次定位移动目标的成功定位次数。图5是随着定位空间的增加定位机器人准确定位移动目标所需的时间。图6是随着定位空间的增加定位机器人定位移动目标的演化迭代次数。从上述结果来看,本发明提出的方法能够稳定的运行,准确定位的次数较为平稳,定位时间随空间的变化呈线性变化,且演化迭代次数呈线性变化。因此本发明可以很好的实现多软件机器人的完全自动定位。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对本发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围以内。

Claims (2)

1.一种基于贝叶斯方法的多软件机器人演化定位方法,包括以下步骤:
1)定位机器人根据移动目标的历史位置信息分析计算移动目标的移动规律;
2)根据移动规律使用贝叶斯方法建立移动目标的运动预测模型,估计移动规律;
3)定位机器人根据移动目标的新的移动信息,使用贝叶斯演化模型对移动目标的预测模型进行更新,得到更准确的移动规律和移动目标位置;
定位机器人利用移动目标的历史位置信息作为先验信息,通过式(1)所示的贝叶斯基本原理来预测移动目标的下一步移动方向和移动曲线,当预测结果与移动目标的真实移动数据之间的Bhattacharyya大于某个阈值时,利用式(2)所示的贝叶斯迭代基本原理进行移动模型的更新;
P ( &theta; - i | &theta; i ) = P ( &theta; i | &theta; - i ) P ( &theta; - i ) P ( &theta; i ) = P ( &theta; i | &theta; - i ) P ( &theta; - i ) &Sigma; k = 1 n P ( &theta; i k ) - - - ( 1 )
P ( k + 1 ) ( &theta; - i | &theta; i ) = P ( k + 1 ) ( &theta; i | &theta; - i ) P ( k ) ( &theta; - i ) P ( k + 1 ) ( &theta; i ) , k = 0 , 1 , 2 , ... - - - ( 2 ) .
2.如权利要求1所述的方法,其特征在于:对软件机器人的运动过程定位策略是一种迭代过程,利用每一迭代步的移动方向D,转移角度A,移动速度V来计算在下一迭代步出现位置的概率,从而预测下一步的位置,定位机器人P和移动机器人E,
P T i , j ( k + 1 ) ( &theta; E | &theta; P ) = P T i , j ( k + 1 ) ( &theta; P | &theta; E ) P T i , j ( k ) ( &theta; E ) P T i , j ( k + 1 ) ( &theta; P ) = P T i , j ( k + 1 ) ( < D P , A P , V P > | < D E , A E , V E > ) P T i , j ( k ) ( < D E , A E , V E > ) P T i , j ( k + 1 ) ( < D P , A P , V P > ) - - - ( 3 )
P T i , j ( k + 1 ) ( &theta; P | &theta; E ) = P T i , j ( k + 1 ) ( &theta; E | &theta; P ) P T i , j ( k ) ( &theta; P ) P T i , j ( k + 1 ) ( &theta; E ) = P T i , j ( k + 1 ) ( < D E , A E , V E > | < D P , A P , V P > ) P T i , j ( k ) ( < D P , A P , V P > ) P T i , j ( k + 1 ) ( < D E , A E , V E > ) . - - - ( 4 )
CN201110400351.8A 2011-12-06 2011-12-06 一种基于贝叶斯方法的多软件机器人演化定位方法 Expired - Fee Related CN102566572B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201110400351.8A CN102566572B (zh) 2011-12-06 2011-12-06 一种基于贝叶斯方法的多软件机器人演化定位方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201110400351.8A CN102566572B (zh) 2011-12-06 2011-12-06 一种基于贝叶斯方法的多软件机器人演化定位方法

Publications (2)

Publication Number Publication Date
CN102566572A CN102566572A (zh) 2012-07-11
CN102566572B true CN102566572B (zh) 2017-07-11

Family

ID=46412213

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201110400351.8A Expired - Fee Related CN102566572B (zh) 2011-12-06 2011-12-06 一种基于贝叶斯方法的多软件机器人演化定位方法

Country Status (1)

Country Link
CN (1) CN102566572B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107844460B (zh) * 2017-07-24 2020-12-25 哈尔滨工程大学 一种基于p-maxq的多水下机器人的围捕方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1558303A (zh) * 2004-02-11 2004-12-29 北京邮电大学 数字水印基础设施
CN1629870A (zh) * 2003-06-30 2005-06-22 微软公司 用于提供用户存在性和有效性的状态和预测的方法及结构
KR20080029417A (ko) * 2006-09-29 2008-04-03 김홍기 시맨틱 웹 어노테이션을 위한 웹 문서의 자동 의미정보추출 방법 및 그 시스템
DE102007050434A1 (de) * 2007-10-22 2009-04-23 Henkel Ag & Co. Kgaa Verfahren und Anordnung zum computergestützten Ermitteln mindestens einer Eigenschaft einer Haarcoloration basierend auf einer Formulierung aus chemisch reaktiven und/oder unreaktiven Rohstoffen, Verfahren und Anordnung zum computergestützten Ermitteln einer Formulierung einer Haarcoloration basierend auf chemisch reaktiven und/oder unreaktiven Rohstoffen, und Verfahren und Anordnung zum computergestützten Trainieren eines vorbestimmten Modells zum computergestützten Ermitteln mindestens einer Eigenschaft einer Haarcoloration basierend auf einer Formulierung aus chemisch reaktiven und/oder unreaktiven Rohstoffen
CN101419499A (zh) * 2008-11-14 2009-04-29 东南大学 基于摄像头和话筒的多媒体人机交互方法
CN101826005A (zh) * 2009-06-09 2010-09-08 张艳红 图像、视频多维信息挖掘与立体可视化搜索引擎软件
CN101964545A (zh) * 2010-10-19 2011-02-02 天津理工大学 基于广域网和多Agent的电网自适应智能协调保护控制系统

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1629870A (zh) * 2003-06-30 2005-06-22 微软公司 用于提供用户存在性和有效性的状态和预测的方法及结构
CN1558303A (zh) * 2004-02-11 2004-12-29 北京邮电大学 数字水印基础设施
KR20080029417A (ko) * 2006-09-29 2008-04-03 김홍기 시맨틱 웹 어노테이션을 위한 웹 문서의 자동 의미정보추출 방법 및 그 시스템
DE102007050434A1 (de) * 2007-10-22 2009-04-23 Henkel Ag & Co. Kgaa Verfahren und Anordnung zum computergestützten Ermitteln mindestens einer Eigenschaft einer Haarcoloration basierend auf einer Formulierung aus chemisch reaktiven und/oder unreaktiven Rohstoffen, Verfahren und Anordnung zum computergestützten Ermitteln einer Formulierung einer Haarcoloration basierend auf chemisch reaktiven und/oder unreaktiven Rohstoffen, und Verfahren und Anordnung zum computergestützten Trainieren eines vorbestimmten Modells zum computergestützten Ermitteln mindestens einer Eigenschaft einer Haarcoloration basierend auf einer Formulierung aus chemisch reaktiven und/oder unreaktiven Rohstoffen
CN101419499A (zh) * 2008-11-14 2009-04-29 东南大学 基于摄像头和话筒的多媒体人机交互方法
CN101826005A (zh) * 2009-06-09 2010-09-08 张艳红 图像、视频多维信息挖掘与立体可视化搜索引擎软件
CN101964545A (zh) * 2010-10-19 2011-02-02 天津理工大学 基于广域网和多Agent的电网自适应智能协调保护控制系统

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
分布估计学习算法研究;樊建聪;《中国博士学位论文全文数据库》;20110815(第8期);第9、76-80页 *
基于贝叶斯方法的决策树分类算法;樊建聪等;《计算机应用》;20051230;第25卷(第12期);第2882-2884页 *

Also Published As

Publication number Publication date
CN102566572A (zh) 2012-07-11

Similar Documents

Publication Publication Date Title
CN106773689B (zh) 基于分层分布式模型预测控制的auv编队协同控制方法
US20190184560A1 (en) A Trajectory Planning Method For Six Degree-of-Freedom Robots Taking Into Account of End Effector Motion Error
CN106502250B (zh) 三维空间内多机器人编队的路径规划算法
Garimort et al. Humanoid navigation with dynamic footstep plans
CN106873599A (zh) 基于蚁群算法和极坐标变换的无人自行车路径规划方法
CN103645725B (zh) 一种机器人示教轨迹规划方法和系统
CN103149937A (zh) 一种基于曲率补偿的横侧向曲线航迹跟踪方法
CN105690392A (zh) 基于行动者-评论家方法的机器人运动控制方法和装置
CN104501816A (zh) 一种多无人飞行器协调避碰导引规划方法
CN103970135A (zh) 一种基于mapso优化粒子滤波的多移动机器人协作定位方法
Li et al. Generating optimal path by level set approach for a mobile robot moving in static/dynamic environments
CN109799829B (zh) 一种基于自组织映射的机器人群体协同主动感知方法
Gao et al. Multi-mobile robot autonomous navigation system for intelligent logistics
CN101630413B (zh) 一种多机器人跟踪移动目标方法
CN110111359A (zh) 多目标对象跟踪方法、执行该方法的设备和计算机程序
Basiuk et al. Mobile Robot Position Determining Using Odometry Method
Su et al. Robot path planning based on random coding particle swarm optimization
CN104865825A (zh) 一种多机器人合作时序预测控制方法
Yuan et al. Cooperative-competitive game based approach to the local path planning problem of distributed multi-agent systems
CN102566572B (zh) 一种基于贝叶斯方法的多软件机器人演化定位方法
Guo et al. Optimal navigation for AGVs: A soft actor–critic-based reinforcement learning approach with composite auxiliary rewards
CN116661469B (zh) 机器人轨迹误差修正方法及系统
Suzuki et al. Posture evaluation for mobile manipulators using manipulation ability, tolerance on grasping, and pose error of end-effector
CN115527272A (zh) 一种行人轨迹预测模型的构建方法
CN106682733B (zh) 无人机运动状态分析方法和装置

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20170711

Termination date: 20181206

CF01 Termination of patent right due to non-payment of annual fee