一种基于位置映射算法的多机器人协作定位方法技术

一种基于位置映射算法的多机器人协作定位方法，机器人编队中每个机器人至少完成：探测的步骤；机器人之间进行位置信息交换的步骤；利用位置映射算法机器人更新自身位置的步骤；机器人之间相互交换位置信息可以提高机器人定位的稳定性和快速性，机器人之间可以共享传感器信息和不同的传感器平台，所有机器人几乎都可以像装备高精度传感器的机，使得机器人能够完成更加复杂的任务。

【技术实现步骤摘要】
一种基于位置映射算法的多机器人协作定位方法
本专利技术属于机器人定位
，具体涉及一种基于位置映射算法的多机器人协作定位方法。
技术介绍
随着机器人技术的发展，在一些面向应用的任务中，多机器人必须通过协作才能完成，如：机器人足球赛，机器人战场协同作战，多机器人协同作业等。然而有效的定位又是多机器人能进行有效协作的基础，在实际应用中一个机器人定位存在以下问题：单机器人只能通过自身传感器对周围的局部环境进行相对的定位，而且其获得的测量信息的误差会随着时间的推移变得越来越大；单机器人要实现精准定位，自身必须装备非常精确的传感器，其价格也会相对较高从而造成成本的增加；另外单个机器人如果定位出现误差，其自身不能很快的修正误差，造成误差累积导致定位失败。因此通过融合不同机器人的探测信息，可以使得机器人在实际环境中的定位更加准确和获得信息更加全面。但是现存的多机器人定位方法需要机器人之间同步的信息量很大，在机器人编队中机器人数量较多时，要实现机器人协同定位不仅需要同步大量的数据而且增加了机器人自身的处理器的负担。另外现有的多机器人协作定位技术多是单纯同步机器人间的几何关系，不仅需要传递的数据量大而且不能快速的扩散到整个机器人编队。
技术实现思路
针对现有技术存在的缺陷和不足，本专利技术提供一种基于位置映射算法的多机器人协作定位方法。本专利技术的技术方案如下：一种基于位置映射算法的多机器人协作定位方法，用于在多机器人构成的机器人编队中多机器人间协作定位，每个机器人至少完成：探测的步骤；机器人之间进行位置信息交换的步骤；利用位置映射算法机器人更新自身位置的步骤；所述探测的步骤中，机器人感知到信息其中和均代表的是信息流并假设每一次测量都是独立的，为环境测量信息；为机器人间的探测信息，表示机器人与其探测到的其它K个机器人之间的几何关系信息，其中表示在机器人Ri探测到机器人Rj时，机器人Ri获得的其与机器人Rj之间的几何关系信息；所述机器人之间进行位置信息交换的步骤中，机器人Ri探测到其他K个机器人，那么机器人Ri将向其他K个机器人传递其位置及探测信息，同时，机器人Ri还接收其他K个机器人分别发送的它们各自的位置及探测信息，所述位置信息包括机器人对自身位置进行预估的预估位置lt和该预估位置的信度所述预估位置的信度指的是机器人对其位置预估的确信度；所述利用位置映射算法机器人更新自身位置的步骤中，机器人Ri根据自身的位置和探测信息以及从其他K个机器人接收到的它们各自的位置和探测信息，机器人Ri可以计算出其自身有K个可能位置，即机器人Ri计算出的可能位置与其接收到的其他机器人的预估位置之间是一一映射的关系，表示为其中表示与所接收的其他某一个机器人的预估位置相对应的机器人的一个可能位置；机器人Ri利用其计算出的K个可能位置，经过位置映射算法，在重新采样后，实现更新自身位置；所述位置映射算法，即在粒子滤波方法中，用这K个可能位置依次替换采样的加权的样本中拥有最小权值的样本，这些样本的权值由接收到的其他K个机器人的预估位置的信度依次相应代替；所述利用位置映射算法机器人更新自身位置，包括如下A、B两种情况：A.只有一个机器人探测到对方的情况：即，机器人Ri可以探测到机器人Rj，而机器人Rj探测不到机器人Ri，则机器人Ri利用位置映射算法更新自身位置，包括如下步骤：步骤一：机器人Ri感知到其与机器人Rj间的探测信息即机器人Ri与机器人Rj之间的几何关系信息，包括两者之间的间距di，j、由机器人Ri坐标连向机器人Rj坐标的连线与x轴正方向形成的夹角按下面公式进行计算：其中θi是机器人Ri的朝向与x轴正方向形成的夹角；αi，j代表机器人Ri的朝向与机器人Ri、Rj的坐标连线之间的夹角；则由机器人Ri提供的其与机器人Rj之间的探测信息为步骤二：机器人Ri与机器人Rj之间相互交换各自的预估位置及预估位置的信度，且机器人Ri与机器人Rj之间还将共享探测信息并将机器人Ri的预估位置定义为所有样本的期望值，将机器人Ri的预估位置的信度定义为所有样本权值的最大值，如式(4)和式(5)所示：ltRi=E(LtRi)---(4)]]>ω^tRi=max(ωtRi)---(5)]]>式(4)中，机器人Ri的预估位置是机器人Ri采样的加权的样本集合的期望值；式(5)中，为机器人Ri预估位置的信度；机器人Ri将其预估位置预估位置的信度探测信息传递给机器人Rj，如式(6)所示：机器人Rj按照相同的计算方法，因为机器人Rj并没有探测到机器人Ri，所以它只向机器人Ri传送自己的预估位置及预估位置的信度如式(7)和式(8)所示：ltRj=E(LtRj)---(7)]]>ω^tRj=max(ωtRj)---(8)]]>式(7)中，机器人Rj的预估位置是机器人Rj采样的加权的样本集合的期望值；式(8)中，为机器人Rj预估位置的信度；机器人Rj将其预估位置预估位置的信度传递给机器人Ri，如式(9)所示：步骤三：机器人Ri更新自身位置；首先，机器人Ri根据机器人Rj的预估位置和该预估位置的信度计算一个可能位置；然后，机器人Ri采样的加权的样本中，拥有最小权值的样本将被这个计算出的可能位置替换，此样本的权值将被接收到机器人Rj的预估位置信度所替换，此过程如以下公式所示：ωtRi,min=ω^tRj---(11)]]>其中，分别为机器人Ri的拥有最小权值的样本及其权值；最后，在重新采样后，机器人Ri的位置更新。B.两个机器人相互探测到对方的情况，则方法为：步骤一：机器人Ri感知到其与机器人Rj间的探测信息同时，机器人Rj也感知到其与机器人Ri间的探测信息其中dj，i为两者之间的间距、为由机器人Rj坐标连向机器人Ri坐标的连线与x轴正方向形成的夹角；步骤二：机器人Ri与机器人Rj之间相互交换各自的预估位置及预估位置的信度，且机器人Ri与机器人Rj之间还共享探测信息和探测信息机器人Ri将其预估位置预估位置的信度探测信息传递给机器人Rj，如式(6)所示，同时，机器人Rj将其预估位置预估位置的信度探测信息传递给机器人Ri，如式(12)所示，步骤三：机器人更新自身位置；首先，根据最优探测信息选择规则，机器人Ri和机器人Rj分别从机器人Ri的探测信息和机器人Rj的探测信息中选择出最优的探测信息；所述最优探测信息选择规则：1)如果探测信息来自于不同的传感器，机器人将选择精确度高的传感器所获得的信息；2)如果探测信息来自于相同的传感器，机器人将选择自身传感器所获得的探测信息；接下来，机器人Ri和机器人Rj更新自身位置。其中，机器人Ri按照情况A中步骤三的方法更新自身位置。机器人Rj更新自己的位置方法与机器人Ri相同，机器人Rj根据机器人Ri的预估位置和该预估位置的信度计算一个可能位置；机器人Rj采样的加权的样本中，拥有最小权值的样本将被这个计算出的可能位置替换，此样本的权值将被接收到机器人Ri的预估位置信度所替换，此过程如以下公式所示：ωtRj,min=ω^tRi---(14)]]>其中，分别为机器人Rj的拥有最小权值的样本及其权值；最后，在重新采样后，机器人Ri和机器人Rj的位置更新。有益效果：本专利技术的本文档来自技高网...

