CN112444816A - 定位方法及装置、存储介质和电子装置 - Google Patents
定位方法及装置、存储介质和电子装置 Download PDFInfo
- Publication number
- CN112444816A CN112444816A CN201910803592.3A CN201910803592A CN112444816A CN 112444816 A CN112444816 A CN 112444816A CN 201910803592 A CN201910803592 A CN 201910803592A CN 112444816 A CN112444816 A CN 112444816A
- Authority
- CN
- China
- Prior art keywords
- ultrasonic
- infrared module
- distance
- infrared
- module
- 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.)
- Pending
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S15/00—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems
- G01S15/02—Systems using the reflection or reradiation of acoustic waves, e.g. sonar systems using reflection of acoustic waves
- G01S15/06—Systems determining the position data of a target
- G01S15/46—Indirect determination of position data
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S17/00—Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
- G01S17/02—Systems using the reflection of electromagnetic waves other than radio waves
- G01S17/06—Systems determining position data of a target
- G01S17/46—Indirect determination of position data
- G01S17/48—Active triangulation systems, i.e. using the transmission and reflection of electromagnetic waves other than radio waves
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Computer Networks & Wireless Communication (AREA)
- General Physics & Mathematics (AREA)
- Acoustics & Sound (AREA)
- Measurement Of Velocity Or Position Using Acoustic Or Ultrasonic Waves (AREA)
Abstract
本发明提供了一种定位方法及装置、存储介质和电子装置;其中,该方法包括:通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度。
Description
技术领域
本发明涉及智能设备领域,具体而言,涉及一种定位方法及装置、存储介质和电子装置。
背景技术
随着智能机器人的发展,自动回充已成为机器人必要功能,自动回充指在机器人电量小于一定值时,再无人为干预的情况下,自动移动至充电桩所在区域,并通过移动机器人,将机器人自身充电接口与充电桩接触,实现充电。而充电桩与机器人充电口,接触面积较小,这里机器人充电口自动贴近充电桩需要精度较高的检测和控制。
现有自动回充检测大都使用多个红外模块,或激光镭射。多个红外模块将充电桩周围分为多个区域,控制机器人行驶至相应区域,以实现与充电桩的对接,但是该方式定位精度较低;激光镭射,机器人安装激光雷达,充电桩装有不同反射强度的反射条,机器人可根据激光雷达收到的数据,得到与充电桩的角度和距离,带式该方式成本较高。
针对相关技术中的上述问题,目前尚未存在有效的解决方案。
发明内容
本发明实施例提供了一种定位方法及装置、存储介质和电子装置,以至少解决相关技术中机器人的自动回充的方式精度较低的问题。
根据本发明的一个实施例,提供了一种定位的方法,包括:通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;其中,所述第一超声红外模块和第二超声红外模块设置在机器装置上,所述第三超声红外模块和第四超声红外模块设置在充电装置上,且所述第一超声红外模块和第二超声红外模块之间的距离为第五距离、所述第三超声红外模块和第四超声红外模块之间的距离为第六距离;根据所述第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定所述机器装置与所述充电装置的相对距离和相对角度。
根据本发明的另一个实施例,提供了一种定位的装置,包括:一种定位装置,包括:第一确定模块,用于通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;第二确定模块,用于通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;其中,所述第一超声红外模块和第二超声红外模块设置在机器装置上,所述第三超声红外模块和第四超声红外模块设置在充电装置上,且所述第一超声红外模块和第二超声红外模块之间的距离为第五距离、所述第三超声红外模块和第四超声红外模块之间的距离为第六距离;第三确定模块,用于根据所述第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定所述机器装置与所述充电装置的相对距离和相对角度。
根据本发明的又一个实施例,还提供了一种存储介质,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行上述任一项方法实施例中的步骤。
根据本发明的又一个实施例,还提供了一种电子装置,包括存储器和处理器,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行上述任一项方法实施例中的步骤。
通过本发明,通过在机器装置和充电装置上分别设置两个红外超声模块,进而根据该红外超声模块之间传输的红外信号超声模块确定出两两模块之间的距离,进而可以准确的确定出机器装置与充电装置的相对距离和相对角度,实现了机器装置与充电装置之间的精准定位,从而解决了相关技术中机器人的自动回充的方式精度较低的问题,提高了机器装置自动回充的精度。
附图说明
此处所说明的附图用来提供对本发明的进一步理解,构成本申请的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1是根据本发明实施例的定位方法的流程图;
图2是根据本发明实施例的机器人自动回充的示意图;
图3是根据本发明实施例的机器人与充电装置定位的计算示意图;
图4是根据本发明实施例的定位装置的结构框图。
具体实施方式
下文中将参考附图并结合实施例来详细说明本发明。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
需要说明的是,本发明的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。
实施例1
在本实施例中提供了一种定位的方法,图1是根据本发明实施例的定位方法的流程图,如图1所示,该流程包括如下步骤:
步骤S102,通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
步骤S104,通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,第一超声红外模块和第二超声红外模块设置在机器装置上,第三超声红外模块和第四超声红外模块设置在充电装置上,且第一超声红外模块和第二超声红外模块之间的距离为第五距离、第三超声红外模块和第四超声红外模块之间的距离为第六距离;
步骤S106,根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度。
需要说明的是,在本申请中第一超声红外模块和第二超声红外模块可以是接收超声信号和红外信号的超声红外接收模块,进而第三超声红外模块和第四超声红外模块为发送超声信号和红外信号的超声红外发送模块。当然,也可以是第一超声红外模块和第二超声红外模块可以是发送超声信号和红外信号的超声红外发送模块,进而第三超声红外模块和第四超声红外模块为接收超声信号和红外信号的超声红外接收模块。
在第一超声红外模块和第二超声红外模块可以是超声红外接收模块,第三超声红外模块和第四超声红外模块为超声红外发送模块的情况下,则是第三超声红外模块发送超声信号和红外信号到第一超声红外模块和第二超声红外模块,第四超声红外模块发送超声信号和红外信号到第一超声红外模块和第二超声红外模块。也即,第一超声红外模块可以接收到第三超声红外模块超声信号和红外信号,以及第一超声红外模块可以接收到第四超声红外模块超声信号和红外信号;同理,第二超声红外模块可以接收到第三超声红外模块超声信号和红外信号,以及第二超声红外模块可以接收到第四超声红外模块超声信号和红外信号。
当然,在第一超声红外模块和第二超声红外模块可以是超声红外发送模块,第三超声红外模块和第四超声红外模块为超声红外接收模块的情况下,则与上述情况刚好相反,在次不再赘述。
基于此,对于上述步骤S102与步骤S104中涉及到的第一距离、第二距离、第三距离、第四距离,下面结合具体的应用场景对其说明,如图2所示,假设S1第三超声红外模块,S2第四超声红外模块,R1为第一超声红外模块,R2为第二超声红外模块,则d为第一距离,f为第二距离,e第三距离,b为第四距离,c为第五距离,a为第六距离。
由上述步骤S102至步骤S106可知,通过在机器装置和充电装置上分别设置两个红外超声模块,进而根据该红外超声模块之间传输的红外信号超声模块确定出两两模块之间的距离,进而可以准确的确定出机器装置与充电装置的相对距离和相对角度,实现了机器装置与充电装置之间的精准定位,从而解决了相关技术中机器人的自动回充的方式精度较低的问题,提高了机器装置自动回充的精度。
需要说明的是,本申请中涉及到的第一超声红外模块,第二超声红外模块,第三超声红外模块以及第四超声红外模块优选设置在同一个平面内,在同一个平面内对于后续确定机器装置与充电装置的相对距离和相对角度会更加便捷。此外,第三超声红外模块与第四超声红外模块分别设置在充电装置的充电口两端,这样能够更加精准地确定出的机器装置与充电装置之间的定位。
在本申请的可选实施方式中,第一超声红外模块和第二超声红外模块为接收超声信号和红外信号的超声红外模块;第三超声红外模块和第四超声红外模块为发送超声信号和红外信号的超声红外模块的情况下,
第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:第一超声红外模块接收第三超声红外模块发送的第一红外信号和第一超声信号;第一超声红外模块接收第四超声红外模块发送的第二红外信号和第二超声信号;
第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:第二超声红外模块接收第三超声红外模块发送的第三红外信号和第三超声信号;第二超声红外模块接收第四超声红外模块发送的第四红外信号和第四超声信号。
在本申请的可选实施方式中,对于步骤S102中涉及到的通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离的方式可以进一步包括:
步骤S102-11,在所述第一超声红外模块接收到所述第一红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第一超声红外模块接收到所述第一超声信号之间的第一时间差,并根据所述第一时间差和超声信号的速率确定所述第一距离;
步骤S102-12,在所述第一超声红外模块接收到所述第二红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第一超声红外模块接收到所述第二超声信号之间的第二时间差,并根据所述第二时间差和超声信号的速率确定所述第二距离。
需要说明的是,在短距离传输中红外信号的传输时间可以忽略不计,另外超声信号的速率是一个公知的技术特征。因此,基于上述时间差和超声信号的速率确定出该第一距离,同理,第二距离也是通过同样的方式确定。
在本申请的另一个可选实施方式中,对于本申请步骤S104中涉及到的通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离方式,进一步可以包括:
步骤S104-11,在所述第二超声红外模块接收到所述第三红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第二超声红外模块接收到所述第三超声信号之间的第三时间差,并根据所述第三时间差和超声信号的速率确定所述第三距离;
步骤S104-12,在所述第二超声红外模块接收到所述第四红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第二超声红外模块接收到所述第四超声信号之间的第四时间差,并根据所述第二时间差和所述超声信号的速率确定所述第四距离。
需要说明的是,步骤S104确定第三距离与第四距离的方式与上述步骤S102中确定第一距离和第二距离的方式是类似的。
在本申请的再一个可选实施方式中,对于步骤S106中涉及到的根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度的方式,进一步可以包括:
步骤S106-11,通过第一距离,第二距离,第三距离,第四距离,以及第五距离和第六距离确定出第一超声红外模块与第二超声红外模块之间连线的第一中点到第三超声红外模块与第四超声红外模块之间连线的第二中点的距离;
步骤S106-12通过第一距离,第二距离,第三距离,第四距离,以及第五距离和第六距离机器装置到充电装置的距离确定出第一中点与第二中点连线与第一超声红外模块与第二超声红外模块之间的连线的夹角。
需要说明的是,如图2所示,在d为第一距离,f为第二距离,e第三距离,b为第四距离,c为第五距离,a为第六距离的情况下,得到该第一超声红外模块与第二超声红外模块之间的第一中点到第三超声红外模块与第四超声红外模块之间的第二中点的距离,以及第一中点与第二中点连线与第一超声红外模块与第二超声红外模块之间的连线的夹角的方式有很多,下面给出其中一种计算方式:
如图3所示,四边形中a、c、d、e、f、b为已知的参数。
△dec中
△daf中
△dgc中
△gha中
∠H=∠F-∠C
△dai中
△ihc中
经过上述计算,得到机器人与充电装置角度距离Distance为h,角度Angle为:π-∠I。
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到根据上述实施例的方法可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件,但很多情况下前者是更佳的实施方式。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质(如ROM/RAM、磁碟、光盘)中,包括若干指令用以使得一台终端设备(可以是手机,计算机,服务器,或者网络设备等)执行本发明各个实施例的方法。
实施例2
在本实施例中还提供了一种定位装置,该装置用于实现上述实施例及优选实施方式,已经进行过说明的不再赘述。如以下所使用的,术语“模块”可以实现预定功能的软件和/或硬件的组合。尽管以下实施例所描述的装置较佳地以软件来实现,但是硬件,或者软件和硬件的组合的实现也是可能并被构想的。
图4是根据本发明实施例的定位的装置的结构框图,如图3所示,该装置包括:
(1)第一确定模块32,用于通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
(2)第二确定模块34,用于通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,第一超声红外模块和第二超声红外模块设置在机器装置上,第三超声红外模块和第四超声红外模块设置在充电装置上,且第一超声红外模块和第二超声红外模块之间的距离为第五距离、第三超声红外模块和第四超声红外模块之间的距离为第六距离;
(3)第三确定模块36,用于根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度。
需要说明的是,在第一超声红外模块和第二超声红外模块为接收超声信号和红外信号的超声红外模块;第三超声红外模块和第四超声红外模块为发送超声信号和红外信号的超声红外模块的情况下,
第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:第一超声红外模块接收第三超声红外模块发送的第一红外信号和第一超声信号;第一超声红外模块接收第四超声红外模块发送的第二红外信号和第二超声信号;
第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:第二超声红外模块接收第三超声红外模块发送的第三红外信号和第三超声信号;第二超声红外模块接收第四超声红外模块发送的第四红外信号和第四超声信号。
可选地,本申请中的第一确定模块32进一步可以包括:
第一确定单元,用于在所述第一超声红外模块接收到所述第一红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第一超声红外模块接收到所述第一超声信号之间的第一时间差,并根据所述第一时间差和超声信号的速率确定所述第一距离;
第二确定单元,用于在所述第一超声红外模块接收到所述第二红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第一超声红外模块接收到所述第二超声信号之间的第二时间差,并根据所述第二时间差和超声信号的速率确定所述第二距离。
可选地,本申请中的第二确定模块34进一步可以包括:
第三确定单元,用于在所述第二超声红外模块接收到所述第三红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第二超声红外模块接收到所述第三超声信号之间的第三时间差,并根据所述第三时间差和超声信号的速率确定所述第三距离;
第四确定单元,用于在所述第二超声红外模块接收到所述第四红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第二超声红外模块接收到所述第四超声信号之间的第四时间差,并根据所述第二时间差和所述超声信号的速率确定所述第四距离。
可选地,本申请中的第三确定模块36进一步可以包括:
第五确定单元,用于通过第一距离,第二距离,第三距离,第四距离,以及第五距离和第六距离确定出第一超声红外模块与第二超声红外模块之间连线的第一中点到第三超声红外模块与第四超声红外模块之间连线的第二中点的距离;
第六确定单元,用于通过第一距离,第二距离,第三距离,第四距离,以及第五距离和第六距离机器装置到充电装置的距离确定出第一中点与第二中点连线与第一超声红外模块与第二超声红外模块之间的连线的夹角。
需要说明的是,上述各个模块是可以通过软件或硬件来实现的,对于后者,可以通过以下方式实现,但不限于此:上述模块均位于同一处理器中;或者,上述各个模块以任意组合的形式分别位于不同的处理器中。
实施例3
本发明的实施例还提供了一种存储介质,该存储介质中存储有计算机程序,其中,该计算机程序被设置为运行时执行上述任一项方法实施例中的步骤。
可选地,在本实施例中,上述存储介质可以被设置为存储用于执行以下步骤的计算机程序:
S1,通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
S2,通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,第一超声红外模块和第二超声红外模块设置在机器装置上,第三超声红外模块和第四超声红外模块设置在充电装置上,且第一超声红外模块和第二超声红外模块之间的距离为第五距离、第三超声红外模块和第四超声红外模块之间的距离为第六距离;
S3,根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度。
可选地,在本实施例中,上述存储介质可以包括但不限于:U盘、只读存储器(Read-Only Memory,简称为ROM)、随机存取存储器(Random Access Memory,简称为RAM)、移动硬盘、磁碟或者光盘等各种可以存储计算机程序的介质。
本发明的实施例还提供了一种电子装置,包括存储器和处理器,该存储器中存储有计算机程序,该处理器被设置为运行计算机程序以执行上述任一项方法实施例中的步骤。
可选地,上述电子装置还可以包括传输设备以及输入输出设备,其中,该传输设备和上述处理器连接,该输入输出设备和上述处理器连接。
可选地,在本实施例中,上述处理器可以被设置为通过计算机程序执行以下步骤:
S1,通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
S2,通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,第一超声红外模块和第二超声红外模块设置在机器装置上,第三超声红外模块和第四超声红外模块设置在充电装置上,且第一超声红外模块和第二超声红外模块之间的距离为第五距离、第三超声红外模块和第四超声红外模块之间的距离为第六距离;
S3,根据第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定机器装置与充电装置的相对距离和相对角度。
可选地,本实施例中的具体示例可以参考上述实施例及可选实施方式中所描述的示例,本实施例在此不再赘述。
显然,本领域的技术人员应该明白,上述的本发明的各模块或各步骤可以用通用的计算装置来实现,它们可以集中在单个的计算装置上,或者分布在多个计算装置所组成的网络上,可选地,它们可以用计算装置可执行的程序代码来实现,从而,可以将它们存储在存储装置中由计算装置来执行,并且在某些情况下,可以以不同于此处的顺序执行所示出或描述的步骤,或者将它们分别制作成各个集成电路模块,或者将它们中的多个模块或步骤制作成单个集成电路模块来实现。这样,本发明不限制于任何特定的硬件和软件结合。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员来说,本发明可以有各种更改和变化。凡在本发明的原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (11)
1.一种定位方法,其特征在于,包括:
通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,所述第一超声红外模块和第二超声红外模块设置在机器装置上,所述第三超声红外模块和第四超声红外模块设置在充电装置上,且所述第一超声红外模块和第二超声红外模块之间的距离为第五距离、所述第三超声红外模块和第四超声红外模块之间的距离为第六距离;
根据所述第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定所述机器装置与所述充电装置的相对距离和相对角度。
2.根据权利要求1所述的方法,其特征在于,所述第一超声红外模块和所述第二超声红外模块为接收超声信号和红外信号的超声红外模块;所述第三超声红外模块和所述第四超声红外模块为发送超声信号和红外信号的超声红外模块;
所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:所述第一超声红外模块接收所述第三超声红外模块发送的第一红外信号和第一超声信号;所述第一超声红外模块接收所述第四超声红外模块发送的第二红外信号和第二超声信号;
所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:所述第二超声红外模块接收所述第三超声红外模块发送的第三红外信号和第三超声信号;所述第二超声红外模块接收所述第四超声红外模块发送的第四红外信号和第四超声信号。
3.根据权利要求2所述的方法,其特征在于,
通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离,包括:
在所述第一超声红外模块接收到所述第一红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第一超声红外模块接收到所述第一超声信号之间的第一时间差,并根据所述第一时间差和超声信号的速率确定所述第一距离;
在所述第一超声红外模块接收到所述第二红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第一超声红外模块接收到所述第二超声信号之间的第二时间差,并根据所述第二时间差和超声信号的速率确定所述第二距离;
通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离,包括:
在所述第二超声红外模块接收到所述第三红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第二超声红外模块接收到所述第三超声信号之间的第三时间差,并根据所述第三时间差和超声信号的速率确定所述第三距离;
在所述第二超声红外模块接收到所述第四红外信号的情况下,启动所述机器装置的计时器;确定从所述计时器开始计时到所述第二超声红外模块接收到所述第四超声信号之间的第四时间差,并根据所述第二时间差和所述超声信号的速率确定所述第四距离。
4.根据权利要求1所述的方法,其特征在于,根据所述第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定所述机器装置与所述充电装置的相对距离和相对角度,包括:
通过所述第一距离,所述第二距离,所述第三距离,所述第四距离,以及所述第五距离和所述第六距离确定出所述第一超声红外模块与所述第二超声红外模块之间连线的第一中点到所述第三超声红外模块与所述第四超声红外模块之间连线的第二中点的距离;
通过所述第一距离,所述第二距离,所述第三距离,所述第四距离,以及所述第五距离和所述第六距离所述机器装置到所述充电装置的距离,确定出所述第一中点与所述第二中点连线与第一超声红外模块与所述第二超声红外模块之间的连线的夹角。
5.根据权利要求1所述的方法,其特征在于,
所述第一超声红外模块,所述第二超声红外模块,所述第三超声红外模块以及所述第四超声红外模块在同一个平面内;和/或,
所述第三超声红外模块与所述第四超声红外模块分别设置在所述充电装置的充电口两端。
6.一种定位装置,其特征在于,包括:
第一确定模块,用于通过第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第一距离、第二距离;
第二确定模块,用于通过第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互,确定所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间的第三距离、第四距离;
其中,所述第一超声红外模块和第二超声红外模块设置在机器装置上,所述第三超声红外模块和第四超声红外模块设置在充电装置上,且所述第一超声红外模块和第二超声红外模块之间的距离为第五距离、所述第三超声红外模块和第四超声红外模块之间的距离为第六距离;
第三确定模块,用于根据所述第一距离、第二距离、第三距离、第四距离、第五距离和第六距离,确定所述机器装置与所述充电装置的相对距离和相对角度。
7.根据权利要求6所述的装置,其特征在于,所述第一超声红外模块和所述第二超声红外模块为接收超声信号和红外信号的超声红外模块;所述第三超声红外模块和所述第四超声红外模块为发送超声信号和红外信号的超声红外模块;
所述第一超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:所述第一超声红外模块接收所述第三超声红外模块发送的第一红外信号和第一超声信号;所述第一超声红外模块接收所述第四超声红外模块发送的第二红外信号和第二超声信号;
所述第二超声红外模块分别与第三超声红外模块、第四超声红外模块之间红外信号、超声信号的交互包括:所述第二超声红外模块接收所述第三超声红外模块发送的第三红外信号和第三超声信号;所述第二超声红外模块接收所述第四超声红外模块发送的第四红外信号和第四超声信号。
8.根据权利要求7所述的装置,其特征在于,
所述第一确定模块包括:
第一确定单元,用于在所述第一超声红外模块接收到所述第一红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第一超声红外模块接收到所述第一超声信号之间的第一时间差,并根据所述第一时间差和超声信号的速率确定所述第一距离;
第二确定单元,用于在所述第一超声红外模块接收到所述第二红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第一超声红外模块接收到所述第二超声信号之间的第二时间差,并根据所述第二时间差和超声信号的速率确定所述第二距离;
所述第二确定模块包括:
第三确定单元,用于在所述第二超声红外模块接收到所述第三红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第二超声红外模块接收到所述第三超声信号之间的第三时间差,并根据所述第三时间差和超声信号的速率确定所述第三距离;
第四确定单元,用于在所述第二超声红外模块接收到所述第四红外信号的情况下,启动所述机器装置的计时器,确定从所述计时器开始计时到所述第二超声红外模块接收到所述第四超声信号之间的第四时间差,并根据所述第二时间差和所述超声信号的速率确定所述第四距离。
9.根据权利要求6所述的装置,其特征在于,所述第三确定模块包括:
第五确定单元,用于通过所述第一距离,所述第二距离,所述第三距离,所述第四距离,以及所述第五距离和所述第六距离确定出所述第一超声红外模块与所述第二超声红外模块之间连线的第一中点到所述第三超声红外模块与所述第四超声红外模块之间连线的第二中点的距离;
第六确定单元,用于通过所述第一距离,所述第二距离,所述第三距离,所述第四距离,以及所述第五距离和所述第六距离所述机器装置到所述充电装置的距离确定出所述第一中点与所述第二中点连线与第一超声红外模块与所述第二超声红外模块之间的连线的夹角。
10.一种计算机可读的存储介质,其特征在于,所述存储介质中存储有计算机程序,其中,所述计算机程序被设置为运行时执行所述权利要求1至5任一项中所述的方法。
11.一种电子装置,包括存储器和处理器,其特征在于,所述存储器中存储有计算机程序,所述处理器被设置为运行所述计算机程序以执行所述权利要求1至5任一项中所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910803592.3A CN112444816A (zh) | 2019-08-28 | 2019-08-28 | 定位方法及装置、存储介质和电子装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910803592.3A CN112444816A (zh) | 2019-08-28 | 2019-08-28 | 定位方法及装置、存储介质和电子装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN112444816A true CN112444816A (zh) | 2021-03-05 |
Family
ID=74741148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910803592.3A Pending CN112444816A (zh) | 2019-08-28 | 2019-08-28 | 定位方法及装置、存储介质和电子装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112444816A (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050021179A1 (en) * | 2003-07-23 | 2005-01-27 | Se-Wan Kim | Method and apparatus for detecting position of mobile robot |
CN1637432A (zh) * | 2003-12-22 | 2005-07-13 | Lg电子株式会社 | 检测移动机器人位置的装置和方法 |
US20150003206A1 (en) * | 2013-06-27 | 2015-01-01 | Kabushiki Kaisha Toshiba | Apparatus, method and program for spatial position measurement |
US20160116568A1 (en) * | 2013-05-17 | 2016-04-28 | Siemens Aktiengesellschaft | Positioning method and device |
CN107272675A (zh) * | 2017-06-06 | 2017-10-20 | 青岛克路德机器人有限公司 | 基于红外线和超声波的自主充电系统 |
US20180081367A1 (en) * | 2016-09-08 | 2018-03-22 | Nanjing Avatarmind Robot Technology Co., Ltd. | Method and system for automatically charging robot |
CN108233466A (zh) * | 2017-12-20 | 2018-06-29 | 北京理工大学 | 自动充电系统 |
-
2019
- 2019-08-28 CN CN201910803592.3A patent/CN112444816A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20050021179A1 (en) * | 2003-07-23 | 2005-01-27 | Se-Wan Kim | Method and apparatus for detecting position of mobile robot |
CN1637432A (zh) * | 2003-12-22 | 2005-07-13 | Lg电子株式会社 | 检测移动机器人位置的装置和方法 |
US20160116568A1 (en) * | 2013-05-17 | 2016-04-28 | Siemens Aktiengesellschaft | Positioning method and device |
US20150003206A1 (en) * | 2013-06-27 | 2015-01-01 | Kabushiki Kaisha Toshiba | Apparatus, method and program for spatial position measurement |
US20180081367A1 (en) * | 2016-09-08 | 2018-03-22 | Nanjing Avatarmind Robot Technology Co., Ltd. | Method and system for automatically charging robot |
CN107272675A (zh) * | 2017-06-06 | 2017-10-20 | 青岛克路德机器人有限公司 | 基于红外线和超声波的自主充电系统 |
CN108233466A (zh) * | 2017-12-20 | 2018-06-29 | 北京理工大学 | 自动充电系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3618022B1 (en) | Remote control device and remote control method for automatic driving vehicle, and server | |
CN107005062B (zh) | 充电方法、移动终端和充电装置 | |
US20150091499A1 (en) | Charger, terminal, charging system, and charging control method | |
CN110120989B (zh) | 一种实现设备间自动分配匹配地址的方法及系统 | |
CN108629594A (zh) | 支付方法、装置、服务器以及存储介质 | |
CN106385304B (zh) | 数据传输方法、设备和系统 | |
CN112256011B (zh) | 回归引导方法、回归引导装置、移动机器人及存储介质 | |
US9989619B2 (en) | Bulk propagation timing measurement messaging | |
CN110351875A (zh) | 一种辅小区波束失败恢复方法、终端及基站 | |
CN112531830A (zh) | 机器人的充电方法、装置和存储介质 | |
CN112260366A (zh) | 充电方法、充电装置和充电器 | |
CN112968752A (zh) | 一种uart通信的波特率切换方法、装置及发起方终端 | |
CN111061735A (zh) | 一种基于单链区块链的扩容方法及装置 | |
CN109254210B (zh) | 电子设备端口类型检测方法、装置、检测电路及电子设备 | |
CN108985749A (zh) | 一种支付方法、测距方法、支付机具设备和测距设备 | |
CN112566078A (zh) | 设备连接方法及装置、存储介质及电子装置 | |
CN112444816A (zh) | 定位方法及装置、存储介质和电子装置 | |
CN104242998A (zh) | 一种通过磁传感器快捷共享多种信息的方法及系统 | |
CN107320129B (zh) | 基于医学的超声波信号的延时参数实时计算方法及装置 | |
CN105933921A (zh) | 一种无线网络控制方法及终端设备 | |
CN116788789A (zh) | 煤流的控制方法、装置和煤流监测系统 | |
CN112540604A (zh) | 机器人充电系统、方法及终端设备 | |
CN108536267B (zh) | 信息处理方法和电子设备 | |
CN110868268A (zh) | 本地时间的对时方法、装置、计时设备和存储介质 | |
KR20200042471A (ko) | 충전 방법, 단말 및 컴퓨터 저장 매체 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination |