测距扫描传感器的测量调整方法与流程

本发明涉及一种测距扫描传感器的测量调整方法，属于小家电制造技术领域。

背景技术：

传统的测距传感器通过旋转的动作获得环境360°的距离信息，通常该类测距传感器是以单点测量为基础，通过电机带动传感器组件旋转，配合预先设置的单位角度信息，即可获得360°范围内的离散一圈的距离信息。由于传感器的测程具有一定的范围，即：根据传感器的系统设计由最近到最远的动态范围。但是通过现有测距传感器扫描环境信息存在很大的缺陷。图1为现有测距传感器扫描存在的缺陷的示意图。如图1所示，根据数学原理可知，若传感器100设置固定的扫描角度α，则近距离两个测量点之间的距离l1较小，远距离两点之间的距离l4较大。因此，对于360°的平面环境中，相对于扫描中心较远处的扫描分辨长度将会远大于较近处的扫描分辨长度，从而导致远处环境信息很不准确，容易产生误判。

另外，图2为现有技术cn204679638u的示意图。如图2所示，该实用新型专利公开了一种可变扫描分辨率的测距传感器，通过在不同角度区域内采用不同发光频率发光，实现区域范围内变分辨率扫描，以解决路面边界区域或者特殊区域扫描点数过少的问题，从而提高边界识别的精度及准确度。但是，该技术方案的区域的划分依据当前扫描位置的角度信息来确定，对于测距传感器与扫描边界之间的位置关系不确定的情况下，无法根据测距传感器的旋转角度调整分辨率去确保不会出现局部扫描分辨率过低的情况。

因此，有必要寻求一种新的通过测距仪扫描边界的解决方案，以避免扫描分辨率分布不均。

技术实现要素：

本发明所要解决的技术问题在于针对现有技术的不足，提供一种测距扫描传感器的测量调整方法，解决了传感器在测量范围内的数据点密度不均匀，且在较远距离上的数据点较少的问题，使得后续的建图以及导航算法更加有效和可靠。

本发明所要解决的技术问题是通过如下技术方案实现的：

一种测距扫描传感器的测量调整方法，包括如下步骤：

步骤100：以扫描角度1进行距离测量，并计算相邻两次距离测量之间的实际分辨长度c；

步骤200：根据实际分辨长度c判断是否需要调整扫描角度，如果是，则将按照调整后的扫描角度进行下一次测量，否则，继续进行下一次测量；

步骤300：重复执行步骤100至步骤200，据此往复调整，直至扫描结束。

为了有效判断是否需要调整扫描角度，所述步骤100之前还包括有：步骤001：在分辨精度的范围内设定实际分辨长度的上限阈值th和下限阈值tl；则：

步骤200具体包括：将实际分辨长度c的大小与上限阈值th和下限阈值tl进行比较，如果tl≤c≤th，则保持扫描角度1作为下一次测量的扫描角度4；否则，对扫描角度进行调整，并将调整后的扫描角度作为下一次测量的扫描角度4。

进一步地，步骤100具体包括：以扫描角度1旋转扫描，得到相邻两次扫描的第一距离a和第二距离b，通过余弦公式得到前述相邻两次扫描的实际分辨长度c。

更具体地，所述步骤200中对扫描角度进行调整的过程进一步包括：

步骤210：将步骤100中相邻两次扫描的第一落点设为点a及第二落点设为点b，以与直线ab相交于点c限制待调整的下一次所述测距传感器的测量路径；

步骤220：限定点c与第二落点点b的距离为d，且d＝(tl+th)/2；

步骤230：根据已知信息计算出调整后的扫描角度的大小，并将调整后的扫描角度作为下一次测量的扫描角度4。

所述步骤230中的已知信息包括：扫描角度、相邻两次扫描的第一距离a和第二距离b及点b与点c之间的距离d。

另外，所述步骤200中对所述扫描角度进行调整的方式，具体包括：调整测量的频率，保持现有的测距仪的转速，将扫描角度转换为测量的频率来实现调整。

所述调整测量的频率来改变扫描角度具体包括：

初始状态测距仪的旋转速度为1秒m圈，测量频率为1秒n次，即：m*360(度/秒)/n(次/秒)＝m*360/n(度/次)；

将测量频率调整为1秒2n次，即：m*360(度/秒)/2n(次/秒)＝m*180/n(度/次)。

除此之外，所述步骤200中对所述扫描角度进行调整的方式，具体包括：调整测距仪的转速，保持现有发射频率，将扫描角度转换为测距仪转速来实现调整。