【技术保护点】
一种基于位置映射算法的多机器人协作定位方法，用于在多机器人构成的机器人编队中多机器人间协作定位，其特征在于：每个机器人至少完成：探测的步骤；机器人之间进行位置信息交换的步骤；利用位置映射算法机器人更新自身位置的步骤；所述探测的步骤中，机器人感知到信息其中和均代表的是信息流并假设每一次测量都是独立的，Zte={zte,zt-1e,zt-2e,···,z0e}]]>为环境测量信息；Ztd={ztRi,1,ztRi,2,···,ztRi,K}]]>为机器人间的探测信息，表示机器人与其探测到的其它K个机器人之间的几何关系信息，其中j＝1,2,…,K表示在机器人Ri探测到机器人Rj时，机器人Ri获得的其与机器人Rj之间的几何关系信息；所述机器人之间进行位置信息交换的步骤中，机器人Ri探测到其他K个机器人，那么机器人Ri将向其他K个机器人传递其位置及探测信息，同时，机器人Ri还接收其他K个机器人分别发送的它们各自的位置及探测信息，所述位置信息包括机器人对自身位置进行预估的预估位置lt和该预估位置的信度所述预估位置的信度指的是机器人对其位置预估的确信度；所述利用位置映射算法机器人更新自身位置的步骤中，机器人Ri根据自身的位置和探测信息以及从其他K个机器人接收到的它们各自的位置和探测信息，机器人可以计算出其自身有K个可能位置，即机器人计算出的可能位置与其接收到的其他机器人的预估位置之间是一一映射的关系，表示为其中表示与所接收的其他某一个机器人的预估位置相对应的机器人的一个可能位置；机器人利用其计算出的K个可能位置，经过位置映射算法，在重新采样后，实现更新自身位置；所述位置映射算法，即在粒子滤波方法中，用这K个可能位置依次替换采样的加权的样本中拥有最小权值的样本，这些样本的权值由接收到的其他K个机器人的预估位置的信度依次相应代替。...

