水池清洁机器人定位方法、装置、设备、介质及程序产品与流程
本公开涉及清洁机器人,尤其涉及一种水池清洁机器人定位方法、装置、设备、介质及程序产品。
背景技术:
1、随着人们生活水平的提高和对居住环境品质要求的提升,泳池作为家庭休闲和商业健身的重要设施,其卫生状况和维护便利性日益受到关注。
2、现有采用水池清洁机器人对泳池进行自动清洁的过程中,需要对水池清洁机器人进行定位。水下定位多采用超短基线系统(usbl)实现。传统基站测向架构通过声学链路将位置数据下发至水下机器人,但受限于水声信道的高传播延迟特性,该方式通信延迟极大,难以满足实时闭环控制的需求。
3、目前,水池清洁机器人定位的通信延迟较长,定位精度较低,进而水池清洁机器人的控制效率较低。
技术实现思路
1、本公开提供一种水池清洁机器人定位方法、装置、设备、介质及程序产品,以至少解决现有水池清洁机器人定位的通信延迟较长,定位精度较低,水池清洁机器人的控制效率较低的问题。
2、本公开的技术方案如下:
3、本公开实施例提供一种水池清洁机器人定位方法,所述水池清洁机器人能够与基站配合,所述基站设置在池岸上,所述基站包括壳体以及设置于所述壳体上的主控单元和定位发射端,所述壳体与所述池岸相连接,所述定位发射端包括至少两个基站水声发射节点,至少两个所述基站水声发射节点中的其中两个分别为第一水声发射节点和第二水声发射节点,所述第一水声发射节点和所述第二水声发射节点沿水平方向排布,并以预设间隔布置,所述第一水声发射节点和所述第二水声发射节点的信号发射受控于所述主控单元;
4、所述水池清洁机器人包括至少一个机器人水声发射节点和一个机器人水声接收节点;
5、所述方法包括:
6、获取第一水声发射节点发出的第一声学信号和第二水声发射节点发出的第二声学信号;其中,所述第一水声发射节点和所述第二水声发射节点为相距预设基线距离的两个节点,所述第一声学信号和所述第二声学信号间隔预设时间间隔发射;
7、确定所述第一声学信号和所述第二声学信号到达目标水声接收点的实际接收时间间隔;其中,所述目标水声接收点为设置于水池清洁机器人上的所述机器人水声接收节点;
8、根据所述实际接收时间间隔、所述预设时间间隔和所述预设基线距离,确定所述水池清洁机器人相对于所述定位发射端的相对位置;
9、可选地,所述水池清洁机器人包括深度传感器;
10、所述定位发射端包括两个基站水声发射节点,两个所述基站水声发射节点中的其中一个为第一水声发射节点,另一个为所述第二水声发射节点;
11、所述深度传感器获取所述水池清洁机器人所处的深度,结合所述水池清洁机器人相对于所述定位发射端的相对位置计算所述水池清洁机器人的三维坐标。
12、可选地,所述确定所述第一声学信号和所述第二声学信号到达目标水声接收点的实际接收时间间隔,包括:
13、获取所述第一声学信号到达所述目标水声接收点的第一时间;以及
14、获取所述第二声学信号到达所述目标水声接收点的第二时间;
15、根据所述第一时间和所述第二时间,计算所述实际接收时间间隔。
16、可选地,确定所述第一声学信号和所述第二声学信号为预设顺序发射,根据接收到的信号顺序确定声学信号的来源。
17、可选地,所述相对位置为方位角;所述根据所述实际接收时间间隔、所述预设时间间隔和所述预设基线距离,确定所述水池清洁机器人相对于所述定位发射端的相对位置,包括:
18、计算所述实际接收时间间隔与所述预设时间间隔的差值;
19、根据所述差值和所述水池水体声速,计算所述目标水声接收点距离所述第一水声发射节点与所述第二水声发射节点的空间声程距离差;
20、根据所述空间声程距离差和所述预设基线距离,计算出所述方位角。
21、可选地,所述第一声学信号和所述第二声学信号在物理层面上具有互相正交隔离的声学编码特征,所述声学编码特征为扫频参数不交叠的线性宽带调频信号。
22、可选地,所述方法还包括:
23、通过所述机器人水声发射节点向所述定位发射端发送测距询问信号;
24、接收所述定位发射端根据所述测距询问信号返回的反馈信号;
25、根据所述测距询问信号对应的发送时刻、所述反馈信号的接收时刻和所述定位发射端的系统转发时延,计算所述水池清洁机器人与所述定位发射端的绝对距离;
26、根据所述绝对距离和方位角,计算所述水池清洁机器人在水池里的坐标。
27、可选地,在一次定位过程中所述第一水声发射节点和所述第二水声发射中的至少有一个发射至少两个声信号。
28、可选地,所述水池清洁机器人获取相对于所述定位发射端的相对位置之后,使用无线方式将自身信息发送给无线接收设备,所述自身信息包括位置信息、工作状态、电量信息、电压信息中的至少一个。
29、可选地,所述第一水声发射节点和所述第二水声发射节点中的至少一个能发射第四水声信号,所述水池清洁机器人收到所述第四水声信号之后改变自己的工作状态。
30、本公开实施例还提供一种水池清洁机器人定位装置,所述水池清洁机器人能够与基站配合,所述基站设置在池岸上,所述基站包括壳体以及设置于所述壳体上的主控单元和定位发射端,所述壳体与所述池岸相连接,所述定位发射端包括至少两个基站水声发射节点,至少两个所述基站水声发射节点中的其中两个分别为第一水声发射节点和第二水声发射节点,所述第一水声发射节点和所述第二水声发射节点沿水平方向排布,并以预设间隔布置,所述第一水声发射节点和所述第二水声发射节点的信号发射受控于所述主控单元;
31、所述水池清洁机器人包括至少一个机器人水声发射节点和一个机器人水声接收节点;包括:
32、获取模块,用于获取第一水声发射节点发出的第一声学信号和第二水声发射节点发出的第二声学信号;其中,所述第一水声发射节点和所述第二水声发射节点为相距预设基线距离的两个节点,所述第一声学信号和所述第二声学信号间隔预设时间间隔发射;
33、第一确定模块,用于确定所述第一声学信号和所述第二声学信号到达目标水声接收点的实际接收时间间隔;其中,所述目标水声接收点为设置于水池清洁机器人上的机器人水声接收节点;
34、第二确定模块,用于根据所述实际接收时间间隔、所述预设时间间隔和所述预设基线距离,确定所述水池清洁机器人相对于所述定位发射端的相对位置。
35、本公开实施例还提供一种电子设备,包括:
36、处理器;
37、用于存储处理器可执行指令的存储器;
38、其中,所述处理器被配置为执行指令,以实现上述的方法中的各步骤。
39、本公开实施例还提供一种计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现上述的方法中的各步骤。
40、本公开实施例还提供一种计算机程序产品,包括计算机程序/指令,所述计算机程序/指令被处理器执行时实现上述的方法中的各步骤。
41、本公开的实施例提供的技术方案至少带来以下有益效果:
42、在本公开的一些实施例中,获取第一水声发射节点发出的第一声学信号和第二水声发射节点发出的第二声学信号;其中,第一水声发射节点和第二水声发射节点为相距预设基线距离的两个节点,第一声学信号和第二声学信号间隔预设时间间隔发射;确定第一声学信号和第二声学信号到达目标水声接收点的实际接收时间间隔;其中,目标水声接收点为设置于水池清洁机器人上的机器人水声接收节点;根据实际接收时间间隔、预设时间间隔和预设基线距离,确定水池清洁机器人相对于定位发射端的相对位置;本公开通过水池内安装的定位发射端与水池清洁机器人进行通信定位,降低通信延迟,提高定位精度,进而提高水池清洁机器人的控制效率。
43、应当理解的是,以上的一般描述和后文的细节描述仅是示例性和解释性的,并不能限制本公开。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com