CN114166177A - 移动平台的激光测距异常检测方法及装置 - Google Patents
移动平台的激光测距异常检测方法及装置 Download PDFInfo
- Publication number
- CN114166177A CN114166177A CN202010951312.6A CN202010951312A CN114166177A CN 114166177 A CN114166177 A CN 114166177A CN 202010951312 A CN202010951312 A CN 202010951312A CN 114166177 A CN114166177 A CN 114166177A
- Authority
- CN
- China
- Prior art keywords
- mobile platform
- value
- laser
- range finder
- laser range
- 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
- 238000001514 detection method Methods 0.000 title claims abstract description 31
- 238000005259 measurement Methods 0.000 claims abstract description 48
- 238000000034 method Methods 0.000 claims abstract description 41
- 230000002159 abnormal effect Effects 0.000 claims abstract description 26
- 230000008859 change Effects 0.000 claims abstract description 21
- 238000001914 filtration Methods 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 6
- 230000000295 complement effect Effects 0.000 claims description 6
- 238000004590 computer program Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 abstract description 5
- 230000005856 abnormality Effects 0.000 description 12
- 238000004891 communication Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 6
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 238000012937 correction Methods 0.000 description 2
- 230000007774 longterm Effects 0.000 description 2
- 239000000463 material Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000003287 optical effect Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- AYFVYJQAPQTCCC-GBXIJSLDSA-N L-threonine Chemical compound C[C@@H](O)[C@H](N)C(O)=O AYFVYJQAPQTCCC-GBXIJSLDSA-N 0.000 description 1
- 230000004075 alteration Effects 0.000 description 1
- 238000009435 building construction Methods 0.000 description 1
- 239000004568 cement Substances 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 239000013307 optical fiber Substances 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C3/00—Measuring distances in line of sight; Optical rangefinders
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
- G01B11/00—Measuring arrangements characterised by the use of optical techniques
- G01B11/02—Measuring arrangements characterised by the use of optical techniques for measuring length, width or thickness
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C1/00—Measuring angles
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Electromagnetism (AREA)
- Manufacturing & Machinery (AREA)
- Optical Radar Systems And Details Thereof (AREA)
Abstract
本申请公开了一种移动平台的激光测距异常检测方法及装置，移动平台上设有激光测距仪及惯性测量单元，其中，方法包括以下步骤：获取由IMU模块采集的移动平台的运动航向角；在根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径期间，检测运动航向角的变化值；若变化值小于或者等于第一预设阈值，则判定激光测距仪的激光测距存在异常。本申请实施例的外墙移动平台的激光测距异常检测方法，解决了相关技术中容易误判其他路径，或者移动平台的位置判断误差较大的问题，实现了激光测距的异常检测。
Description
技术领域
本申请涉及测距异常检测技术领域，特别涉及一种移动平台的激光测距异常检测方法及装置。
背景技术
外墙移动平台是基于外墙四周铺设导轨，于轨道上移动并由编码器检测实时位置的设备。外墙移动平台自带的执行器是在建筑建造过程中水泥浇筑外墙后，完成外墙墙面打磨、封堵螺杆洞等作业需求。建造作业过程中对测距精度要求较高，针对编码器的累积误差，已有技术使用激光测距仪对其修正。
但是，激光测距仪需要直视环境，若作业过程中存在突发障碍物，直接导致激光测距异常。例如，如图1所示，移动轨道有直行轨道OS1，S2S3，S4S5和弯道S1S2，S3S4组成，激光遇到障碍物实际测量的是移动平台和障碍物间距，这种异常修正编码器时会导致两种场景：(1)误判到其他轨道，如图1中，移动平台在轨道S2S3，发生激光测距异常时可能会导致，修正后的编码器判断当前在S4S5或S0S1轨道；(2)判断在当前轨道，但移动平台的位置判断误差较大；有待解决。
申请内容
本发明旨在至少在一定程度上解决相关技术中的技术问题之一。
为此，本发明的第一目的在于提出一种移动平台的激光测距异常检测方法，解决了相关技术中容易误判其他路径，或者移动平台的位置判断误差较大的问题，实现了激光测距的异常检测。
本发明的第二个目的在于提出一种移动平台的激光测距异常检测装置。
本发明的第三个目的在于提出一种电子设备。
本发明的第四个目的在于提出一种计算机可读存储介质。
为达到上述目的，本申请第一方面实施例提供一种移动平台的激光测距异常检测方法，所述移动平台上设有激光测距仪及惯性测量单元(Inertial Measurement Unit，简称IMU)，所述方法包括以下步骤：
获取由所述IMU模块采集的移动平台的运动航向角；
在根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径期间，检测所述运动航向角的变化值；以及
若所述变化值小于或者等于第一预设阈值，则判定所述激光测距仪的激光测距存在异常。
另外，根据本发明上述实施例的移动平台的激光测距异常检测方法还可以具有以下附加的技术特征：
可选地，上述的移动平台的激光测距异常检测方法，还包括：
在直行路径时，根据所述激光测距仪的测量值和时间戳构造运动模型，以通过所述运动模型预测下一时刻的预测值；
若所述预测值与下一时刻的测量值间的差值大于第二预设阈值时，判定所述激光测距异常。
可选地，通过下述公式构造所述运动模型：
dlidar＝di+(ti+j-ti)×vi；
其中，di为ti时刻对应的激光测距仪的测量值，di-k为ti-k时刻对应的激光测距仪的测量值，i为正整数，vi为所述运动模型运动速度，dlidar为所述激光测距仪ti+j时刻的预测值。
可选地，所述根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径包括：使用所述测量值校正所述移动平台上的编码器，基于所述编码器所测量得到的编码值判断所述移动平台是否从一直行路径驶入另一直行路径。
可选地，在获取由所述IMU模块采集的移动平台的运动航向角之前，还包括：
对所述IMU模块的加速度与陀螺仪进行零漂校准，以通过校准后的加速度计和陀螺仪采用二阶互补滤波计算所述运动航向角。
可选地，所述第一预设阈值λ＝π/2-ω，其中，ω表示转角因子，范围在[0，π/36]内。
为达到上述目的，本申请第二方面实施例提供一种移动平台的激光测距异常检测装置，所述移动平台上设有激光测距仪及惯性测量单元，其中，所述装置包括：
获取模块，用于获取由所述IMU模块采集的移动平台的运动航向角；
检测模块，用于在根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径期间，检测所述运动航向角的变化值；以及
第一判定模块，用于在所述变化值小于或者等于第一预设阈值时，判定所述激光测距仪的激光测距存在异常。
可选地，上述的移动平台的激光测距异常检测装置，还包括：
预测模块，用于在直行路径时，根据所述激光测距仪的测量值和时间戳构造运动模型，以通过所述运动模型预测下一时刻的预测值；
第二判定模块，用于在所述预测值与下一时刻测量值间的差值大于第二预设阈值时，判定所述激光测距异常。
可选地，通过下述公式构造所述运动模型：
dlidar＝di+(ti+j-ti)×vi；
其中，di为ti时刻对应的激光测距仪的测量值，di-k为ti-k时刻对应的激光测距仪的测量值，i为正整数，vi为所述运动模型运动速度，dlidar为所述激光测距仪下一时刻的预测值。
可选地，所述根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径包括：使用所述测量值校正所述移动平台上的编码器，基于所述编码器所测量得到的编码值判断所述移动平台是否从一直行路径驶入另一直行路径。
可选地，在获取由所述IMU模块采集的移动平台的运动航向角之前，所述采集模块，还包括：
计算单元，用于对所述IMU模块的加速度与陀螺仪进行零漂校准，以通过校准后的加速度计和陀螺仪采用二阶互补滤波计算所述运动航向角。
可选地，所述第一预设阈值λ＝π/2-ω，其中，ω表示转角因子，范围在[0，π/36]内。
为达到上述目的，本申请第三方面实施例提供一种电子设备，包括：至少一个处理器；以及，与所述至少一个处理器通信连接的存储器；其中，所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被设置为用于执行如上述实施例所述的移动平台的激光测距异常检测方法。
为达到上述目的，本申请第四方面实施例提供一种计算机可读存储介质，所述计算机可读存储介质存储计算机指令，所述计算机指令用于使所述计算机执行如上述实施例所述的移动平台的激光测距异常检测方法。
由此，可以采集移动平台的运动航向角，并根据激光测距仪的测量值判定移动平台改变直行路径，即转弯时，检测运动航向角的变化值，如果变化值小于或者等于第一预设阈值，说明惯性测量单元没有检测到平台转弯，则确定激光测距异常。由此，解决了相关技术中容易误判其他路径，或者移动平台的位置判断误差较大的问题，实现了激光测距的异常检测。本申请附加的方面和优点将在下面的描述中部分给出，部分将从下面的描述中变得明显，或通过本申请的实践了解到。
附图说明
本申请上述的和/或附加的方面和优点从下面结合附图对实施例的描述中将变得明显和容易理解，其中：
图1为编码器和激光测距仪测量示意图；
图2为根据本申请实施例的移动平台的激光测距异常检测方法的流程图；
图3为根据本申请实施例提供的激光测量运动模型的示意图；
图4为根据本申请一个实施例的移动平台的激光测距异常检测方法的流程图；
图5为根据本申请实施例提供的移动平台的激光测距异常检测装置的方框示意图；
图6为本申请实施例提供的电子设备的结构示意图
具体实施方式
下面详细描述本申请的实施例，实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，旨在用于解释本申请，而不能理解为对本申请的限制。
下面参照附图描述根据本发明实施例提出的移动平台的激光测距异常检测方法及装置，首先将参照附图描述根据本发明实施例提出的移动平台的激光测距异常检测方法。
具体而言，图2为本申请实施例所提供的一种移动平台的激光测距异常检测方法的流程示意图，该实施例中，移动平台上设有激光测距仪及惯性测量单元，其中，IMU模块包括加速度计和陀螺仪，加速度计的长期精度高，而陀螺仪的短期精度高。
如图2所示，该移动平台的激光测距异常检测方法包括以下步骤：
在步骤S201中，获取由IMU模块采集的移动平台的运动航向角。
可以理解的是，移动平台可以在预先铺设的固定轨道上移动，本实施例中所涉及的直行路径与弯道均属于固定轨道。激光测距仪可校正编码器的累积误差，激光测距仪与固定标靶间存在障碍物时，会导致移动平台定位异常，影响对执行器的相关控制作业。
因此，本申请实施例可以在移动平台上增加IMU模块，从而计算移动平台的运动航向角。
可选地，在一些实施例中，在获取由IMU模块采集的移动平台的运动航向角之前，还包括：对IMU模块的加速度与陀螺仪进行零漂校准，以通过校准后的加速度计和陀螺仪采用二阶互补滤波计算运动航向角。
可以理解的是，IMU模块和激光测距仪可以安装在同一位置，选定直行路径的固定点为移动平台工作原点并初始化此时的航向角是0°。由于校准后的编码器的实时值可判断当前位置处于直行路径或弯道，直行路径期间实时检测航向角的变化。在使用IMU模块计算移动平台的运动航向角前，需要对加速度与陀螺仪进行零漂校准，加速度计的校准方可以采用九字椭球校正法，陀螺仪采用静态点校准，已校准后的加速度计和陀螺仪采用二阶互补滤波，或者卡尔曼滤波计算航向角。
需要说明的是，上述方式仅为示例性的，不作为对本申请的限制，本领域技术人员可以根据实际情况进行调整。
在步骤S202中，在根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径期间，检测运动航向角的变化值。
可选地，根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径包括：使用测量值校正移动平台上的编码器，基于编码器所测量得到的编码值判断移动平台是否从一直行路径驶入另一直行路径。
也就是说，本申请实施例可以根据校准后的编码器的实时值进行区别当前位置处于直行路径还是弯道。
在步骤S203中，若变化值小于或者等于第一预设阈值，则判定激光测距仪的激光测距存在异常。
可选地，第一预设阈值λ＝π/2-ω，其中，ω表示转角因子，范围在[0，π/36]内。在固定轨道中，相邻两个直行路径基本上是相互垂直的，即两者间夹角为π/2，若移动平台成功从一直行路径驶入另一直行路径，那么其转过的角度基本也为π/2。基于此，将第一预设阈值λ设为π/2-ω，即第一预设阈值略小于π/2，若检测到的航向角变化小于这个阈值，则移动平台实际上并没有完成路径变换，说明根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径的结果是错误的，表示激光测距仪的激光测距存在异常。
可以理解的是，本申请实施例可以在判定移动平台行驶于直行路径期间时，检测运动航向角的变化值。
具体地，假设移动平台刚入直行路径Li时的航向角为θ1，实时运动航向角为θ，实时检测移动平台移动过程中所在路径Lj，运动航向角的变化值为δ_θ，则运动航向角的变化值可以通过下述公式计算：
δ_θ＝abs(θ-θ1)j≠i；
其中，abs表示取绝对值；若j≠i，且Lj是其他直行路径时，表示当前根据激光校正的编码器检测移动平台路径变化，激光异常标志用flag_lidar表示，比较δ_θ与直角π/2的大小：
其中，ω为转角因子，范围在[0，π/36]内，第一预设阈值可以为π/2-ω；flag_lidar等于1表示激光测量异常，0表示此时路径状态判断正确。
可选地，在一些实施例中，上述的移动平台的激光测距异常检测方法，还包括：在直行路径时，根据激光测距仪的测量值和时间戳构造运动模型，以通过运动模型预测下一时刻的预测值；若预测值与下一时刻的测量值间的差值大于第二预设阈值时，判定激光测距异常。
可选地，通过下述公式构造运动模型：
dlidar＝di+(ti+j-ti)×vi；
其中，di为ti时刻对应的激光测距仪的测量值，di-k为ti-k时刻对应的激光测距仪的测量值，i为正整数，vi为运动模型运动速度，dlidar为激光测距仪ti+j时刻的预测值。
可以理解的是，本申请实施例可以根据直行路径上激光测距仪的实时测量值、时间戳构造运动模型，并根据运动模型对下一时刻的测距值进行预测，得到预测值。由于移动平台都是匀速移动，且速度较小(低于15cm/s)，激光测量按照匀速模型拟合，如图3所示，已知ti-k时刻激光测量值di-k；ti时刻激光测量值di；拟合匀速运动模型的运动速度vi：
预测ti+j时刻的激光测量值dlidar：
dlidar＝di+(ti+j-ti)×vi；
进一步地，运动模型的预测值与当前激光测距仪的测量值存在较大差异时，则当前路径存在障碍物干扰激光测距，上报该场景激光测距异常。
也就是说，本申请实施例可以比较预测值dlidar和测量值di+j的差异。
δ_d＝abs(dlidar-di+j)；
直行路径内激光异常标志flag_lidar：
其中，thre_d为允许激光测量误差阈值。
也就是说，当测量值超过预测值一定范围时，则检测激光测量异常，并上报测量异常状态至后台。
为使得本领域技术人员进一步了解本申请实施例的移动平台的激光测距异常检测方法，下面以一个具体实施例进行详细阐述。
如图4所示，上述的移动平台的激光测距异常检测方法，包括以下步骤：
S401，计算运动航向角。
S402，判断移动平台和IMU模块是否转到同一弯道，如果是，执行步骤S403，否则，执行步骤S406。
S403，根据激光测距仪的测量值和时间戳构造运动模型。
S404，比较预测值和激光测量值的差值是否大于第二预设阈值，如果是，执行步骤S409，否则执行步骤S405。
S405，符合运动模型。
S406，检测运动航向角的变化。
S407，判断移动平台是否转到下一路径，如果是，执行步骤S408，否则执行步骤S409。
S408，转到下一直行路径。
S409，确定激光测距异常。
S410，上报后台异常。
S411，结束。
由此，通过在移动平台上增加IMU模块，通过比较直行路径上激光的变化和同时间段内的航向角变化检测误判到其他路径的场景；同时根据运动模型检测同路径内的激光异常测距场景。
根据本申请实施例提出的移动平台的激光测距异常检测方法，可以采集移动平台的运动航向角，并根据激光测距仪的测量值判定移动平台改变直行路径，即转弯时，检测运动航向角的变化值，如果变化值小于或者等于第一预设阈值，说明惯性测量单元没有检测到平台转弯，则确定激光测距异常。由此，解决了相关技术中容易误判其他路径，或者移动平台的位置判断误差较大的问题，实现了激光测距的异常检测。
其次参照附图描述根据本申请实施例提出的移动平台的激光测距异常检测装置。
图5是本申请实施例的移动平台的激光测距异常检测装置的方框示意图，该实施例中，移动平台上设有激光测距仪及惯性测量单元，其中，IMU模块包括加速度计和陀螺仪，加速度计的长期精度高，而陀螺仪的短期精度高。
如图5所示，该移动平台的激光测距异常检测装置10包括：获取模块100、检测模块200和判断模块300。
其中，获取模块100用于获取由IMU模块采集的移动平台的运动航向角；
检测模块200用于在根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径期间，检测运动航向角的变化值；以及
第一判定模块300用于在变化值小于或者等于第一预设阈值时，判定激光测距仪的激光测距存在异常。
可选地，在一些实施例中，上述的移动平台的激光测距异常检测装置，还包括：
预测模块，用于在直行路径时，根据激光测距仪的测量值和时间戳构造运动模型，以通过运动模型预测下一时刻的预测值；
第二判定模块，用于若预测值与下一时刻测量值间的差值大于第二预设阈值时，判定激光测距异常。
可选地，通过下述公式构造运动模型：
dlidar＝di+(ti+j-ti)×vi；
其中，di为ti时刻对应的激光测距仪的测量值，di-k为ti-k时刻对应的激光测距仪的测量值，i为正整数，vi为运动模型运动速度，dlidar为激光测距仪下一时刻的预测值。
可选地，根据激光测距仪的测量值判定移动平台从一直行路径驶入另一直行路径包括：使用测量值校正移动平台上的编码器，基于编码器所测量得到的编码值判断移动平台是否从一直行路径驶入另一直行路径。
可选地，在一些实施例中，在获取由IMU模块采集的移动平台的运动航向角之前，获取模块100还包括：
计算单元，用于对IMU模块的加速度与陀螺仪进行零漂校准，以通过校准后的加速度计和陀螺仪采用二阶互补滤波计算运动航向角。
可选地，第一预设阈值λ＝π/2-ω，其中，ω表示转角因子，范围在[0，π/36]内。
需要说明的是，前述对移动平台的激光测距异常检测方法实施例的解释说明也适用于该实施例的移动平台的激光测距异常检测装置，此处不再赘述。
根据本申请实施例提出的移动平台的激光测距异常检测装置，可以采集移动平台的运动航向角，并根据激光测距仪的测量值判定移动平台改变直行路径，即转弯时，检测运动航向角的变化值，如果变化值小于或者等于第一预设阈值，说明惯性测量单元没有检测到平台转弯，则确定激光测距异常。由此，解决了相关技术中容易误判其他路径，或者移动平台的位置判断误差较大的问题，实现了激光测距的异常检测。
图6为本申请实施例提供的电子设备的结构示意图。该电子设备可以包括：
存储器1201、处理器1202及存储在存储器1201上并可在处理器1202上运行的计算机程序。
处理器1202执行程序时实现上述实施例中提供的移动平台的激光测距异常检测方法。
进一步地，电子设备还包括：
通信接口1203，用于存储器1201和处理器1202之间的通信。
存储器1201，用于存放可在处理器1202上运行的计算机程序。
存储器1201可能包含高速RAM存储器，也可能还包括非易失性存储器(non-volatile memory)，例如至少一个磁盘存储器。
如果存储器1201、处理器1202和通信接口1203独立实现，则通信接口1203、存储器1201和处理器1202可以通过总线相互连接并完成相互间的通信。总线可以是工业标准体系结构(Industry Standard Architecture，简称为ISA)总线、外部设备互连(PeripheralComponent，简称为PCI)总线或扩展工业标准体系结构(Extended Industry StandardArchitecture，简称为EISA)总线等。总线可以分为地址总线、数据总线、控制总线等。为便于表示，图6中仅用一条粗线表示，但并不表示仅有一根总线或一种类型的总线。
可选的，在具体实现上，如果存储器1201、处理器1202及通信接口1203，集成在一块芯片上实现，则存储器1201、处理器1202及通信接口1203可以通过内部接口完成相互间的通信。
处理器1202可能是一个中央处理器(Central Processing Unit，简称为CPU)，或者是特定集成电路(Application Specific Integrated Circuit，简称为ASIC)，或者是被配置成实施本申请实施例的一个或多个集成电路。
本实施例还提供一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行时实现如上的移动平台的激光测距异常检测方法。
在本说明书的描述中，参考术语“一个实施例”、“一些实施例”、“示例”、“具体示例”、或“一些示例”等的描述意指结合该实施例或示例描述的具体特征、结构、材料或者特点包含于本申请的至少一个实施例或示例中。在本说明书中，对上述术语的示意性表述不必须针对的是相同的实施例或示例。而且，描述的具体特征、结构、材料或者特点可以在任一个或N个实施例或示例中以合适的方式结合。此外，在不相互矛盾的情况下，本领域的技术人员可以将本说明书中描述的不同实施例或示例以及不同实施例或示例的特征进行结合和组合。
此外，术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本申请的描述中，“N个”的含义是至少两个，例如两个，三个等，除非另有明确具体的限定。
流程图中或在此以其他方式描述的任何过程或方法描述可以被理解为，表示包括一个或更N个用于实现定制逻辑功能或过程的步骤的可执行指令的代码的模块、片段或部分，并且本申请的优选实施方式的范围包括另外的实现，其中可以不按所示出或讨论的顺序，包括根据所涉及的功能按基本同时的方式或按相反的顺序，来执行功能，这应被本申请的实施例所属技术领域的技术人员所理解。
在流程图中表示或在此以其他方式描述的逻辑和/或步骤，例如，可以被认为是用于实现逻辑功能的可执行指令的定序列表，可以具体实现在任何计算机可读介质中，以供指令执行***、装置或设备(如基于计算机的***、包括处理器的***或其他可以从指令执行***、装置或设备取指令并执行指令的***)使用，或结合这些指令执行***、装置或设备而使用。就本说明书而言，"计算机可读介质"可以是任何可以包含、存储、通信、传播或传输程序以供指令执行***、装置或设备或结合这些指令执行***、装置或设备而使用的装置。计算机可读介质的更具体的示例(非穷尽性列表)包括以下：具有一个或N个布线的电连接部(电子装置)，便携式计算机盘盒(磁装置)，随机存取存储器(RAM)，只读存储器(ROM)，可擦除可编辑只读存储器(EPROM或闪速存储器)，光纤装置，以及便携式光盘只读存储器(CDROM)。另外，计算机可读介质甚至可以是可在其上打印所述程序的纸或其他合适的介质，因为可以例如通过对纸或其他介质进行光学扫描，接着进行编辑、解译或必要时以其他合适方式进行处理来以电子方式获得所述程序，然后将其存储在计算机存储器中。
应当理解，本申请的各部分可以用硬件、软件、固件或它们的组合来实现。在上述实施方式中，N个步骤或方法可以用存储在存储器中且由合适的指令执行***执行的软件或固件来实现。如，如果用硬件来实现和在另一实施方式中一样，可用本领域公知的下列技术中的任一项或他们的组合来实现：具有用于对数据信号实现逻辑功能的逻辑门电路的离散逻辑电路，具有合适的组合逻辑门电路的专用集成电路，可编程门阵列(PGA)，现场可编程门阵列(FPGA)等。
本技术领域的普通技术人员可以理解实现上述实施例方法携带的全部或部分步骤是可以通过程序来指令相关的硬件完成，所述的程序可以存储于一种计算机可读存储介质中，该程序在执行时，包括方法实施例的步骤之一或其组合。
此外，在本申请各个实施例中的各功能单元可以集成在一个处理模块中，也可以是各个单元单独物理存在，也可以两个或两个以上单元集成在一个模块中。上述集成的模块既可以采用硬件的形式实现，也可以采用软件功能模块的形式实现。所述集成的模块如果以软件功能模块的形式实现并作为独立的产品销售或使用时，也可以存储在一个计算机可读取存储介质中。
上述提到的存储介质可以是只读存储器，磁盘或光盘等。尽管上面已经示出和描述了本申请的实施例，可以理解的是，上述实施例是示例性的，不能理解为对本申请的限制，本领域的普通技术人员在本申请的范围内可以对上述实施例进行变化、修改、替换和变型。
Claims (10)
1.一种移动平台的激光测距异常检测方法，其特征在于，所述移动平台上设有激光测距仪及惯性测量单元，所述方法包括以下步骤：
获取由所述惯性测量单元采集的移动平台的运动航向角；
在根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径期间，检测所述运动航向角的变化值；以及
若所述变化值小于或者等于第一预设阈值，则判定所述激光测距仪的激光测距存在异常。
2.根据权利要求1所述的方法，其特征在于，还包括：
在直行路径时，根据所述激光测距仪的测量值和时间戳构造运动模型，以通过所述运动模型预测下一时刻的预测值；
若所述预测值与下一时刻的测量值间的差值大于第二预设阈值时，判定所述激光测距异常。
3.根据权利要求2所述的方法，其特征在于，通过下述公式构造所述运动模型：
dlidar＝di+(ti+j-ti)×vi；
其中，di为ti时刻对应的激光测距仪的测量值，di-k为ti-k时刻对应的激光测距仪的测量值，i为正整数，vi为所述运动模型运动速度，dlidar为所述激光测距仪ti+j时刻的预测值。
4.根据权利要求1所述的方法，其特征在于，所述根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径包括：使用所述测量值校正所述移动平台上的编码器，基于所述编码器所测量得到的编码值判断所述移动平台是否从一直行路径驶入另一直行路径。
5.根据权利要求1所述的方法，其特征在于，在获取由所述惯性测量单元采集的移动平台的运动航向角之前，还包括：
对所述惯性测量单元的加速度与陀螺仪进行零漂校准，以通过校准后的加速度计和陀螺仪采用二阶互补滤波计算所述运动航向角。
6.根据权利要求1所述的方法，其特征在于，所述第一预设阈值λ＝π/2-ω，其中，ω表示转角因子，范围在[0，π/36]内。
7.一种移动平台的激光测距异常检测装置，其特征在于，所述移动平台上设有激光测距仪及惯性测量单元，其中，所述装置包括：
获取模块，用于获取由所述惯性测量单元采集的移动平台的运动航向角；
检测模块，用于在根据所述激光测距仪的测量值判定所述移动平台从一直行路径驶入另一直行路径期间，检测所述运动航向角的变化值；以及
第一判定模块，用于在所述变化值小于或者等于第一预设阈值时，判定所述激光测距仪的激光测距存在异常。
8.根据权利要求7所述的装置，其特征在于，还包括：
预测模块，用于在直行路径时，根据所述激光测距仪的测量值和时间戳构造运动模型，以通过所述运动模型预测下一时刻的预测值；
第二判定模块，用于在所述预测值与下一时刻测量值间的差值大于第二预设阈值时，判定所述激光测距异常。
9.一种电子设备，其特征在于，包括：存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序，所述处理器执行所述程序，以实现如权利要求1-6任一项所述的移动平台的激光测距异常检测方法。
10.一种计算机可读存储介质，其上存储有计算机程序，其特征在于，该程序被处理器执行，以用于实现如权利要求1-6任一项所述的移动平台的激光测距异常检测方法。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010951312.6A CN114166177A (zh) | 2020-09-11 | 2020-09-11 | 移动平台的激光测距异常检测方法及装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010951312.6A CN114166177A (zh) | 2020-09-11 | 2020-09-11 | 移动平台的激光测距异常检测方法及装置 |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN114166177A true CN114166177A (zh) | 2022-03-11 |
Family
ID=80476105
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010951312.6A Pending CN114166177A (zh) | 2020-09-11 | 2020-09-11 | 移动平台的激光测距异常检测方法及装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114166177A (zh) |
Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09113261A (ja) * | 1995-10-23 | 1997-05-02 | Toyota Motor Corp | 操舵角センサの異常検出装置 |
| JP2012042285A (ja) * | 2010-08-17 | 2012-03-01 | Ono Sokki Co Ltd | ヨー角初期化異常判定装置及び方法 |
| CN103186140A (zh) * | 2011-12-29 | 2013-07-03 | 财团法人工业技术研究院 | 移动平台的导航方法与*** |
| CN105890595A (zh) * | 2015-01-08 | 2016-08-24 | 北京中坤天朗信息技术有限公司 | 基于信息滤波的车载组合导航*** |
| CN108020813A (zh) * | 2016-11-04 | 2018-05-11 | 富士通株式会社 | 定位方法、定位装置和电子设备 |
| US20190120631A1 (en) * | 2017-10-23 | 2019-04-25 | Hyundai Motor Company | Apparatus of compensating for a sensing value of a gyroscope sensor, a system having the same, and a method thereof |
| CN110146866A (zh) * | 2019-04-11 | 2019-08-20 | 南京信息职业技术学院 | 一种麦克纳姆轮全向平台精确定位方法 |
| US20200128123A1 (en) * | 2018-10-22 | 2020-04-23 | Motorola Mobility Llc | Determining orientation of a mobile device |
-
2020
- 2020-09-11 CN CN202010951312.6A patent/CN114166177A/zh active Pending
Patent Citations (8)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH09113261A (ja) * | 1995-10-23 | 1997-05-02 | Toyota Motor Corp | 操舵角センサの異常検出装置 |
| JP2012042285A (ja) * | 2010-08-17 | 2012-03-01 | Ono Sokki Co Ltd | ヨー角初期化異常判定装置及び方法 |
| CN103186140A (zh) * | 2011-12-29 | 2013-07-03 | 财团法人工业技术研究院 | 移动平台的导航方法与*** |
| CN105890595A (zh) * | 2015-01-08 | 2016-08-24 | 北京中坤天朗信息技术有限公司 | 基于信息滤波的车载组合导航*** |
| CN108020813A (zh) * | 2016-11-04 | 2018-05-11 | 富士通株式会社 | 定位方法、定位装置和电子设备 |
| US20190120631A1 (en) * | 2017-10-23 | 2019-04-25 | Hyundai Motor Company | Apparatus of compensating for a sensing value of a gyroscope sensor, a system having the same, and a method thereof |
| US20200128123A1 (en) * | 2018-10-22 | 2020-04-23 | Motorola Mobility Llc | Determining orientation of a mobile device |
| CN110146866A (zh) * | 2019-04-11 | 2019-08-20 | 南京信息职业技术学院 | 一种麦克纳姆轮全向平台精确定位方法 |
Non-Patent Citations (1)
| Title |
|---|
| 刘育浩: "适于惯性制导炸弹的捷联惯导关键技术研究", <<中国博士论文电子期刊网工程科技Ⅱ辑>>, no. 2011, pages 031 - 33 * |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| KR100772915B1 (ko) | 이동 로봇에 장착된 자이로의 바이어스를 보정하는 장치 및방법 | |
| CN109649490B (zh) | 汽车方向盘零偏的自动标定方法、***及车辆 | |
| US8209055B2 (en) | System for sensing state and position of robot | |
| US20130085666A1 (en) | Method, Apparatus and System with Error Correction for an Inertial Navigation System | |
| KR101417456B1 (ko) | 차량 요레이트센서의 바이어스 획득방법 | |
| KR20180002853A (ko) | 자재 취급 차량 오도메트리 교정을 위한 시스템들 및 방법들 | |
| US11486988B2 (en) | Method for calibrating the alignment of a moving object sensor | |
| WO2009155269A2 (en) | Inclinometer measurement system and method providing correction for movement induced acceleration errors | |
| JP6776202B2 (ja) | 車載カメラのキャリブレーション装置及び方法 | |
| JP7113134B2 (ja) | 車両制御装置 | |
| KR101115012B1 (ko) | 로봇의 각속도 오차 보정 장치 및 방법 | |
| CN111845740A (zh) | 动态偏航角速率偏差估计的方法和装置 | |
| US11577736B2 (en) | Method and device for ascertaining a highly accurate estimated value of a yaw rate for controlling a vehicle | |
| CN110850882A (zh) | 一种扫地机器人的充电桩定位方法及装置 | |
| JP2024511128A (ja) | ヨーレートオフセット値を確認するための方法、システム、およびコンピュータプログラム製品 | |
| CN112147995A (zh) | 机器人的运动控制方法及装置、机器人、存储介质 | |
| CN114166177A (zh) | 移动平台的激光测距异常检测方法及装置 | |
| CN103542864B (zh) | 一种惯性导航中计步的方法及装置 | |
| KR101802650B1 (ko) | 배관의 위치 추정 시스템 및 그 방법 | |
| CN113050104B (zh) | 基于位置预估的车辆位置测量方法、终端设备及存储介质 | |
| CN115900796A (zh) | 定位诊断方法、装置、设备及存储介质 | |
| KR20180101690A (ko) | 열차 이동정보 측정 장치 및 방법 | |
| CN114001729A (zh) | 定位方法、装置及电子设备 | |
| US20220055655A1 (en) | Positioning autonomous vehicles | |
| CN112557072A (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 | ||
| AD01 | Patent right deemed abandoned | ||
| AD01 | Patent right deemed abandoned |
Effective date of abandoning: 20240322 |