所述调整测距仪的转速来改变扫描角度具体包括：

初始状态测距仪的旋转速度为1秒m圈，测量频率为1秒n次，即：m*360(度/秒)/n(次/秒)＝m*360/n(度/次)；

将转速变成1秒m/2圈，即：(m/2)*360(度/秒)/n(次/秒)＝m*180/n(度/次)。

本发明还提供一种测距扫描传感器的测量调整方法，包括如下步骤：

步骤1000：预设扫描精度范围的上限阈值th和下限阈值tl；

步骤2000：设定扫描测距器的多个档位测量频率；

步骤3000：根据以初始测量频率测量获得的相邻两次的测量距离及测量角度计算出实际扫描分辨长度，判断所述实际扫描分辨长度与预设扫描精度范围的上限阈值th和下限阈值tl之间的关系；

步骤4000：根据步骤3000的比较结果调整所述测距扫描传感器的测量频率，并以调整后的测量频率进行下一次测量；

步骤5000：依此往复调整，直至扫描结束。

具体来说，步骤4000进一步包括：

4001：如果该实际扫描分辨长度小于预设扫描精度范围，则将测量频率下调一个档位；

4002：如果该实际扫描分辨长度大于预设扫描精度范围，则将测量频率上调一个档位；

4003：如果该实际扫描分辨长度在预设扫描精度范围内，则保持测量频率不变；

4004：以调整后的测量频率进行下一次测量。

综上所述，提供一种测距扫描传感器的测量调整方法，解决了传感器在测量范围内的数据点密度不均匀，且在较远距离上的数据点较少的问题，使得后续的建图以及导航算法更加有效和可靠。

下面结合附图和具体实施例，对本发明的技术方案进行详细地说明。

附图说明

图1为现有测距传感器扫描存在的缺陷的示意图；

图2为现有技术cn204679638u的示意图；

图3为本发明实施例一的工作原理示意图。

具体实施方式

实施例一

图3为本发明实施例一的工作原理示意图。如图3所示，本发明提供一种测距扫描传感器的测量调整方法。如背景技术中所述，如果测距仪为按照预设可变的扫描角度(分辨率)进行周期性测量，仍不能避免会在近距离处数据点过密，远距离处数据点过疏，而且对于处于陌生环境下的测距仪也无法制定所述可变的扫描角度调整方案，而本发明则解决了这个问题。具体来说，本发明提供一种测距扫描传感器的测量调整方法，包括如下步骤：步骤100：以扫描角度1进行距离测量，并计算相邻两次距离测量之间的实际分辨长度c；步骤200：根 据实际分辨长度c判断是否需要调整扫描角度，如果是，则将按照调整后的扫描角度进行下一次测量，否则，继续进行下一次测量；步骤300：重复执行步骤100至步骤200，据此往复调整，直至扫描结束。需要说明的是，上述步骤100中的扫描角度1可以为一预设的角度。

为了准确判断是否需要调整扫描角度，所述步骤100之前还包括有：步骤001：在分辨精度的范围内设定实际分辨长度的上限阈值th和下限阈值tl，分别为可分辨精度的最小值和最大值，来判断两次测距之间的分辨长度是否已经超出分辨精度。如图3所示：进一步地，步骤100具体包括：以扫描角度1旋转扫描，得到相邻两次扫描的第一距离a和第二距离b，通过余弦公式得到前述相邻两次扫描的实际分辨长度c。

步骤200具体包括：将实际分辨长度c的大小与上限阈值th和下限阈值tl进行比较，如果tl≤c≤th，则保持扫描角度1作为下一次测量的扫描角度4；否则，对扫描角度进行调整，并将调整后的扫描角度作为下一次测量的扫描角度4。

更具体地，所述步骤200中对扫描角度进行调整的过程进一步包括：

步骤210：将步骤100中相邻两次扫描的第一落点设为点a及第二落点设为点b，以与直线ab相交于点c限制待调整的下一次所述测距传感器的测量路径；

步骤220：限定点c与第二落点点b的距离为d，且d＝(tl+th)/2；

步骤230：根据已知信息计算出调整后的扫描角度的大小，并将调整后的扫描角度作为下一次测量的扫描角度4。

所述步骤230中的已知信息包括：扫描角度、相邻两次扫描的第一距离a和第二距离b及点b与点c之间的距离d。

具体地，对于优选的实施例中的下一次测量的扫描角度4的计算方式包括：首先，假定下一次测量的测量落点在图3所示的实际分辨长度c所在的线段的延长线上。其次，假设距离d为测量精度内的值，即tl和th中间的某个值，tl≤d≤th，例如：d＝(tl+th)/2。

