一种TOF Lidar多机抗干扰工作方法
技术领域
本发明属于传感器及雷达通讯技术领域,具体涉及一种TOF Lidar多机抗干扰工作方法。
背景技术
随着自动化驾驶技术的推进,各种传感器的需求量与日俱增,***中多个传感器工作时相互干扰的情形时有发生,虽然多个图像传感器相互影响的仅仅是图像质量的降低,***仍能在一定程度上进行图像分析,但多个深度传感器相互影响时,往往会造成大量异常数据帧的产生,这将严重影响无人驾驶的安全性。针对多个深度传感器同时工作时相互干扰的现象,现行解决方案主要有如下三种:
1、通过调制频率的微调:采用调制频率的微调时,不同深度传感器装置采用不同的调制频率时往往会造成各深度传感器出现不同程度的测距误差,影响其性能,并且由于基频附近的差频量是有限的,因此仍存在同频率深度传感器相互影响的可能。
2、通过随机延时:采用随机延时,需要对不同深度传感器是否相互影响有一定判断,但目前的判断条件并不能被有效检测到,从而有时会造成多台深度传感器随机延时后仍然存在相互影响的可能。
3、通过时钟控制:采用时钟控制时,需要保证各深度传感器在同一时钟下,但对于深度传感器大规模使用的场景,这种方式是不现实的,而且受总线时钟和装置发射信号时间的影响,同一时钟下的深度传感器总量限制会有明确规定,因此很难适用于实际场景。
因此,如何有效解决多深度传感器同时使用时出现的相互干扰现象,防止因传感器干扰而造成无人驾驶安全事故的产生,是本发明需要解决的课题。
发明内容
本发明的实施例旨提供一种TOF Lidar多机抗干扰工作方法,该方法能够通过数据分析,从原理上判定深度传感器所接收的数据是否受其他深度传感器的影响,并以一定的规律避免异常测距。
本发明实施例中的TOF Lidar多机抗干扰工作方法尤其在多感光单元的深度传感器同时工作时能有效检测出深度传感器是否被影响,并采取一定措施,避免各深度传感器间的相互干扰,保证最终输出的测距信息准确可靠。
对于单像素点场景来说,TOF Lidar测距装置包括至少两个深度传感器,至少两个深度传感器的每一个均具有一个感光单元,感光单元能够接收分别对应于相位90°、180°、270°、0°的四个采样信号,其幅值分别为S1、S2、S3、S4,该四个采样信号满足关系:S1与S3之和为常数且S2与S4之和为常数。
为抗干扰的目的,本发明提供了一种TOF Lidar多机抗干扰工作方法,该方法包括调整采样时间间隔的调整步骤,当至少两个深度传感器中的一个深度传感器的四个采样信号中的至少一个受到干扰而无法满足S1与S3之和为常数或S2与S4之和为常数时,调整步骤改变下次采样的时间间隔,使得四个采样信号重新满足S1与S3之和为常数且S2与S4之和为常数。
对于多像素面阵深度传感器来说,TOF Lidar测距装置包括具有至少两个深度传感器的深度传感器面阵,深度传感器具有上下相邻的两个感光单元,以使得深度传感器面阵具有M行N列感光单元,当M为奇数时,第M行感光单元能够接收分别对应于相位0°、90°、180°、270°的四个采样信号,其幅值分别为S4、S1、S2、S3,当M为偶数时,第M行感光单元能够接收分别对应于相位180°、270°、0°、90°的四个采样信号,其幅值分别为S2、S3、S4、S1;其中四个采样信号满足关系:S1与S3之和为常数且S2与S4之和为常数。
为抗干扰的目的,本发明实施例还提供了另一种TOF Lidar多机抗干扰工作方法,当四个采样信号中的至少一个受到干扰而无法满足S1与S3之和为常数或S2与S4之和为常数时,该方法使用未被干扰的信号计算延时相位
本发明实施例所提供的TOF Lidar多机抗干扰工作方法能有效检测出深度传感器是否被影响,并采取一定措施,避免深度传感器间相互干扰,保证最终输出的测距信息准确可靠。
附图说明
图1是现有技术的TOF Lidar测距装置的工作原理图;
图2是现有技术的TOF Lidar测距装置的工作波形及接收原理图;
图3是TOF Lidar测距装置中多深度传感器的工作波形及接收原理图;
图4是TOF Lidar测距装置中两深度传感器的单像素点干扰示意图;
图5是TOF Lidar测距装置中面阵深度传感器感光芯片的光电传感器单元采样原理图;
图6是TOF Lidar测距装置中两深度传感多像素面阵深度传感器干扰示意图;
图7是TOF Lidar测距装置中三深度传感多像素面阵深度传感器干扰示意图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及具体实施例,对本发明做进一步详细说明。应当理解,此处所描述的具体实施例仅仅用于解释本发明,而不能理解为对本发明的限制。
图1示出了现有技术的TOF Lidar测距装置的工作原理,现有的TOF Lidar测距装置一般采用深度传感器,并基于TOF原理进行测距。图1中,TOF Lidar测距装置具有一深度传感器,其包括发射模块1、接收模块2、信号处理及控制模块3,接收模块2具有感光单元。
实际工作时,当TOF Lidar测距装置接到工作指令后,发射模块1持续发出具有一定波形的红外光波,当光波遇到障碍物(如图1中所示的人、树等)后被反射回来,反射光被接收模块2的感光单元接收并感应,信号处理及控制模块3将光信号处理为电信号。
根据光波从发射到被接收的时间差τ可以计算出光飞行的距离,基于该距离即可算出TOF Lidar测距装置与障碍物之间的实际距离Distance,计算公式如下:
Distance=c*τ/2
其中,c为光速,τ为时间差。
目前,计算方法一般采用四步相位法,通过相位差间接得到时间差,即在整个周期中进行四次采样,通过四次采样的积累,最终得到接收信号与发射信号的相位差,从而解算出TOF Lidar测距装置与障碍物之间的实际距离Distance。
图2是现有技术的TOF Lidar测距装置的工作波形及接收原理图。如图2所示,对经过发射模块1调制出的周期为TMOD的波形信号分别在相位90°、180°、270°、0°四个时间段内进行采样,得到四个采样信号S1、S2、S3、S4的,各采样信号S1、S2、S3、S4的幅度受波形影响,能反映出不同的幅度值。
具体地,根据公式可以计算出接收信号相对于发射信号的延时相位然后利用该延时相位可计算得到上述实际距离Distance,计算公式如下:
其中,c为光速,周期TMOD可通过调制波形的频率fMOD计算得到,即TMOD=1/fMOD。
针对静态障碍物,四步相位法基本不存在偏差,即使有,也只是一些微弱噪声的影响,不妨碍最终结果的准确性。针对动态障碍物,虽然障碍物移动会在一定程度上影响测距的准度,但障碍物运动速度相对光速而言,基本可以视为静止状态,因此该四步相位法对常见速度范围内的障碍物测距仍然适用,基本不存在较大偏差,同样不妨碍最终结果的准确性。
从发射信号到接收信号,测距过程中信号是否能保持原始状态,在一定程度上决定了测距装置的准确度。实际应用中,由于TOF Lidar测距装置中的多个深度传感器之间相互干扰或其他信号源的干扰,经常会导致接收到的信号不能保持原始状态,致使最终结果的准确度往往不能满足需求。
具体地,图3示出了TOF Lidar测距装置中多深度传感器的工作波形及接收原理图。这里,示例性地有两个深度传感器同时工作,即模组1和模组2。如图3所示,(a)当模组1和模组2同时探测障碍物距离信息时,模组1接收到的信号包括模组1的反射信号1和模组2的反射信号4,模组2接收到的信号包括模组2的反射信号3和模组1的反射信号2;(b)当模组1和模组2对射时,模组1接收到的信号包含直接从模组2发射的信号2,同理,模组2接收到的信号包含直接从模组1发射的信号1。
公知地,模组1和模组2接收到的信号都会相互影响,造成各模组的输出数据异常,最终导致获得的距离信息不准确。
为避免多深度传感器之间的相互干扰,目前可行的优化方法包括频率控制和随机延时。其中,频率控制是保证各深度传感器的工作频率相差一定比例,如一深度传感器的正常调制频率为12MHz,那么可将该深度传感器的调制频率调整为11.95MHz或12.05MHz,诸如此类。但在实际应用时,往往很难保证同一区域内的所有深度传感器均能够采用不同的调制频率,另外使用频差调制频率对度传感器的准确度也有一定程度的影响。此外,随机延时是利用深度传感器的发光时间在每次测距过程中的时间较短,对不同深度传感器采用不同的延时机制,这样做可尽可能地错开不同深度传感器的发光时间,避免信号间的相互干扰,从而减少异常测距数据的产生比例,随机延时是否能较好避开信号间相互干扰的关键点在于准确判断深度传感器何时发光,这是相当有难度的事情。
根据上述原理,四步相位法的四次采样过程均能控制在很小的时间范围内完成,因此尽可能地判断出哪些采样过程被影响,从而通过固定延时采样或随机延时采样机制可在很大程度上避免多深度传感器的发光信号之间的相互干扰。
由此,为解决现有技术中基于四步相位法的多深度传感器之间的信号干扰问题,本发明实施例提供TOF Lidar多机抗干扰工作方法,具体包括两种可行的方案:一、单像素点干扰优化方法;二、多像素面阵深度传感器干扰优化方法。
方案一中,基于上述现有技术中的TOF Lidar测距装置,从原理上讲,如图2所示,在同一个激光雷达模组的同一个感光单元中,四步相位法中各相位满足关系:1)采样信号S1和采样信号S3为一组相关相位信号;2)采样信号S2和采样信号S4为一组相关相位信号。在同一个激光雷达模组的同一个感光单元中,在考虑到不同信号强度、不同材质的障碍物、不同波形调制频率、不同温度、不同室外环境光、不同距离等因素下均可以得到变量关系:S1+S3=Constant、S2+S4=Constant。
因此,在同一个激光雷达模组中,对采样得到的四次信号S1、S2、S3、S4,可以有如下判定方式:
1)当S1与S3的上述变量关系异常而S2与S4的上述变量关系正常时,可以判定为S1受干扰严重,在采用采样延时机制时,可以考虑增加下次采样的时间间隔;
2)当S1与S3的上述变量关系正常而S2和S4的上述变量关系异常时,可以判定为S4受干扰严重,在采用采样延时机制时,可以考虑减小下次采样的时间间隔;
3)当S1与S3的上述变量关系异常且S2与S4变的上述量关系也异常时,可以判定为S1与S2受干扰严重、S3与S4受干扰严重或S1、S2、S3和S4均受干扰严重等多种情况。
第一实施方式
为优化的目的,本发明第一实施例提供了一种TOF Lidar多机抗干扰工作方法,适用于单像素场景。图4示出了TOF Lidar测距装置中两深度传感器的单像素点干扰示意图。如图4所示,示例性地有两个深度传感器同时工作,即模组1和模组2,模组1和模组2均具有一个感光单元。
其中,①当模组1进行信号采样S4时,会受到模组2的信号干扰,从而导致模组1中S2与S4的变量关系异常,而模组1中S3和S1的变量关系正常,为减少干扰,采取如此优化措施:减小下一次进行信号采样的帧间隔,即减小模组1中T1对应的时间间隔,满足关系T1<T3;②当模组2进行信号采样S1时,同样会受到模组1的信号干扰,从而导致模组1中S1和S3的变量关系异常,而模组2中S2和S4的变量关系正常,为减少干扰,采取如此优化措施:增加下一次进行信号采样的帧间隔,即增加T2对应的时间间隔,满足关系T2>T4。
需要说明的是,上述①和②并不需要同时进行,在其中的实施例中,只进行上述①或者②的操作就能够实现模组1和模组2之间不产生干扰;但可以理解的是,在可选的实施例中,通过同时进行上述①和②同样可以实现模组1和模组2之间不产生干扰。
仍需要说明的是,在上述减小下一次进行信号采样的帧间隔操作中,只是对下一次的整体信号采样S1、S2、S3、S4的时间进行提前,当进行该一次的操作后,模组1进行正常的距离探测操作,其调制频率fMOD以及邻近的两次S1之间的间隔与调整前相同,即继续以正常的T3工作,其中T3为模组1正常工作时S4与下一个S1之间的时间间隔;同样地,在上述增加下一次进行信号采样的帧间隔操作中,只是对下一次的整体信号采样S1、S2、S3、S4的时间进行延迟,当进行该一次的操作后,模组2进行正常的距离探测操作,其调制频率fMOD以及邻近的两次S1之间的间隔与调整前相同,即继续以正常的T4工作,其中T4为模组2正常工作时S4与下一个S1之间的时间间隔。并且,在正常的工作下,模组1和模组2的调制频率fMOD,以及模组1和模组2中各自的相邻的两次S1之间的时间间隔相同,即T3=T4。
这样一来,经过上述工作方法的调整,可以明显的降低串扰比例,上述抗干扰工作方法对两个模组同时工作的场景具有较好的实施效果。
明显地,上述抗干扰工作方法针对受影响的数据无法进行有效利用,仍需增加采样次数来弥补数据缺失的问题。对于静止障碍物,上述抗干扰工作方法能在一定程度上过滤掉异常测距数据,但当障碍物处于运动状态时,由于运动速度的快慢会影响采样规律性,造成采样信号S1、S2、S3、S4的数据规律并非如预期那样。因此,有必要考虑使用新的方式去选择识别并过滤干扰数据。
第二实施方式
为进一步优化的目的,本发明第二实施例提供了一种TOF Lidar多机抗干扰工作方法,适用于多像素面阵深度传感器场景,用于有效解决多像素面阵深度传感器的抗干扰问题。
针对多像素面阵深度传感器测距装置,当采用分辨率足够的深度传感器时,考虑多像素面阵深度传感器之间的相互关系,可以在一定程度上作为是否被干扰的标准,此方法基于深度传感器的感光芯片能按照给定的方式进行采样。
图5示出了TOF Lidar测距装置中面阵深度传感器感光芯片的光电传感器单元采样原理图。如图5所示,面阵深度传感器感光芯片具有整帧M行N列感光单元,将M行N列感光单元分为两类,其中,奇数行对应的采样顺序为相位0°、90°、180°、270°,则奇数行对应的采样信号编号为S4、S1、S2、S3,偶数列对应的采样顺序为相位180°、270°、0°、90°,则偶数行对应的采样信号编号为S2、S3、S4、S1。
这样做的目的是保证上下相邻的两个感光单元能够同时进行采样且采样相差180°,当上下相邻的两个感光单元接收的信号来自相同障碍物的同一部分区域时,在同一个激光雷达模组的上下行相邻的两个感光单元中,它们的采样信号S4与S2或S1与S3即满足变量关系:S4+S2=Constant1、S1+S3=Constant2。
因为无论障碍物是处于动态,还是静态,上下相邻的两个感光单元在同一障碍物的采样信号类似于单个感光单元的接收信号。因此,当上下相邻的两个感光单元同时工作时,基于此原理可以得到如下判定方法:
(1)第一种情况,当上下相邻的两个感光单元的四次采样信号S4、S1、S2、S3均比较接近时,判定为测距正常,无相互干扰,若同一个感光单元的采样信号S4与S2或S1与S3相关性不是很清晰时,说明障碍物处于运动状态,可以利用此原理,上下相邻的两个感光单元相互计算校正,得到更为准确的测距数据。
(2)第二种情况,当上下相邻的两个感光单元的四次采样信号中的采样信号S4或者S3被其他模组的光信号干扰时,此时仍然能判定出采样信号S1、S2是正常的,则仍然可以考虑采用二步相位法进行测距计算,即或通过此计算仍能得到有效距离数据,减少因为干扰造成的数据错误输出或延时。其中,在同一个激光雷达模组的上下行相邻的两个感光单元中,它们的采样信号S4与S2或S1与S3即满足变量关系:S4+S2=Constant1、S1+S3=Constant2,即例如第3行某一感光单元的采样信号S4与其相邻第4行感光单元的采样信号S2之和为常数Constant1;第3行某一感光单元的采样信号S1与其相邻第4行感光单元的采样信号S3之和为常数Constant2,Constant1和Constant2为经过数据统计的经验数值。
(3)第三种情况,当上下相邻的两个感光单元的四次采样信号中的采样信号S1与S4或者S2与S3被其他模组的光信号干扰,此时利用判定正常的采样信号S2与S3或S4与S1进行距离计算,得到有效测距数据,同上述第二种情况的计算原理。
(4)当上下两个感光单元的四次采样信号中有三个采样信号被干扰时,即S4、S1和S2,或者S1、S2和S3被干扰时,可采取和方法1中相同的策略,降低或增加当前帧与下一帧的帧间隔来降低不同模组信号相互干扰比例。
(5)当上下两个相邻的感光单元的四次采样信号S4、S1、S2和S3均有明显异常时,可以采用随机延时,错开两个模组的发光时间,降低相互干扰的时间,通过多次判断,找到合适的避免干扰的发光时间,从而得到稳定的不受干扰的测距数据的输出。
图6示出了TOF Lidar测距装置中两深度传感多像素面阵深度传感器干扰示意图。如图6所示,存在两个深度传感,即两个模组,模组1和模组2,每个模组均具有上下相邻的两个感光单元Unit 1和Unit 2。
当两个模组1和2都处于正常工作状态时,可以看到模组1的前两个采样信号被模组2干扰,其中模组1的相邻两个感光单元Unit 1和Unit 2的各自对应被干扰的采样信号分别为Unit 1:S1、S2和Unit 2:S3、S4,此时Unit 1:S1、S2和Unit 2:S3、S4很难满足关系:S1+S3=S2+S4(此条件在干扰情况下基本不存在),而对于未被模组2干扰的模组1的感光单元Unit1的采样信号S3、S4以及感光单元Unit 2的采样信号S1、S2,正常情况下可以得到关系S3+S4=S1+S2(针对未被干扰的信号,此关系基本恒定存在)。
此时,针对模组1的感光单元Unit 1,其相位计算公式可表示为 或而针对模组1的感光单元Unit 2,其相位计算公式可表示为或
另外,在可能的一种实现方式中,通过模组1的感光单元Unit1的采样信号S3、S4以及感光单元Unit 2的采样信号S1、S2,通过公式算出相位
上述式中,相比于通过两个信号采样的计算方式,通过四个信号采样计算得到的结果会相对更准确。
同理,针对模组2的上下相邻的两个感光单元Unit 1和Unit 2,其未被相邻的模组1干扰的采样信号分别为Unit 1:S1、S2和Unit 2:S3、S4,采用上述相同的计算思路,可以得到模组2的各个感光单元的相位计算公式,在此不再赘述。
进一步地,图7示出了TOF Lidar测距装置中三深度传感多像素面阵深度传感器干扰示意图。如图7所示,存在三个深度传感,即三个模组,模组1、模组2和模组3,每个模组均具有上下相邻的两个感光单元Unit 1和Unit 2。
图7中,对于模组2而言,其感光单元Unit1的采样信号S1和S4以及感光单元Unit2的采样信号S2和S3分别被不同深度传感模组干扰时,仍能利用中间两个采样信号进行计算,得到较为准确的深度数据。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。