CN113740870B - 一种多频融合ToF的测距方法、系统、装置及存储介质 - Google Patents

一种多频融合ToF的测距方法、系统、装置及存储介质 Download PDF

Info

Publication number
CN113740870B
CN113740870B CN202110894274.XA CN202110894274A CN113740870B CN 113740870 B CN113740870 B CN 113740870B CN 202110894274 A CN202110894274 A CN 202110894274A CN 113740870 B CN113740870 B CN 113740870B
Authority
CN
China
Prior art keywords
distance
maximum detection
frequency
detection distance
repetition
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.)
Active
Application number
CN202110894274.XA
Other languages
English (en)
Other versions
CN113740870A (zh
Inventor
邓舜耕
王文熹
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Zhuhai Shixi Technology Co Ltd
Original Assignee
Zhuhai Shixi Technology Co Ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Zhuhai Shixi Technology Co Ltd filed Critical Zhuhai Shixi Technology Co Ltd
Priority to CN202110894274.XA priority Critical patent/CN113740870B/zh
Publication of CN113740870A publication Critical patent/CN113740870A/zh
Application granted granted Critical
Publication of CN113740870B publication Critical patent/CN113740870B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01SRADIO 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/00Systems using the reflection or reradiation of electromagnetic waves other than radio waves, e.g. lidar systems
    • G01S17/02Systems using the reflection of electromagnetic waves other than radio waves
    • G01S17/06Systems determining position data of a target
    • G01S17/08Systems determining position data of a target for measuring distance only
    • G01S17/32Systems determining position data of a target for measuring distance only using transmission of continuous waves, whether amplitude-, frequency-, or phase-modulated, or unmodulated
    • G01S17/36Systems determining position data of a target for measuring distance only using transmission of continuous waves, whether amplitude-, frequency-, or phase-modulated, or unmodulated with phase comparison between the received signal and the contemporaneously transmitted signal

Landscapes

  • Physics & Mathematics (AREA)
  • Electromagnetism (AREA)
  • Engineering & Computer Science (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Optical Radar Systems And Details Thereof (AREA)

Abstract

本申请公开了一种多频融合ToF测距方法、系统、装置及存储介质,用于在不增加硬件成本的基础上提高帧率以及降低功耗。本申请方法包括:分别确定第一最大检测距离和第二最大检测距离;根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;根据第一重复周期数和第二重复周期数的所有取值确定第一重复周期数和第二重复周期数的所有有效组合;分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与距离差值的映射表格,映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。

Description

一种多频融合ToF的测距方法、系统、装置及存储介质
技术领域
本申请涉及数据处理领域,尤其涉及一种多频融合ToF测距方法、系统、装置及存储介质。
背景技术
飞行时间法(Time-of-Flight,ToF)是一种通过光速的飞行时间来测量两点之间距离的方法,其具体应用是通过计算光束从被发射到经目标物体反射被接收的时间差或相位差来计算目标物体的距离,以获得目标物体的距离信息。目前,ToF技术已被广泛应用于包含3D人脸识别、3D建模以及手势识别、体感游戏、AR/VR在内的众多场景中。
相位ToF法是通过发射连续调制载波信号,根据该调制信号在待测点往返一次所形成的相移来得到待测点的距离。但由于调制载波信号具有周期性,所以测量系统中的任何相位测量每隔一个周期就会重复一次,因此这种单一调制频率的相位法测距会造成距离模糊现象。
为了消除ToF中的距离模糊现象,现有技术中一般采用对同一被测点发射多种调制频率信号,再将多频结算的距离融合得到正确的距离的方法。ToF 多频融合算法越复杂,其对芯片算力要求越高,将导致芯片延时过高和功耗增加。
发明内容
本申请提供了一种多频融合ToF测距方法、系统、装置及存储介质,用于在不增加硬件成本的基础上提高帧率以及降低功耗。
本申请第一方面提供了一种多频融合ToF测距方法,包括:
分别确定第一最大检测距离和第二最大检测距离,所述第一最大检测距离为第一频率对应的最大检测距离,所述第二最大检测距离为第二频率对应的最大检测距离,所述第一频率和所述第二频率的频率不同;
根据所述第一最大检测距离和所述第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
根据所述第一重复周期数和第二重复周期数的所有取值确定所述第一重复周期数和第二重复周期数的所有有效组合;
分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与所述距离差值的映射表格,所述映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。
可选的,所述方法还包括:
根据所述第一频率和所述第二频率对目标物体进行测量;
根据测量结果确定第一测量距离和第二测量距离;
根据所述第一测量距离和所述第二测量距离计算得到实际距离差值;
在所述映射表格中确定与所述实际距离差值对应的第一重复周期数和第二重复周期数;
根据所述第一重复周期数和所述第二重复周期数确定所述目标物体的真实距离。
可选的,所述目标物体的真实距离通过如下公式确定:
Figure RE-GDA0003295161620000021
其中k0为所述第一重复周期数,D0为所述第一最大检测距离,d0为所述第一测量距离,k1为所述第二重复周期数,D1为所述第二最大检测距离,d1为所述第二测量距离。
可选的,所述根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数所有可能取值包括:
根据所述第一频率和所述第二频率的最大公约数以及光速确定理论最大检测距离;
根据所述第一最大检测距离和所述理论最大检测距离确定第一重复周期数的所有取值;
根据所述第二最大检测距离和所述理论最大检测距离确定第二重复周期数的所有取值。
可选的,所述理论最大检测距离通过如下公式确定:
Figure RE-GDA0003295161620000031
其中DMAX为所述理论最大检测距离,c为光速,gcd((f0,f1)为所述第一频率和所述第二频率的最大公约数。
可选的,所述第一重复周期数或所述第二重复周期数的所有取值通过如下公式确定:
Figure RE-GDA0003295161620000032
其中DMAX为所述理论最大检测距离,D为所述第一最大检测距离或所述第二最大检测距离,所述第一重复周期数或所述第二重复周期数的所有取值为0~N的所有整数。
可选的,所述距离差值通过如下公式计算得到:
Δd=k1*D1-k0*D0
其中Δd为距离差值,k1为所述第二重复周期数,D1为所述第二最大检测距离,k0为所述第一重复周期数,D0为所述第一最大检测距离。
本申请第二方面提供了一种多频融合ToF测距系统,包括:
第一确定单元,用于分别确定第一最大检测距离和第二最大检测距离,所述第一最大检测距离为第一频率对应的最大检测距离,所述第二最大检测距离为第二频率对应的最大检测距离,所述第一频率和所述第二频率的频率不同;
第二确定单元,用于根据所述第一最大检测距离和所述第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
第三确定单元,用于根据所述第一重复周期数和第二重复周期数的所有取值确定所述第一重复周期数和第二重复周期数的所有有效组合;
第四确定单元,用于分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与所述距离差值的映射表格,所述映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。
可选的,所述系统还包括:
测量单元,用于根据所述第一频率和所述第二频率对目标物体进行测量;
第五确定单元,用于根据测量结果确定第一测量距离和第二测量距离;
计算单元,用于根据所述第一测量距离和所述第二测量距离计算得到实际距离差值;
第六确定单元,用于在所述映射表格中确定与所述实际距离差值对应的第一重复周期数和第二重复周期数;
第七确定单元,用于根据所述第一重复周期数和所述第二重复周期数确定所述目标物体的真实距离。
可选的,所述目标物体的真实距离通过如下公式确定:
Figure RE-GDA0003295161620000041
其中k0为所述第一重复周期数,D0为所述第一最大检测距离,d0为所述第一测量距离,k1为所述第二重复周期数,D1为所述第二最大检测距离,d1为所述第二测量距离。
可选的,所述第二确定单元具体用于:
根据所述第一频率和所述第二频率的最大公约数以及光速确定理论最大检测距离;
根据所述第一最大检测距离和所述理论最大检测距离确定第一重复周期数的所有取值;
根据所述第二最大检测距离和所述理论最大检测距离确定第二重复周期数的所有取值。
可选的,所述理论最大检测距离通过如下公式确定:
Figure RE-GDA0003295161620000042
其中DMAX为所述理论最大检测距离,c为光速,gcd(f0,f1)为所述第一频率和所述第二频率的最大公约数。
可选的,所述第一重复周期数或所述第二重复周期数的所有取值通过如下公式确定:
Figure RE-GDA0003295161620000051
其中DMAX为所述理论最大检测距离,D为所述第一最大检测距离或所述第二最大检测距离,所述第一重复周期数或所述第二重复周期数的所有取值为0~N0的所有整数。
可选的,所述距离差值通过如下公式计算得到:
Δd=k1*D1-k0*D0
其中Δd为距离差值,k1为所述第二重复周期数,D1为所述第二最大检测距离,k0为所述第一重复周期数,D0为所述第一最大检测距离。
本申请第三方面提供了一种多频融合ToF测距装置,所述装置包括:
处理器、存储器、输入输出单元以及总线;
所述处理器与所述存储器、所述输入输出单元以及所述总线相连;
所述存储器保存有程序,所述处理器调用所述程序以执行第一方面以及第一方面中任一项可选的多频融合ToF测距方法。
本申请第四方面提供了一种计算机可读存储介质,所述计算机可读存储介质上保存有程序,所述程序在计算机上执行时执行第一方面以及第一方面中任一项可选的多频融合ToF测距方法。
从以上技术方案可以看出,本申请具有以下优点:
通过预先建立第一重复周期数和第二重复周期数与距离差值的映射表格,在后续实际测量时只需要根据处理器在两个频率的检测数据并作相应计算得到距离差值,随后在映射表格中查找与该距离差值对应的第一重复周期数和第二重复周期数,并根据第一重复周期数和第二重复周期数来计算目标物体的真实距离。
本申请提供的ToF多频融合测距方法相较于现有的复杂算法中计算量大大降低,从而能够实现在不增加硬件成本的基础上提高帧率,并且降低功耗。
附图说明
为了更清楚地说明本申请中的技术方案,下面将对实施例描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。
图1为本申请提供的多频融合ToF测距方法一个实施例流程示意图;
图2为本申请提供的多频融合ToF测距方法另一个实施例流程示意图;
图3为本申请提供的多频融合ToF测距系统一个实施例结构示意图;
图4为本申请提供的多频融合ToF测距系统另一个实施例结构示意图;
图5为本申请提供的多频融合ToF测距装置一个实施例结构示意图。
具体实施方式
本申请提供了一种多频融合ToF测距方法、系统、装置及存储介质,用于在不增加硬件成本的基础上提高帧率以及降低功耗。
需要说明的是,本申请提供的多频融合ToF测距方法应用于搭载有ToF 测距系统的终端上,例如终端可以是智能手机或电脑、平板电脑、智能电视、智能手表、便携计算机终端也可以是台式计算机等固定终端。本申请中的ToF 测距系统由发射端、接收端以及处理器三部分组成,其中发射端负责向被测点发送调制光信号,接收端负责接收被测点反射回来的光信号,而处理器则利用反射回来的光信号通过相位计算被测点距离ToF测距系统的距离。
请参阅图1,图1为本申请提供的多频融合ToF测距方法的一个实施例,该方法包括:
101、分别确定第一最大检测距离和第二最大检测距离,第一最大检测距离为第一频率对应的最大检测距离,第二最大检测距离为第二频率对应的最大检测距离,第一频率和第二频率的频率不同;
相位TOF法是通过发射连续调制载波信号,根据该调制信号在被测点往返一次所形成的相移得到待测点的距离。由于调制载波信号具有周期性,所以测量系统中的任何相位测量每隔会2π重复一次,即调制信号传播一个周期的距离,接收端测得的信号相位就延迟2π弧度,因此如果只用一种调制频率进行测距,将无法确认真实距离落在第几个距离周期,这种现象称为ToF测距中的距离模糊现象。需要说明的是,在某一固定的调制频率下,整个周期的距离被称为当前频率下的模糊距离,即本申请中的最大检测距离。
为了消除距离模糊现象,在进行本实施例提供的多频融合ToF测距方法时,首先发射端需要向任一被测点发射两个不同频率的载波信号,即本申请中的第一频率f0和第二频率f1,接收端则接收该被测点反射回来的两个不同的光信号。
处理器根据第一频率f0和第二频率f1的频率的值可以分别确定第一频率所对应的第一最大检测距离D0,和第二频率对应的第二最大检测距离D1
具体的,
Figure RE-GDA0003295161620000071
102、根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
在确定第一重复周期数k0和第二重复周期数k1之前,还需要根据第一频率f0和第二频率f1来确定本方法所能实现的理论最大检测距离DMAX,该理论最大检测距离DMAX由第一频率f0和第二频率f1的最大公约数以及光速c共同决定,具体的:
Figure RE-GDA0003295161620000072
第一重复周期数k0的取值范围是0~N0的所有整数,而N0的值由理论最大检测距离DMAX和第一最大检测距离D0共同决定,具体的:
Figure RE-GDA0003295161620000073
同理,第二重复周期数k1的取值范围是0~N1的所有整数,而N1的值由理论最大检测距离DMAX和第二最大检测距离D1共同决定,具体的:
Figure RE-GDA0003295161620000074
103、根据第一重复周期数和第二重复周期数的所有取值确定第一重复周期数和第二重复周期数的所有有效组合;
在本实施例中,第一频率f0和第二频率f1的频率的选取,即第一频率f0和第二频率f1的大小关系将影响到第一重复周期数k0和第二重复周期数k1的有效组合。下面进行举例说明:
取第一频率f0为100Mhz,第二频率f1为80Mhz,则可通过上述步骤101 中的公式确定第一最大检测距离D0为1498.96mm,第二最大检测距离D1为 1873.70mm;
第一频率f0和第二频率f1的最大公约数为20Mhz,再根据步骤102中的公式可确定理论最大检测距离DMAX为7494.81mm;
第一重复周期数k0的取值范围是0~N0的所有整数,计算可得N0为4,即 k0=0、1、2、3或4;
第二重复周期数k1的取值范围是0~N1的所有整数,其中N1为3,即k1=0、 1、2或3;
虽然k0和k1排列组合有5x4=20种之多,但是由于f0<2f1,因此在实际测量中不会出现|k0-k1|>1的情况,即一个f0的周期内不会出现两个完整的f1的周期,k0和k1需满足k0-k1≤1,据此在k0和k1的所有排列组合中可以确定k0和k1有效的组合仅有8种,具体有效组合如下表所示:
k<sub>0</sub> k<sub>1</sub>
0 0
1 0
1 1
2 1
2 2
3 2
3 3
4 3
需要说明的是,处理器可以在初始化过程中,根据f0和f1频率的选取来匹配相应的规则来确定k0和k1的有效组合,例如当f0<3f1时,k0和k1需满足 k0-k1≤2等。
104、分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与距离差值的映射表格,映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。
在确定了第一重复周期数k0和第二重复周期数k1的有效组合后,则分别计算k0和k1不同的有效组合对应的距离差值,并建立相应的映射表格存储起来,方便调用。
需要说明的是,距离差值Δd是指处理器根据接收端接收到的被测点反射回来的两个不同的光信号测得的相移
Figure RE-GDA0003295161620000091
Figure RE-GDA0003295161620000092
计算得到的第一测量距离d0和第二测量距离d1的差值。具体的:
Figure RE-GDA0003295161620000093
继而可推导出,Δd=d0-d1=k1*D1-k0*D0
通过代入不同的k0和k1和有效组合,计算得到与其对应的距离差值Δd,然后建立Δd关于k0和k1的映射表格。
接步骤103中的举例说明,根据举例中的不同的k0和k1的取值可得到如下映射表格:
k<sub>0</sub> k<sub>1</sub> Δd
0 0 0
1 0 -1499
1 1 375
2 1 -1124
2 2 749
3 2 -749
3 3 1124
4 3 -375
通过该映射表格的建立,使得在后续实际测量中,只需要向被测物体发射第一频率f0和第二频率f1的两个调制光信号,再根据处理器计算得到的距离差值在映射表格中查找对应的k0和k1的取值,即可通过相关公式计算得到目标物体的真实距离d。
在本实施例中,通过预先建立第一重复周期数和第二重复周期数与距离差值的映射表格,在后续实际测量时只需要根据处理器在两个频率的检测数据并作相应计算得到距离差值,随后在映射表格中查找与该距离差值对应的第一重复周期数和第二重复周期数,并根据第一重复周期数和第二重复周期数来计算目标物体的真实距离。
本申请提供的ToF多频融合测距方法相较于现有的复杂算法中计算量大大降低,从而能够实现在不增加硬件成本的基础上提高帧率,并且降低功耗。
以上对本申请提供的多频融合ToF测距方法中的映射表格的建立过程作相关描述,以下将对本申请提供的多频融合ToF测距方法中映射表格在实际测距中的应用进行详细描述,请参阅图2,图2为本申请提供的多频融合ToF 测距方法另一个实施例,该方法包括:
201、分别确定第一最大检测距离和第二最大检测距离,第一最大检测距离为第一频率对应的最大检测距离,第二最大检测距离为第二频率对应的最大检测距离,第一频率和第二频率的频率不同;
202、根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
203、根据第一重复周期数和第二重复周期数的所有取值确定第一重复周期数和第二重复周期数的所有有效组合;
204、分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与距离差值的映射表格,映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数;
本实施例中的步骤201至步骤204与前述实施例中步骤101至步骤104 类似,此处不再赘述。
205、根据第一频率和第二频率对目标物体进行测量;
在建立好Δd关于k0和k1的映射表格后,即可对目标物体进行测距。
首先进行第一次测量,处理器控制发射端向目标物体发射第一频率f0的调制光信号,接收端对目标物体反射回来的光信号进行采样,处理器计算得到发射端和接收端的光信号的第一相位差
Figure RE-GDA0003295161620000111
然后进行第二次测量,处理器控制发射端向目标物体发射第二频率f1的调制光信号,接收端对目标物体反射回来的光信号进行采样,处理器计算得到发射端和接收端的光信号的第二相位差
Figure RE-GDA0003295161620000112
206、根据测量结果确定第一测量距离和第二测量距离;
处理器根据第一相位差
Figure RE-GDA0003295161620000113
和第二相位差
Figure RE-GDA0003295161620000114
分别计算第一测量距离d0和第二测量距离d1,具体的:
Figure RE-GDA0003295161620000115
207、根据第一测量距离和第二测量距离计算得到实际距离差值;
处理器通过将第一测量距离d0和第二测量距离d1作差,得到实际距离差值Δd。
208、在映射表格中确定与实际距离差值对应的第一重复周期数和第二重复周期数;
利用前述步骤204中建立的Δd关于k0和k1的映射表格,即可通过实际距离差值Δd确定相应的第一重复周期数k0和第二重复周期数k1
209、根据第一重复周期数和第二重复周期数确定目标物体的真实距离。
在得到第一重复周期数k0和第二重复周期数k1的值后,即可轻松通过如下公式计算出目标物体的真实距离d,具体的:
Figure RE-GDA0003295161620000116
下面对本申请提供的多频融合ToF测距方法的全部流程进行举例说明:
取第一频率f0为100Mhz,第二频率f1为80Mhz,则可通过上述步骤201 中的公式确定第一最大检测距离D0为1498.96mm,第二最大检测距离D1为 1873.70mm;
第一频率f0和第二频率f1的最大公约数为20Mhz,再根据步骤202中的公式可确定理论最大检测距离DMAX为7494.81mm;
第一重复周期数k0的取值范围是0~N0的所有整数,计算可得N0为4,即 k0=0、1、2、3或4;
第二重复周期数k1的取值范围是0~N1的所有整数,其中N1为3,即k1=0、 1、2或3;
在根据第一频率f0和第二频率f1的值确定第一重复周期数k0和第二重复周期数k1的有效组合后,可建立如下映射表格:
k<sub>0</sub> k<sub>1</sub> Δd
0 0 0
1 0 -1499
1 1 375
2 1 -1124
2 2 749
3 2 -749
3 3 1124
4 3 -375
然后进入实际测量环节,通过向目标物体分别发射第一频率f0100Mhz和第二频率f180Mhz的两种调制光信号,可计算得到实际实际距离差值Δd:
1)、当Δd=0时,查表得k0=0,k1=0,那么真实距离
Figure RE-GDA0003295161620000121
2)、当Δd=-1499时,查表得k0=1,k1=0,那么真实距离
Figure RE-GDA0003295161620000122
3)、当Δd=375时,查表得k0=1,k1=1,那么真实距离
Figure RE-GDA0003295161620000123
4)、当Δd=-1124时,查表得k0=2,k1=1,那么真实距离
Figure RE-GDA0003295161620000131
5)、当Δd=749时,查表得k0=2,k1=2,那么真实距离
Figure RE-GDA0003295161620000132
6)、当Δd=-749时,查表得k0=3,k1=2,那么真实距离
Figure RE-GDA0003295161620000133
7)、当Δd=1124时,查表得k0=3,k1=3,那么真实距离
Figure RE-GDA0003295161620000134
8)、当Δd=-375时,查表得k0=4,k1=3,那么真实距离
Figure RE-GDA0003295161620000135
在本实施例中,在建立好映射表格后,只需要执行向目标物体发射第一频率和第二频率的调制光信号,并根据处理器测量得到的相应频率的相移计算得到实际距离差值,再通过映射表格查表获得与该实际距离差值匹配的两个频率的重复周期数,即可计算得到目标物体的真实距离。相较于现有的多频融合测距方法计算量大大降低,从而能够实现在不增加硬件成本的基础上提高帧率,并且降低功耗。
请参阅图3,图3为本申请提供的多频融合ToF测距系统一个实施例,该系统包括:
第一确定单元301,用于分别确定第一最大检测距离和第二最大检测距离,第一最大检测距离为第一频率对应的最大检测距离,第二最大检测距离为第二频率对应的最大检测距离,第一频率和第二频率的频率不同;
第二确定单元302,用于根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
第三确定单元303,用于根据第一重复周期数和第二重复周期数的所有取值确定第一重复周期数和第二重复周期数的所有有效组合;
第四确定单元304,用于分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与距离差值的映射表格,映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。
在本实施例中,通过预先建立第一重复周期数和第二重复周期数与距离差值的映射表格,在后续实际测量时只需要根据处理器在两个频率的检测数据并作相应计算得到距离差值,随后在映射表格中查找与该距离差值对应的第一重复周期数和第二重复周期数,并根据第一重复周期数和第二重复周期数来计算目标物体的真实距离。本申请提供的ToF多频融合测距系统相较于现有的系统中计算量大大降低,从而能够实现在不增加硬件成本的基础上提高帧率,并且降低功耗。
下面对本申请提供的多频融合ToF测距系统进行详细说明,请参阅图4,图4为本申请提供的多频融合ToF测距系统另一个实施例,该系统包括:
第一确定单元401,用于分别确定第一最大检测距离和第二最大检测距离,第一最大检测距离为第一频率对应的最大检测距离,第二最大检测距离为第二频率对应的最大检测距离,第一频率和第二频率的频率不同;
第二确定单元402,用于根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
第三确定单元403,用于根据第一重复周期数和第二重复周期数的所有取值确定第一重复周期数和第二重复周期数的所有有效组合;
第四确定单元404,用于分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与距离差值的映射表格,映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数。
进一步的,本实施例系统还包括:
测量单元405,用于根据第一频率和第二频率对目标物体进行测量;
第五确定单元406,用于根据测量结果确定第一测量距离和第二测量距离;
计算单元407,用于根据第一测量距离和第二测量距离计算得到实际距离差值;
第六确定单元408,用于在映射表格中确定与实际距离差值对应的第一重复周期数和第二重复周期数;
第七确定单元409,用于根据第一重复周期数和第二重复周期数确定目标物体的真实距离。
进一步的,目标物体的真实距离通过如下公式确定:
Figure RE-GDA0003295161620000151
其中k0为第一重复周期数,D0为第一最大检测距离,d0为第一测量距离, k1为第二重复周期数,D1为第二最大检测距离,d1为第二测量距离。
进一步的,第二确定单元具体用于:
根据第一频率和第二频率的最大公约数以及光速确定理论最大检测距离;
根据第一最大检测距离和理论最大检测距离确定第一重复周期数的所有取值;
根据第二最大检测距离和理论最大检测距离确定第二重复周期数的所有取值。
进一步的,理论最大检测距离通过如下公式确定:
Figure RE-GDA0003295161620000152
其中DMAX为理论最大检测距离,c为光速,gcd(f0,f1)为第一频率和第二频率的最大公约数。
进一步的,第一重复周期数或第二重复周期数的所有取值通过如下公式确定:
Figure RE-GDA0003295161620000153
其中DMAX为理论最大检测距离,D为第一最大检测距离或第二最大检测距离,第一重复周期数或第二重复周期数的所有取值为0~N0的所有整数。
进一步的,距离差值通过如下公式计算得到:
Δd=k1*D1-k0*D0
其中Δd为距离差值,k1为第二重复周期数,D1为第二最大检测距离,k0为第一重复周期数,D0为第一最大检测距离。
本实施例系统中,各单元的功能与前述图2所示方法实施例中的步骤对应,此处不再赘述。
本申请还提供了一种多频融合ToF测距装置,请参阅图5,图5为本申请提供的多频融合ToF测距装置一个实施例,该装置包括:
处理器501、存储器502、输入输出单元503、总线504;
处理器501与存储器502、输入输出单元503以及总线504相连;
存储器502保存有程序,处理器501调用程序以执行如上任一多频融合 ToF测距方法。
本申请还涉及一种计算机可读存储介质,计算机可读存储介质上保存有程序,其特征在于,当程序在计算机上运行时,使得计算机执行如上任一多频融合ToF测距方法。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的系统,装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的系统,装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。上述集成的单元既可以采用硬件的形式实现,也可以采用软件功能单元的形式实现。
所述集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,read-onlymemory)、随机存取存储器(RAM,random access memory)、磁碟或者光盘等各种可以存储程序代码的介质。

