一种基于路标的移动物体的定位方法与流程

文档序号:12155417阅读:来源:国知局

技术特征:

1.一种基于路标的移动物体定位方法,其特征在于,包括:

设计和放置路标:

根据移动物体的工作环境,设计路标的数量和图案;其中,由标记点组成的路标包括:用于定位移动物体相对路标的相对位置的定位部分、用于唯一标识路标的标识部分和用于为移动物体提供校验路标的数据完整性的校验信息的校验部分;

放置路标;路标是被贴附于天花板上;

依据路标位置表,定位移动物体所在位置的世界坐标值:

采集识别路标的图像;

根据采集识别的路标的校验部分校验路标的数据完整性,根据定位部分获取移动物体的相对位置,根据标识部分获取路标ID号;

根据路标ID号,并结合所述路标位置表,得到路标的世界坐标值;

根据相对位置和路标的世界坐标值换算移动物体的世界坐标值。

2.根据权利要求1所述的基于路标的移动物体的定位方法,其特征在于:路标的数据完整性是根据路标的校验部分的标记点,通过奇偶校验法、异或校验法或循环冗余校验法进行校验的。

3.根据权利要求1所述的基于路标的移动物体的定位方法,其特征在于:组成路标的标记点采用回归反射材料或者发光材料制作。

4.根据权利要求1所述的基于路标的移动物体的定位方法,其特征在于:路标的定位部分包括至少三个标记点;标识部分包括至少一个标记点;校验部分包括至少一个标记点位置。

5.根据权利要求1所述的基于路标的移动物体的定位方法,其特征在于,所述定位部分的标记点用于确定路标对应的极坐标系。

6.根据权利要求5所述的基于路标的移动物体的定位方法,其特征在于:所述路标位置表是通过标定工作环境中的每一个路标而获得的:

在工作环境中的所有路标中,选择一个路标作为起始点;其中,所述起始点的世界坐标值是已知的;

从所述起始点开始,移动物体在工作环境中运动,对工作环境中的所有路标进行标定;

其中,标定每一个路标包括

采集识别至少两个路标的图像;其中一个路标的世界坐标值是已知的;

根据采集的至少两个路标的定位部分,分别计算移动物体相对于采集的至少两个路标的相对位置;

根据空间坐标变换的关系和移动物体相对于采集的至少两个路标的相对位置,计算采集的未知世界坐标值的路标的世界坐标值;并将计算的世界坐标值按照所述路标ID号保存在所述路标位置表中。

7.根据权利要求6所述的基于路标的移动物体的定位方法,其特征在于:所述根据采集的至少两个路标的定位部分,分别计算移动物体相对于采集的至少两个路标的相对位置的步骤包括:对于采集的一个的路标的图像,

进行图像预处理并予以识别;

根据校验部分校验路标的数据完整性:若是,则根据定位部分的标记点建立路标对应的极坐标系;

根据标识部分的标记点的极坐标值,计算路标ID号;

根据摄像头的内参矩阵、移动物体的旋转矩阵、平移矩阵和定位部分的标记点极坐标值,计算移动物体相对于路标的位置;其中,旋转矩阵是根据移动物体的倾角检测单元测量获得的。

8.根据权利要求5所述的基于路标的移动物体的定位方法,其特征在于:所述路标ID号包括M个数据位,每一个数据位均采用N进制编码;其中,M大于等于1,且M与路标中标识部分的标记点的数量和半径坐标相关;N大于等于2,且N与标识部分的标记点的角坐标相关。

9.根据权利要求8所述的基于路标的移动物体的定位方法,其特征在于:所述N进制编码包括二进制编码、十进制编码、十六进制编码或六十四进制编码。

10.根据权利要求1所述的基于路标的移动物体的定位方法,其特征在于:所述基于路标的移动物体的定位方法还包括标定移动物体的摄像头。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1