由于以a，b，c为边的三角形已知，

第一辅助角度∠2也可通过余弦公式：

求得，第二辅助角度∠3＝180°-∠2，通过已知的第二辅助角度∠3以及距离d：d＝(tl+th)/2和第二边b即可求得下一次扫描的扫描角度∠4。

但是需要注意的是，本发明旨在提供一种新的反馈机制，以避免出现测距扫描传感器的实际分辨长度过大或过小的问题，而以上计算下一次测量的扫描角度的方式仅是一种较佳的实施例，而不应以此来限制本发明的实现方式。而且根据对精度要求的不同，当需要调整当前扫描角度时，计算下一次测量的扫描角度的方式还可以为其他方式，比如按比例调整：不妨沿用上面的定义，相邻两次扫描的实际分辨长度为c，当前扫面角度为∠1，要求的实际分辨长度的阈值范围为[tl,th]，所述下一侧测量的扫描角度也可以为∠4＝∠1*(tl+th)/2c。

另外，需要注意的是，事实上，在实际操作中对扫描角度的大小的调节是很难控制的，理论上可以通过如下两种方式对扫描角度的大小进行间接调节：

所述步骤200中对所述扫描角度进行调整的方式，具体包括：调整测量的频率，保持现有的测距仪的转速，将扫描角度转换为测量的频率来实现调整。

举例来说，所述调整测量的频率来改变扫描角度具体包括：

初始状态测距仪的旋转速度为1秒m圈，测量频率为1秒n次，即：m*360(度/秒)/n(次/秒)＝m*360/n(度/次)；

将测量频率调整为1秒2n次，即：m*360(度/秒)/2n(次/秒)＝m*180/n(度/次)。

也就是说，初始状态测距仪的旋转速度为1秒1圈，测量频率为1秒360次，即：360(度/秒)/360(次/秒)＝1(度/次)；

将测量频率调整为1秒720次，即：360(度/秒)/720(次/秒)＝0.5(度/次)。

除此之外，所述步骤200中对所述扫描角度进行调整的方式，具体包括：调整测距仪的转速，保持现有发射频率，将扫描角度转换为测距仪转速来实现调整。

举例来说，所述调整测距仪的转速来改变扫描角度具体包括：

初始状态测距仪的旋转速度为1秒m圈，测量频率为1秒n次，即：m*360(度/秒)/n(次/秒)＝m*360/n(度/次)；

将转速变成1秒m/2圈，即：(m/2)*360(度/秒)/n(次/秒)＝m*180/n(度/次)。

也就是说初始状态测距仪的旋转速度为1秒1圈，测量频率为1秒360次，即：360(度/秒)/360(次/秒)＝1(度/次)；

将转速变成1秒0.5圈，即：180(度/秒)/360(次/秒)＝0.5(度/次)。

上述测量频率和转速可根据实际产品需要进行调整。

实施例二

鉴于实施例一中的技术方案比较繁琐，可选地，在本实施例中可以将所述测距扫描传感器的测量调整方法简化为如下步骤：

步骤1000：预设扫描精度范围的上限阈值th和下限阈值tl；

步骤2000：设定扫描测距器的多个测量频率；

步骤3000：根据以初始测量频率测量获得的相邻两次的测量距离及测量角度计算出实际扫描分辨长度，判断所述实际扫描分辨长度与预设扫描精度范围的上限阈值th和下限阈值tl之间的关系；

步骤4000：根据步骤3000的比较结果调整所述测距扫描传感器的测量频率，并以调整后的测量频率进行下一次测量；

步骤5000：依此往复调整，直至扫描结束。

具体来说，步骤4000进一步包括：

4001：如果该实际扫描分辨长度小于预设扫描精度范围，则将测量频率下调一个档位；

4002：如果该实际扫描分辨长度大于预设扫描精度范围，则将测量频率上调一个档位；

4003：如果该实际扫描分辨长度在预设扫描精度范围内，则保持测量频率不变；

4004：以调整后的测量频率进行下一次测量。

需要说明的是，本发明提供的根据实际分辨长度反馈调节扫描角度的调整方法并不局限于图3所示的平面情况，对于断面、曲面等同样适用。

综上所述，本发明提供一种测距扫描传感器的测量调整方法，解决了传感器在测量范围内的数据点密度不均匀，且在较远距离上的数据点较少的问题，使得后续的建图以及导航算法更加有效和可靠。