CN111256709B - 基于编码器和陀螺仪的车辆航位推算定位方法及装置 - Google Patents
基于编码器和陀螺仪的车辆航位推算定位方法及装置 Download PDFInfo
- Publication number
- CN111256709B CN111256709B CN202010100193.3A CN202010100193A CN111256709B CN 111256709 B CN111256709 B CN 111256709B CN 202010100193 A CN202010100193 A CN 202010100193A CN 111256709 B CN111256709 B CN 111256709B
- Authority
- CN
- China
- Prior art keywords
- coordinate
- course angle
- gyroscope
- virtual
- encoder
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000005070 sampling Methods 0.000 claims abstract description 43
- 230000002159 abnormal effect Effects 0.000 claims description 49
- 238000001514 detection method Methods 0.000 claims 1
- 230000009286 beneficial effect Effects 0.000 description 6
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000005540 biological transmission Effects 0.000 description 2
- 238000007405 data analysis Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 238000009825 accumulation Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 238000002372 labelling Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
- G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
本发明提供了基于编码器和陀螺仪的车辆航位推算定位方法及装置，其中，方法包括：根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；基于编码器获取目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取目标车辆在预设采样周期内的陀螺仪数据；判断获取的距离数据是否为零，若是，判定在预设采样周期获取的第二坐标和第二航向角为上一周期的第一坐标和第一航向角；否则，基于预先存储的预设算法，对第一坐标和第一航向角进行补偿处理，来更新上一周期的第一坐标和第一航向角。用以通过编码器和陀螺仪对车辆航位进行定位推算和补偿处理，其可有效的降低定位误差。
Description
技术领域
本发明涉及车辆导航技术领域，特别涉及基于编码器和陀螺仪的车辆航位推算定位方法及装置。
背景技术
随着车辆导航的广泛应用，在陆地车辆导航方面，GPS定位技术具有全天候、高精度、全球性以及三维定位等技术优点，但是在有遮挡的地方不能实现连续准确的定位。虽然后来采用了基于陀螺仪和加速度计的车辆航位推算定位算法，来解决上述提出的问题，但是在基于陀螺仪测量的航向角变化量和加速度计测量的加速度做两次积分得到位移时，其加速度计和陀螺仪的零偏问题导致定位误差随着行驶距离和行驶时间的积累而增大，因此，基于编码器和陀螺仪的车辆航位推算定位算法，就应运而生。
发明内容
本发明提供基于编码器和陀螺仪的车辆航位推算定位方法，用以通过编码器和陀螺仪对车辆航位进行定位推算和补偿处理，其可有效的降低定位误差。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，包括：
根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
判断获取的所述距离数据是否为零，若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角。
在一种可能实现的方式中，基于预先设定的推算定位算法，更新所述上一周期的第一坐标和第一航向角的步骤包括：
当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
在一种可能实现的方式中，还包括：
所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
在一种可能实现的方式中，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角的步骤还包括：
根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
在一种可能实现的方式中，还包括：对所述输入输出接口进行检测，其检测步骤包括：
对所述输入输出接口进行扫描，并获取所述输入输出接口的虚拟接口结构；
基于预先训练好的接口训练模型，对所述虚拟接口结构进行深度训练，判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出所述输入输出接口正常信息。
本发明实施例提供基于编码器和陀螺仪的车辆航位推算定位方法对应的装置，包括：
第一获取模块，用于根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
第二获取模块，用于基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
中央处理器，用于判断所述第二获取模块获取的所述距离数据是否为零；
若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角。
在一种可能实现的方式中，
所述中央处理器，还用于当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
所述中央处理器，还用于当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
在一种可能实现的方式中，还包括：采样板；
所述采用板，用于采集所述编码器获取的距离数据，并将所述距离数据传输到中央处理器；
其中，所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
在一种可能实现的方式中，
所述中央处理器，还用于根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
所述中央处理器，还用于根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
在一种可能实现的方式中，还包括：
扫描模块，用于对所述输入输出接口进行扫描，并获取所述输入输出接口的虚拟接口结构；
训练模块，用于基于预先训练好的接口训练模型，对所述扫描模块获取的所述虚拟接口结构进行深度训练；
所述中央处理器，用于判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出所述输入输出接口正常信息。
本发明的其它特征和优点将在随后的说明书中阐述，并且，部分地从说明书中变得显而易见，或者通过实施本发明而了解。本发明的目的和其他优点可通过在所写的说明书、以及附图中所特别指出的结构来实现和获得。
下面通过附图和实施例，对本发明的技术方案做进一步的详细描述。
附图说明
附图用来提供对本发明的进一步理解，并且构成说明书的一部分，与本发明的实施例一起用于解释本发明，并不构成对本发明的限制。在附图中：
图1为本发明实施例中基于编码器和陀螺仪的车辆航位推算定位方法的总流程图；
图2为本发明实施例中车辆航位推算定位方法的具体流程图；
图3为本发明实施例中车辆航位推算定位方法的构造图；
图4为本发明实施例中基于编码器和陀螺仪的车辆航位推算定位方法的结构图。
具体实施方式
以下结合附图对本发明的优选实施例进行说明，应当理解，此处所描述的优选实施例仅用于说明和解释本发明，并不用于限定本发明。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，如图1所示，包括：
步骤1：根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
步骤2：基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
步骤31：判断获取的所述距离数据是否为零，若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
步骤32：否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角。
上述航位推算算法，是预先设置好的，且获取的第一坐标和第一航向角是未进行补偿处理之前获取的；
上述对第一坐标和第一航向角进行补偿处理，是为了对第一坐标和第一航向角进行修正处理，降低其的误差，提高其的定位准确性；
上述预设采样周期，可以是指在上一周期结束之后，紧接着上一周期开始判断的；
上述距离数据，实际上是路程大小，上述航向角，实际上是弯曲角度。
上述预设算法是包括补偿处理和航位推算算法在内的。
上述技术方案的有益效果是：通过编码器和陀螺仪对车辆航位进行定位推算和补偿处理，其可有效的降低定位误差。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角的步骤包括：
当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
对于上述的实施例具体参见图2。
上述第一时间戳和第二时间戳，看可以是在同一时刻获取不同数据，且当数据获取成功之后，其分别在第一时间戳和第二时间戳上的显示时间，其两者之间的差异。
上述预先设定的时间差，实际上是在同一时刻获取距离数据和陀螺仪数据时，两个数据对应的最终获取时间之间的时间差。
上述第一补偿处理可以是在原先第一坐标基础上进行的距离调整；
上述第二补偿处理可以是在原先第二坐标基础上进行的角度调整。
上述技术方案的有益效果是：通过对陀螺仪数据或者距离数据进行补偿处理，便于对第一坐标和第一航向角进行更新，且采用的陀螺仪和编码器成本低，实用性好。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，如图3所示，还包括：
所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
上述技术方案的有益效果是：通过将输出输出接口和串口作为连接媒介，便于将数据进行有效传输。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角的步骤还包括：
根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
上述技术方案的有益效果是：通过公式(1)、(2)和(3)方便对第一坐标和第一航向角进行有效更新，且第一航向角和第一坐标都是在航向角变化量的基础上进行更新的。
本发明实施例提出基于编码器和陀螺仪的车辆航位推算定位方法，还包括：对所述输入输出接口进行检测，其检测步骤包括：
对所述输入输出接口进行扫描，并获取所述输入输出接口的虚拟接口结构；
基于预先训练好的接口训练模型，对所述虚拟接口结构进行深度训练，判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出所述输入输出接口正常信息。
通过上述技术方案，还可以对第一串口和第二串口进行有效确定，是否可以正常传输数据。
上述技术方案的有益效果是：通过对接口进行扫描，便于保证其接口的正常传输，为后续对数据分析提供便利，通过显著性标注，可以有效处理其异常部位。
本发明实施例提供基于编码器和陀螺仪的车辆航位推算定位方法对应的装置，如图4所示，包括：
第一获取模块，用于根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
第二获取模块，用于基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
中央处理器，用于判断所述第二获取模块获取的所述距离数据是否为零；
若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角。
优选的，所述中央处理器，还用于当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
所述中央处理器，还用于当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
优选的，还包括：采样板；
所述采用板，用于采集所述编码器获取的距离数据，并将所述距离数据传输到中央处理器；
其中，所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
优选的，所述中央处理器，还用于根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
所述中央处理器，还用于根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
优选的，上述装置，还包括：
扫描模块，用于对所述输入输出接口进行扫描，并获取所述输入输出接口的虚拟接口结构；
训练模块，用于基于预先训练好的接口训练模型，对所述扫描模块获取的所述虚拟接口结构进行深度训练；
所述中央处理器，用于判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出所述输入输出接口正常信息。
上述技术方案的有益效果是：通过编码器和陀螺仪对车辆航位进行定位推算和补偿处理，其可有效的降低定位误差；通过对陀螺仪数据或者距离数据进行补偿处理，便于对第一坐标和第一航向角进行更新，且采用的陀螺仪和编码器成本低，实用性好；方便对第一坐标和第一航向角进行有效更新，且第一航向角和第一坐标都是在航向角变化量的基础上进行更新的；通过对接口进行扫描，便于保证其接口的正常传输，为后续对数据分析提供便利。
显然，本领域的技术人员可以对本发明进行各种改动和变型而不脱离本发明的精神和范围。这样，倘若本发明的这些修改和变型属于本发明权利要求及其等同技术的范围之内，则本发明也意图包含这些改动和变型在内。
Claims (8)
1.基于编码器和陀螺仪的车辆航位推算定位方法，其特征在于，包括：
根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
判断获取的所述距离数据是否为零，若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角的步骤包括：
当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
2.如权利要求1所述的方法，其特征在于，还包括：
所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
3.如权利要求1所述的方法，其特征在于，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角的步骤还包括：
根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
4.如权利要求3所述的方法，其特征在于，还包括：对输入输出接口进行检测，其检测步骤包括：
对输入输出接口进行扫描，并获取输入输出接口的虚拟接口结构；
基于预先训练好的接口训练模型，对所述虚拟接口结构进行深度训练，判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出输入输出接口正常信息。
5.基于权利要求1-4任一所述的方法对应的装置，其特征在于，包括：
第一获取模块，用于根据航位推算算法，获取目标车辆在上一周期的第一坐标和第一航向角；
第二获取模块，用于基于编码器获取所述目标车辆在预设采样周期内的距离数据，同时基于陀螺仪获取所述目标车辆在预设采样周期内的陀螺仪数据；
中央处理器，用于判断所述第二获取模块获取的所述距离数据是否为零；
若是，判定在所述预设采样周期获取的第二坐标和第二航向角为所述上一周期的第一坐标和第一航向角；
否则，基于预先存储的预设算法，对所述第一坐标和第一航向角进行补偿处理，来更新所述上一周期的第一坐标和第一航向角；
所述中央处理器，还用于当获取的所述距离数据不为零时，判断所述编码器获取所述距离数据的第一时间戳是否晚于所述陀螺仪获取所述陀螺仪数据的第二时间戳；
若是，根据预先设定的时间差，对所述陀螺仪数据进行第一补偿处理；
否则，根据预先设定的时间差，对所述距离数据进行第二补偿处理；
所述中央处理器，还用于当补偿处理结束后，根据所述航位推算算法重新计算所述上一周期的第一坐标和第一航向角，并进行更新。
6.如权利要求5所述的装置，其特征在于，还包括：采样板；
采用板，用于采集所述编码器获取的距离数据，并将所述距离数据传输到中央处理器；
其中，所述编码器通过输入输出接口与采样板连接，所述采样板通过第一串口与中央处理器连接，所述陀螺仪通过第二串口与所述中央处理器连接。
7.如权利要求5所述的装置，其特征在于，
所述中央处理器，还用于根据公式(1)和(2)对所述上一周期的第一坐标进行更新；
Xn＝Xn-1+S*sinφn (1)；
Yn＝Yn-1+S*cosφn (2)；
其中，Xn-1表示上一周期的第一坐标的横坐标；Yn-1表示上一周期的第一坐标的纵坐标；Xn表示基于第一坐标进行更新后的横坐标；Yn表示基于第一坐标进行更新后的纵坐标；φn表示基于第一航向角进行更新后的航向角；S表示所述目标车辆在预设采样周期内的行驶距离；
所述中央处理器，还用于根据公式(3)对所述上一周期的第一航向角进行更新；
Φn＝φn-1+Detφ (3)；
其中，φn-1表示上一周期的第一航向角；Detφ表示基于陀螺仪得到的航向角的变化量；
其中，(Xn，Yn)和Φn即为对所述上一周期的第一坐标和第一航向角进行更新后的坐标和航向角。
8.如权利要求5所述的装置，其特征在于，还包括：
扫描模块，用于对输入输出接口进行扫描，并获取所述输入输出接口的虚拟接口结构；
训练模块，用于基于预先训练好的接口训练模型，对所述扫描模块获取的所述虚拟接口结构进行深度训练；
所述中央处理器，用于判断所述虚拟接口结构上是否存在异常结构，
若存在，确定所述异常结构基于所述虚拟接口结构的异常信息，并在所述虚拟接口结构上将所述异常结构进行显著性标注，并输出，其中，异常信息包括：所述异常结构基于所述虚拟接口结构的虚拟位置、虚拟结构大小、虚拟结构形态、虚拟结构异常指数；
否则，输出所述输入输出接口正常信息。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010100193.3A CN111256709B (zh) | 2020-02-18 | 2020-02-18 | 基于编码器和陀螺仪的车辆航位推算定位方法及装置 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010100193.3A CN111256709B (zh) | 2020-02-18 | 2020-02-18 | 基于编码器和陀螺仪的车辆航位推算定位方法及装置 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111256709A CN111256709A (zh) | 2020-06-09 |
| CN111256709B true CN111256709B (zh) | 2021-11-02 |
Family
ID=70951093
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010100193.3A Active CN111256709B (zh) | 2020-02-18 | 2020-02-18 | 基于编码器和陀螺仪的车辆航位推算定位方法及装置 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111256709B (zh) |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1221586A3 (en) * | 2001-01-08 | 2004-06-16 | Motorola, Inc. | Position and heading error-correction method and apparatus for vehicle navigation systems |
| CN102495415A (zh) * | 2011-11-28 | 2012-06-13 | 北京航空航天大学 | 一种gps滞后时间的自适应检测方法 |
| CN105180934A (zh) * | 2015-09-16 | 2015-12-23 | 成都四威高科技产业园有限公司 | 一种agv惯性导航方法 |
| CN106017454A (zh) * | 2016-06-16 | 2016-10-12 | 东南大学 | 一种基于新型多传感器融合技术的行人导航装置和方法 |
| CN206411514U (zh) * | 2016-09-13 | 2017-08-15 | 哈尔滨工业大学深圳研究生院 | 一种基于二维码定位的智能仓储移动机器人系统 |
| CN107860399A (zh) * | 2017-09-22 | 2018-03-30 | 北京机械设备研究所 | 一种基于地图匹配的车载捷联惯导行进间精对准方法 |
Family Cites Families (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US11036238B2 (en) * | 2015-10-15 | 2021-06-15 | Harman International Industries, Incorporated | Positioning system based on geofencing framework |
| CN103712625A (zh) * | 2013-12-23 | 2014-04-09 | 哈尔滨工程大学 | 一种估计初始航向偏差滤波的方法 |
| CN107941217B (zh) * | 2017-09-30 | 2020-05-22 | 杭州迦智科技有限公司 | 一种机器人定位方法、电子设备、存储介质、装置 |
-
2020
- 2020-02-18 CN CN202010100193.3A patent/CN111256709B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| EP1221586A3 (en) * | 2001-01-08 | 2004-06-16 | Motorola, Inc. | Position and heading error-correction method and apparatus for vehicle navigation systems |
| CN102495415A (zh) * | 2011-11-28 | 2012-06-13 | 北京航空航天大学 | 一种gps滞后时间的自适应检测方法 |
| CN105180934A (zh) * | 2015-09-16 | 2015-12-23 | 成都四威高科技产业园有限公司 | 一种agv惯性导航方法 |
| CN106017454A (zh) * | 2016-06-16 | 2016-10-12 | 东南大学 | 一种基于新型多传感器融合技术的行人导航装置和方法 |
| CN206411514U (zh) * | 2016-09-13 | 2017-08-15 | 哈尔滨工业大学深圳研究生院 | 一种基于二维码定位的智能仓储移动机器人系统 |
| CN107860399A (zh) * | 2017-09-22 | 2018-03-30 | 北京机械设备研究所 | 一种基于地图匹配的车载捷联惯导行进间精对准方法 |
Non-Patent Citations (1)
| Title |
|---|
| 室内智能小车定位技术研究;郑震;《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》;20200215;第C035-417页 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111256709A (zh) | 2020-06-09 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN100470198C (zh) | 步行者导航设备 | |
| KR100495635B1 (ko) | 네비게이션 시스템의 위치오차 보정방법 | |
| CN105865461B (zh) | 一种基于多传感器融合算法的汽车定位系统及方法 | |
| CN103162689B (zh) | 辅助车载定位系统及车辆的辅助定位方法 | |
| CN111065043B (zh) | 一种基于车路通信的隧道内车辆融合定位系统及方法 | |
| CN112577521B (zh) | 一种组合导航误差校准方法及电子设备 | |
| CN111443337B (zh) | 一种基于手眼标定的雷达-imu标定方法 | |
| CN111238535B (zh) | 一种基于因子图的imu误差在线标定方法 | |
| CN114179825B (zh) | 多传感器融合获取量测值置信度方法及自动驾驶车辆 | |
| CN110044377B (zh) | 一种基于Vicon的IMU离线标定方法 | |
| CN112146682B (zh) | 智能汽车的传感器标定方法、装置、电子设备及介质 | |
| EP4345421A2 (en) | Method for calibrating sensor parameters based on autonomous driving, apparatus, storage medium, and vehicle | |
| CN113933818A (zh) | 激光雷达外参的标定的方法、设备、存储介质及程序产品 | |
| CN113137973A (zh) | 一种图像语义特征点真值确定方法及装置 | |
| CN111256709B (zh) | 基于编码器和陀螺仪的车辆航位推算定位方法及装置 | |
| CN113554712A (zh) | 自动驾驶车辆的配准方法、装置、电子设备和车辆 | |
| CN111222225B (zh) | 一种机器人中传感器位姿的确定方法及装置 | |
| CN115790613A (zh) | 一种视觉信息辅助的惯性/里程计组合导航方法及装置 | |
| CN111829473B (zh) | 一种行进间的运动底盘测距方法及系统 | |
| CN112633043B (zh) | 一种车道线确定方法、装置、电子设备及存储介质 | |
| EP1206683B1 (en) | Integrated inertial/vms navigation system | |
| CN114608570B (zh) | 一种多模式自切换的管线仪自适应精密定位方法 | |
| JP3401997B2 (ja) | 車両走行方位算出装置 | |
| CN110082805A (zh) | 一种三维定位装置和方法 | |
| EP4148392A1 (en) | Method and apparatus for vehicle positioning |
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 | ||
| PE01 | Entry into force of the registration of the contract for pledge of patent right | ||
| PE01 | Entry into force of the registration of the contract for pledge of patent right |
Denomination of invention: Vehicle dead reckoning positioning method and device based on encoder and gyroscope Effective date of registration: 20220923 Granted publication date: 20211102 Pledgee: Haidian Beijing science and technology enterprise financing Company limited by guarantee Pledgor: Beijing Jiuquan Intelligent Technology Co.,Ltd. Registration number: Y2022990000671 |
|
| PC01 | Cancellation of the registration of the contract for pledge of patent right | ||
| PC01 | Cancellation of the registration of the contract for pledge of patent right |
Granted publication date: 20211102 Pledgee: Haidian Beijing science and technology enterprise financing Company limited by guarantee Pledgor: Beijing Jiuquan Intelligent Technology Co.,Ltd. Registration number: Y2022990000671 |