Claims (9)

1.一种多频融合ToF测距方法,其特征在于,所述方法包括:
分别确定第一最大检测距离和第二最大检测距离,所述第一最大检测距离为第一频率对应的最大检测距离,所述第二最大检测距离为第二频率对应的最大检测距离,所述第一频率和所述第二频率的频率不同;
根据所述第一最大检测距离和所述第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
根据所述第一重复周期数和第二重复周期数的所有取值确定所述第一重复周期数和第二重复周期数的所有有效组合;
分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与所述距离差值的映射表格,所述映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数;
根据所述第一频率和所述第二频率对目标物体进行测量;
根据测量结果确定第一测量距离和第二测量距离;
根据所述第一测量距离和所述第二测量距离计算得到实际距离差值;
在所述映射表格中确定与所述实际距离差值对应的第一重复周期数和第二重复周期数;
根据所述第一重复周期数和所述第二重复周期数确定所述目标物体的真实距离。
2.根据权利要求1所述的方法,其特征在于,所述目标物体的真实距离通过如下公式确定:
Figure FDA0003498310820000011
其中k0为所述第一重复周期数,D0为所述第一最大检测距离,d0为所述第一测量距离,k1为所述第二重复周期数,D1为所述第二最大检测距离,d1为所述第二测量距离。
3.根据权利要求1所述的方法,其特征在于,所述根据第一最大检测距离和第二最大检测距离分别确定第一重复周期数和第二重复周期数所有可能取值包括:
根据所述第一频率和所述第二频率的最大公约数以及光速确定理论最大检测距离;
根据所述第一最大检测距离和所述理论最大检测距离确定第一重复周期数的所有取值;
根据所述第二最大检测距离和所述理论最大检测距离确定第二重复周期数的所有取值。
4.根据权利要求3所述的方法,其特征在于,所述理论最大检测距离通过如下公式确定:
Figure FDA0003498310820000021
其中DMAX为所述理论最大检测距离,c为光速,gcd(f0,f1)为所述第一频率和所述第二频率的最大公约数。
5.根据权利要求4所述的方法,其特征在于,所述第一重复周期数或所述第二重复周期数的所有取值通过如下公式确定:
Figure FDA0003498310820000022
其中DMAX为所述理论最大检测距离,D为所述第一最大检测距离或所述第二最大检测距离,所述第一重复周期数或所述第二重复周期数的所有取值为0~N的所有整数。
6.根据权利要求1至5中任一项所述的方法,其特征在于,所述距离差值通过如下公式计算得到:
Δd=k1*D1-k0*D0
其中Δd为距离差值,k1为所述第二重复周期数,D1为所述第二最大检测距离,k0为所述第一重复周期数,D0为所述第一最大检测距离。
7.一种多频融合ToF测距系统,其特征在于,所述系统包括:
第一确定单元,用于分别确定第一最大检测距离和第二最大检测距离,所述第一最大检测距离为第一频率对应的最大检测距离,所述第二最大检测距离为第二频率对应的最大检测距离,所述第一频率和所述第二频率的频率不同;
第二确定单元,用于根据所述第一最大检测距离和所述第二最大检测距离分别确定第一重复周期数和第二重复周期数的所有取值;
第三确定单元,用于根据所述第一重复周期数和第二重复周期数的所有取值确定所述第一重复周期数和第二重复周期数的所有有效组合;
第四确定单元,用于分别确定与第一重复周期数和第二重复周期数的不同有效组合对应的距离差值,建立第一重复周期数和第二重复周期数的不同有效组合与所述距离差值的映射表格,所述映射表格用于在测量目标物体的真实距离时根据距离差值确定对应的第一重复周期数和第二重复周期数;
测量单元,用于根据所述第一频率和所述第二频率对目标物体进行测量;
第五确定单元,用于根据测量结果确定第一测量距离和第二测量距离;
计算单元,用于根据所述第一测量距离和所述第二测量距离计算得到实际距离差值;
第六确定单元,用于在所述映射表格中确定与所述实际距离差值对应的第一重复周期数和第二重复周期数;
第七确定单元,用于根据所述第一重复周期数和所述第二重复周期数确定所述目标物体的真实距离。
8.一种多频融合ToF测距装置,其特征在于,所述装置包括:
处理器、存储器、输入输出单元以及总线;
所述处理器与所述存储器、所述输入输出单元以及所述总线相连;
所述存储器保存有程序,所述处理器调用所述程序以执行如权利要求1至6中任一项所述方法。
9.一种计算机可读存储介质,所述计算机可读存储介质上保存有程序,所述程序在计算机上执行时执行如权利要求1至6中任一项所述方法。
CN202110894274.XA 2021-08-05 2021-08-05 一种多频融合ToF的测距方法、系统、装置及存储介质 Active CN113740870B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110894274.XA CN113740870B (zh) 2021-08-05 2021-08-05 一种多频融合ToF的测距方法、系统、装置及存储介质

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110894274.XA CN113740870B (zh) 2021-08-05 2021-08-05 一种多频融合ToF的测距方法、系统、装置及存储介质