【技术特征摘要】
1.一种基于位置映射算法的多机器人协作定位方法，用于在多机器人构成的机器人编队中多机器人间协作定位，其特征在于：每个机器人至少完成：探测的步骤；机器人之间进行位置信息交换的步骤；利用位置映射算法机器人更新自身位置的步骤；所述探测的步骤中，机器人感知到信息其中和均代表的是信息流并假设每一次测量都是独立的，为环境测量信息；为机器人间的探测信息，表示机器人与其探测到的其它K个机器人之间的几何关系信息，其中j＝1，2，…，K表示在机器人Ri探测到机器人Rj时，机器人Ri获得的其与机器人Rj之间的几何关系信息；所述机器人之间进行位置信息交换的步骤中，机器人Ri探测到其他K个机器人，那么机器人Ri将向其他K个机器人传递其位置及探测信息，同时，机器人Ri还接收其他K个机器人分别发送的它们各自的位置及探测信息，所述位置信息包括机器人对自身位置进行预估的预估位置lt和该预估位置的信度所述预估位置的信度指的是机器人对其位置预估的确信度；所述利用位置映射算法机器人更新自身位置的步骤中，机器人Ri根据自身的位置和探测信息以及从其他K个机器人接收到的它们各自的位置和探测信息，机器人Ri可以计算出其自身有K个可能位置，即机器人Ri计算出的可能位置与其接收到的其他机器人的预估位置之间是一一映射的关系，表示为其中表示与所接收的其他某一个机器人的预估位置相对应的机器人的一个可能位置；机器人Ri利用其计算出的K个可能位置，经过位置映射算法，在重新采样后，实现更新自身位置；所述位置映射算法，即在粒子滤波方法中，用这K个可能位置依次替换采样的加权的样本中拥有最小权值的样本，这些样本的权值由接收到的其他K个机器人的预估位置的信度依次相应代替。2.根据权利要求1所述的基于位置映射算法的多机器人协作定位方法，其特征在于：所述利用位置映射算法机器人更新自身位置，包括如下A、B两种情况：A.只有一个机器人探测到对方的情况：即，机器人Ri可以探测到机器人Rj，而机器人Rj探测不到机器人Ri，则机器人Ri利用位置映射算法更新自身位置，包括如下步骤：步骤一：机器人Ri感知到其与机器人Rj间的探测信息即机器人Ri与机器人Rj之间的几何关系信息，包括两者之间的间距di，j、由机器人Ri坐标连向机器人Rj坐标的连线与x轴正方向形成的夹角按下面公式进行计算：其中θi是机器人Ri的朝向与x轴正方向形成的夹角；αi，j代表机器人Ri的朝向与机器人Ri、Rj的坐标连线之间的夹角；则由机器人Ri提供的其与机器人Rj之间的探测信息为步骤二：机器人Ri与机器人Rj之间相互交换各自的预估位置及预估位置的信度，且机器人Ri与机器人Rj之间还将共享探测信息并将机器人Ri的预估位置定义为所有样本的期望值，将机器人Ri的预估位置的信度定义为所有样本权值的最大值，如式(4)和式(5)所示：式(4)中...

【专利技术属性】
技术研发人员：张磊，张华希，刘腾飞，方正，徐泉，于合强，
申请(专利权)人：东北大学，
类型：发明
国别省市：辽宁;21