室外移动机器人超宽带定位系统初始化方法与流程

文档序号:28696594发布日期:2022-01-29 12:28阅读:来源:国知局

技术特征:
1.室外移动机器人超宽带定位系统初始化方法,所述的室外移动机器人包括运动工作平台,以及设置在工作区域边缘的充电基座,所述的运动工作平台在顶部设置超宽带基站天线,所述的运动工作平台内部设置电子装置,所述的电子装置包括进行集中控制的处理器,与所述的处理器连接的超宽带基站,所述的超宽带基站的信号端连接所述的超宽带基站天线,与所述的处理器连接的wifi模块,用于与用户手机连接;所述的充电基座的顶部设置第一超宽带标签天线,内部设置第一超宽带标签,所述的第一超宽带标签的信号端连接所述的第一超宽带标签天线;还包括设置在工作区域边缘的第二超宽带标签和第三超宽带标签,所述的第二超宽带标签的信号端连接第二超宽带标签天线,所述的第三超宽带标签的信号端连接第三超宽带标签天线,所述的充电基座,第二超宽带标签和第三超宽带标签等间距设置,其特征在于:所述的处理器用于执行所述的定位系统初始化方法,用于所述的室外移动机器人正式使用之前建立坐标系,确定所述的充电基座,第二超宽带标签和第三超宽带标签的坐标,包括以下步骤:(1)当所述的室外移动机器人位于所述的充电基座内时,所述的处理器控制所述的超宽带基站与所述的第二超宽带标签进行测距,获得距离l
02
,与所述的第三超宽带标签进行测距,获得距离l
03
;(2)所述的室外移动机器人通过所述的wifi模块与用户的手机建立连接,用户通过手机控制所述的室外移动机器人沿着工作区域边缘运动,进行环境边界学习;同时所述的处理器每隔固定周期t控制所述的超宽带基站分别与所述的第一超宽带标签、第二超宽带标签和第三超宽带标签进行测距,获得距离l
i1
,l
i2
,l
i3
,并进行保存,i=1,2,3.....,代表测量的序号;(3)当所述的室外移动机器人回到所述的充电基座,完成环境边界学习;(4)对所有保存的数据,计算|l
i2-l
i3
|,比较出最小值,得到i=m,|l
m2-l
m3
|为最小值;计算|l
i1-l
i3
|,比较出最小值,得到i=n,|l
n1-l
n3
|为最小值;计算|l
i1-l
i2
|,比较出最小值,得到i=q,|l
q1-l
q2
|为最小值,其中m,n,q为i的具体值;(5)计算所述的第一超宽带标签,第二超宽带标签和第三超宽带标签组成的三角形中,以所述的第一超宽带标签为顶点的角的角度θ1=arccos{[(l
02
)2+(l
m1
)
2-(l
m2
)2]/(2
·
l
02
·
l
m1
)}+arccos{[(l
03
)2+(l
m1
)
2-(l
m3
)2]/(2
·
l
03
·
l
m1
)};计算所述的第二超宽带标签和第三超宽带标签之间的距离l
23
=;(6)计算所述的第一超宽带标签,第二超宽带标签和第三超宽带标签组成的三角形中,以所述的第二超宽带标签为顶点的角的角度θ2=arccos{[(l
23
)2+(l
n2
)
2-(l
n3
)2]/(2
·
l
23
·
l
n2
)}+arccos{[(l
02
)2+(l
n2
)
2-(l
n1
)2]/(2
·
l
02
·
l
n2
)};计算所述的第一超宽带标签和第三超宽带标签中间的距离l
13
=;(7)计算所述的第一超宽带标签,第二超宽带标签和第三超宽带标签组成的三角形中,以所述的第三超宽带标签为顶点的角的角度θ3=arccos{[(l
13
)2+(l
q3
)
2-(l
q1
)2]/(2
·
l
13
·
l
q3
)}+arccos{[(l
23
)2+(l
q3
)
2-(l
q2
)2]/(2
·
l
23
·
l
q3
)};计算所述的第一超宽带标签和第二超宽带标签中间的距离l
12
=;(8)重新计算所述的第一超宽带标签,第二超宽带标签和第三超宽带标签组成的三角
形中,以所述的第一超宽带标签为顶点的角的角度θ1=arccos{[(l
12
)2+(l
13
)
2-(l
23
)2]/(2
·
l
12
·
l
13
)}。2.根据权利要求1所述的室外移动机器人超宽带定位系统初始化方法,其特征在于:所述的定位系统初始化方法还包括极坐标系建立方法:以所述的第一超宽带标签为极点,以所述的第一超宽带标签和第二超宽带标签所在直线为极轴,指向所述的第二超宽带标签,建立极坐标系,因此所述的第一超宽带标签的坐标为(0,0),所述的第二超宽带标签的坐标为(l
12
,0),所述的第三超宽带标签的坐标为(l
13
,θ1)。3.根据权利要求1所述的室外移动机器人超宽带定位系统初始化方法,其特征在于:所述的定位系统初始化方法还包括直角坐标系建立方法:以所述的第一超宽带标签为原点,以所述的第一超宽带标签和第二超宽带标签所在直线为x轴,指向所述的第二超宽带标签,建立直角坐标系,因此所述的第一超宽带标签的坐标为(0,0),所述的第二超宽带标签的坐标为(l
12
,0),所述的第三超宽带标签的坐标为(l
13
·
cosθ1,l
13
·
sinθ1)。

技术总结
公开一种室外移动机器人超宽带定位系统初始化方法,所述的室外移动机器人包括运动工作平台,以及设置在工作区域边缘的充电基座,所述的运动工作平台在顶部设置超宽带基站天线,内部设置电子装置,所述的电子装置包括进行集中控制的处理器,与所述的处理器连接的超宽带基站,所述的超宽带基站的信号端连接所述的超宽带基站天线;所述的充电基座的顶部设置第一超宽带标签天线,内部设置第一超宽带标签;还包括设置在工作区域边缘的第二超宽带标签和第三超宽带标签,所述的充电基座,第二超宽带标签和第三超宽带标签等间距设置,所述的处理器用于执行所述的定位系统初始化方法,用于所述的室外移动机器人正式使用之前建立坐标系。标系。标系。


技术研发人员:ꢀ(51)Int.Cl.G01S5/02
受保护的技术使用者:杭州晶一智能科技有限公司
技术研发日:2021.10.19
技术公布日:2022/1/28
当前第2页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1