Publications (2)

Publication Number Publication Date
CN113740870A CN113740870A (zh) 2021-12-03
CN113740870B true CN113740870B (zh) 2022-03-29

Family

ID=78730129

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110894274.XA Active CN113740870B (zh) 2021-08-05 2021-08-05 一种多频融合ToF的测距方法、系统、装置及存储介质

Country Status (1)

Country Link
CN (1) CN113740870B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114859365A (zh) * 2022-07-05 2022-08-05 武汉市聚芯微电子有限责任公司 一种深度测量方法及装置、存储介质
CN114881894B (zh) * 2022-07-07 2022-09-30 武汉市聚芯微电子有限责任公司 一种像素修复方法、装置、设备以及计算机存储介质

Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333591A (zh) * 2018-01-18 2018-07-27 中国科学院苏州纳米技术与纳米仿生研究所 一种测距方法及其系统

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP2444818B1 (en) * 2010-10-19 2013-04-03 Siemens Aktiengesellschaft A pulse-echo ranging system and method
KR102523972B1 (ko) * 2015-10-27 2023-04-20 삼성전자주식회사 광 셔터를 포함하는 3차원 깊이 센서를 이용한 거리측정방법
CN109425865B (zh) * 2017-08-22 2020-09-08 深圳市道通智能航空技术有限公司 一种无人机测距方法、装置及无人机
JP7426123B2 (ja) * 2019-12-25 2024-02-01 国立研究開発法人産業技術総合研究所 光学的測定装置及び測定方法
CN111427025B (zh) * 2020-01-14 2021-09-17 深圳市镭神智能系统有限公司 激光雷达和激光雷达的测距方法
CN112526546B (zh) * 2021-02-09 2021-08-17 深圳市汇顶科技股份有限公司 深度信息确定方法及装置

Patent Citations (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108333591A (zh) * 2018-01-18 2018-07-27 中国科学院苏州纳米技术与纳米仿生研究所 一种测距方法及其系统

Also Published As

Publication number Publication date
CN113740870A (zh) 2021-12-03

Similar Documents

Publication Publication Date Title
CN113740870B (zh) 一种多频融合ToF的测距方法、系统、装置及存储介质
US10024966B2 (en) Efficient implementation of distance de-aliasing for ranging systems using phase domain computation
US20150310622A1 (en) Depth Image Generation Utilizing Pseudoframes Each Comprising Multiple Phase Images
CN104931973A (zh) 用于激光雷达系统的非对称相位编码测距方法
EP3644271A1 (en) Method, apparatus, and storage medium for obtaining depth image
CN112526545A (zh) 一种激光雷达点云处理方法、装置、存储介质及终端设备
CN109782266B (zh) 定位方法及装置、系统、计算机装置及可读存储介质
CN110109133A (zh) 基于飞行时间的距离补偿方法和测距方法
CN109597091A (zh) Tof测距的相位解包裹的方法及tof测距系统
US20160226683A1 (en) Apparatus for estimating channel spacing, apparatus for monitoring wavelength, and receiver
CN109164440B (zh) 一种多频雷达测距的方法
CN114114197A (zh) 多普勒模糊度的计算方法、多普勒速度的计算方法及装置
CN109188389B (zh) 超视距多基被动雷达中的解时差测量模糊的方法
WO2022000147A1 (zh) 深度图像处理方法及设备
WO2022000333A1 (zh) 一种雷达探测方法及相关装置
CN115236653B (zh) 一种雷达探测方法、装置、设备及介质
WO2022160622A1 (zh) 一种距离测量方法、装置及系统
CN113115429B (zh) 一种晶振频偏确定方法、装置及通信系统
WO2022204895A1 (zh) 获取深度图的方法、装置、计算设备和可读存储介质
CN112367476B (zh) Tof相机的曝光时间确定方法、装置及终端设备
CN111736146B (zh) 一种基于速度滤波的双基地检测前跟踪方法及装置
Choi et al. Fusion of time-of-flight and stereo for disambiguation of depth measurements
CN113760539A (zh) 一种tof相机深度数据处理方法、终端以及存储介质
CN113900088A (zh) 一种针对匀加速机动目标的长时间相参积累方法及系统
WO2021077358A1 (zh) 测距方法、测距装置及计算机可读存储介质

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
GR01 Patent grant
GR01 Patent grant