CN115390103A - 卫星定位信号的异常检测方法、装置及电子设备 - Google Patents

卫星定位信号的异常检测方法、装置及电子设备 Download PDF

Info

Publication number
CN115390103A
CN115390103A CN202211041137.2A CN202211041137A CN115390103A CN 115390103 A CN115390103 A CN 115390103A CN 202211041137 A CN202211041137 A CN 202211041137A CN 115390103 A CN115390103 A CN 115390103A
Authority
CN
China
Prior art keywords
track
satellite positioning
positioning signal
lane change
predicted
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.)
Granted
Application number
CN202211041137.2A
Other languages
English (en)
Other versions
CN115390103B (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.)
Zhidao Network Technology Beijing Co Ltd
Original Assignee
Zhidao Network Technology Beijing 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 Zhidao Network Technology Beijing Co Ltd filed Critical Zhidao Network Technology Beijing Co Ltd
Priority to CN202211041137.2A priority Critical patent/CN115390103B/zh
Publication of CN115390103A publication Critical patent/CN115390103A/zh
Application granted granted Critical
Publication of CN115390103B publication Critical patent/CN115390103B/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
    • G01S19/00Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
    • G01S19/01Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
    • G01S19/13Receivers
    • G01S19/23Testing, monitoring, correcting or calibrating of receiver elements

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Computer Networks & Wireless Communication (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Navigation (AREA)

Abstract

本申请公开了一种卫星定位信号的异常检测方法、装置及电子设备,所述卫星定位信号的异常检测方法包括:获取自动驾驶车辆的当前定位信息和对应的高精地图数据;根据当前定位信息和对应的高精地图数据,确定自动驾驶车辆在预设距离内的预测轨迹,预测轨迹包括不变道行驶轨迹;获取自动驾驶车辆的卫星定位信号;根据预测轨迹确定卫星定位信号是否异常,得到卫星定位信号的异常检测结果。本申请将基于高精地图数据得到的预测轨迹作为先验信息,对卫星定位信号的异常值进行检测,保证滤波器不受短时不准确的“欺骗性”卫星定位信号的影响,保障定位稳定性,在仅依靠车身数据辅助定位的情况下,降低由于定位误差产生的定位突变或人工接管的概率。

Description

卫星定位信号的异常检测方法、装置及电子设备
技术领域
本申请涉及自动驾驶技术领域,尤其涉及一种卫星定位信号的异常检测方法、装置及电子设备。
背景技术
基于GNSS(Global Navigation Satellite System,全球导航卫星系统)/RTK(Real-time kinematic,实时动态差分)+IMU(Inertial Measurement Unit,惯性测量单元)组成的组合导航系统在自动驾驶领域已经得到广泛应用,目前主流的算法是基于卡尔曼滤波器将不可观的、高频的惯导相对定位数据与可观的、低频的GNSS/RTK绝对定位数据融合,从而产生高频、高精度的定位结果以及定位结果的置信度,供后续感知、规划控制模块使用。
由于滤波器自身的逻辑原因,如果GNSS观测值产生误差,整个滤波器会受到影响,目前的一些异常值检测算法,比如卡方检测,可以在一定程度上拒绝突变的异常观测值,但对于一些特殊的异常值,仍无法进行良好的处理,例如受到高架桥、周边信号干扰等出现的短时间不规则的误差范围内的定位信号,就会导致自动驾驶车辆在GNSS定位信号恢复后出现跳变,或者由于GNSS定位不准确导致后续模块接收到不正确的位置,影响感知和规划控制模块的正常处理,进而引起人工接管。
针对单一观测数据不稳定的情况,基于激光雷达或视觉SLAM(SimultaneousLocalization And Mapping,同步定位与建图)技术得到的定位结果也越来越多的被作为辅助观测信息加入到滤波器中,以提高定位的鲁棒性。然而此种方式会带来额外的算力和数据准备工作,比如地图建立、数据关联、高精度标定、地图更新等,会对在固定运营区域运行的自动驾驶车辆带来额外的高成本。
发明内容
本申请实施例提供了一种卫星定位信号的异常检测方法、装置及电子设备,以提高自动驾驶车辆的定位稳定性。
本申请实施例采用下述技术方案:
第一方面,本申请实施例提供一种卫星定位信号的异常检测方法,其中,所述卫星定位信号的异常检测方法包括:
获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
获取所述自动驾驶车辆的卫星定位信号;
根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
可选地,所述根据所述预测轨迹确定所述卫星定位信号是否异常包括:
确定所述自动驾驶车辆是否发生变道;
若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果;
若发生变道,则根据变道结果更新所述预测轨迹,并利用更新后的预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
可选地,所述若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:
确定所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差;
若所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差小于预设横向偏差阈值,则确定所述卫星定位信号正常;
否则,则确定所述卫星定位信号异常。
可选地,所述确定所述自动驾驶车辆是否发生变道包括:
基于所述当前定位信息,利用预设航迹推演策略进行航迹推演,得到航迹推演轨迹;
根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
可选地,所述变道包括非主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:
利用预设相似度度量算法,确定所述预测轨迹与所述航迹推演轨迹的相似度;
根据所述预测轨迹与所述航迹推演轨迹的相似度,确定所述自动驾驶车辆是否发生所述非主动变道;
所述若发生变道,则根据变道结果更新所述预测轨迹包括:
若发生所述非主动变道,则根据所述航迹推演轨迹确定非主动变道结果,并根据所述非主动变道结果更新所述预测轨迹。
可选地,所述变道包括主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:
获取自动驾驶车辆的控制反馈信息;
根据所述航迹推演轨迹的形状以及所述控制反馈信息,确定所述自动驾驶车辆是否发生主动变道;
所述若发生变道,则根据变道结果更新所述预测轨迹包括:
若发生所述主动变道,则根据所述航迹推演轨迹的形状以及所述控制反馈信息确定主动变道结果,并根据所述主动变道结果更新所述预测轨迹。
可选地,所述根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:
在所述自动驾驶车辆发生主动变道的情况下,获取所述自动驾驶车辆在变道过程对应的卫星定位数据;
根据所述自动驾驶车辆在变道过程对应的卫星定位数据,生成所述变道过程对应的卫星定位轨迹;
获取所述变道过程对应的航迹推演轨迹,并利用预设相似度度量算法,确定所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度;
根据所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
第二方面,本申请实施例还提供一种卫星定位信号的异常检测装置,其中,所述卫星定位信号的异常检测装置包括:
第一获取单元,用于获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
第一确定单元,用于根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
第二获取单元,用于获取所述自动驾驶车辆的卫星定位信号;
第二确定单元,用于根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
第三方面,本申请实施例还提供一种电子设备,包括:
处理器;以及
被安排成存储计算机可执行指令的存储器,所述可执行指令在被执行时使所述处理器执行前述之任一所述卫星定位信号的异常检测方法。
第四方面,本申请实施例还提供一种计算机可读存储介质,所述计算机可读存储介质存储一个或多个程序,所述一个或多个程序当被包括多个应用程序的电子设备执行时,使得所述电子设备执行前述之任一所述卫星定位信号的异常检测方法。
本申请实施例采用的上述至少一个技术方案能够达到以下有益效果:本申请实施例的卫星定位信号的异常检测方法,先获取自动驾驶车辆的当前定位信息和对应的高精地图数据;然后根据当前定位信息和对应的高精地图数据,确定自动驾驶车辆在预设距离内的预测轨迹,预测轨迹包括不变道行驶轨迹;之后获取自动驾驶车辆的卫星定位信号;最后根据预测轨迹确定卫星定位信号是否异常,得到卫星定位信号的异常检测结果。本申请实施例的卫星定位信号的异常检测方法将基于高精地图数据得到的预测轨迹作为先验信息,对卫星定位信号的异常值进行检测,保证滤波器不受短时不准确的“欺骗性”卫星定位信号的影响,保障整体的定位稳定性,在仅依靠车身数据辅助定位的情况下,降低由于定位误差产生的自动驾驶车辆定位突变或人工接管的概率。
附图说明
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:
图1为本申请实施例中一种卫星定位信号的异常检测方法的流程示意图;
图2为本申请实施例中一种卫星定位信号的异常检测装置的结构示意图;
图3为本申请实施例中一种电子设备的结构示意图。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚,下面将结合本申请具体实施例及相应的附图对本申请技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
以下结合附图,详细说明本申请各实施例提供的技术方案。
本申请实施例提供了一种卫星定位信号的异常检测方法,如图1所示,提供了本申请实施例中一种卫星定位信号的异常检测方法的流程示意图,所述卫星定位信号的异常检测方法至少包括如下的步骤S110至步骤S140:
步骤S110,获取自动驾驶车辆的当前定位信息和对应的高精地图数据。
本申请实施例的卫星定位信号例如可以是GNSS定位信号,在进行卫星定位信号的异常检测时,需要先获取自动驾驶车辆的当前定位信息,例如包括当前位置和当前车身速度等定位信息,这些定位信息可以通过滤波器输出的当前状态来得到。
此外,还需要获取当前位置对应的高精地图数据,高精地图数据中不仅有高精度的坐标,同时还有准确的道路形状,并且每个车道的坡度、曲率、航向、高程,侧倾的数据也都包含在内;另外,每条车道上的标识类型、车道线的颜色、道路的隔离带、道路上的指示牌上的箭头和文字都会在高精地图中呈现。因此,本申请实施例基于高精地图数据中提供的丰富的道路结构化信息能够为卫星定位信号的异常检测提供有力支撑。
步骤S120,根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹。
由于一般自动驾驶场景下,需要尽可能保证自动驾驶车辆在车道中心线上或者附近行驶,而高精地图数据中又提供了丰富的车道信息,因此基于自动驾驶车辆的当前位置和高精地图数据中的车道信息能够确定出自动驾驶车辆当前所在的车道,进一步结合自动驾驶车辆的当前车身速度能够预测出自动驾驶车辆在预设距离内的行驶轨迹,这里的预设距离可以是从当前位置到终点位置的距离,预测轨迹可以是指不变道行驶轨迹,以尽可能避免岔路、拐弯等情况的定位不确定性。
本申请实施例的轨迹预测的过程,可以看作是在自动驾驶车辆当前所在的高精地图的车道上基于当前位置和当前车身速度采集轨迹点的过程,从而得到预测轨迹,作为后续检测卫星定位信号是否异常的先验信息。
步骤S130,获取所述自动驾驶车辆的卫星定位信号。
步骤S140,根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
本申请实施例在得到预测轨迹之后,就可以对后续接收到的卫星定位信号进行异常检测了,例如可以将当前接收到的卫星定位信号的定位位置与预测轨迹进行比较,确定当前接收到的卫星定位信号的定位位置与预测轨迹之间的横向偏差大小,如果横向偏差大小能够被接受,则可以认为当前接收到的卫星定位信号为正常值,可以用于后续融合处理,否则,则不能用于融合处理。
本申请实施例的卫星定位信号的异常检测方法将基于高精地图数据得到的预测轨迹作为先验信息,对卫星定位信号的异常值进行检测,保证滤波器不受短时不准确的“欺骗性”卫星定位信号的影响,保障整体的定位稳定性,在仅依靠车身数据辅助定位的情况下,降低由于定位误差产生的自动驾驶车辆定位突变或人工接管的概率。
在本申请的一些实施例中,所述根据所述预测轨迹确定所述卫星定位信号是否异常包括:确定所述自动驾驶车辆是否发生变道;若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果;若发生变道,则根据变道结果更新所述预测轨迹,并利用更新后的预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
如前所述,预测轨迹主要是针对不变道的行驶情况进行预测得到的轨迹,而实际场景下,自动驾驶车辆并不一定会始终按照预测轨迹上的车道行驶,即可能会出现变道的情况,一旦自动驾驶车辆变道,那么原来的预测轨迹中的车道信息就不再准确,这时可以根据变道结果对预测轨迹进行更新,从而根据更新后的预测轨迹继续进行卫星定位信号的异常检测,保证车道级别的卫星定位信号异常检测的准确性。
在本申请的一些实施例中,所述若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:确定所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差;若所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差小于预设横向偏差阈值,则确定所述卫星定位信号正常;否则,则确定所述卫星定位信号异常。
如果自动驾驶车辆当前没有变道,那么说明之前基于高精地图数据得到的预测轨迹仍然是准确的,即仍然可以基于原来的预测轨迹进行卫星定位信号的异常检测。
具体地,可以先将当前获取到的卫星定位信号的观测值转换到车体坐标系下,然后计算当前的卫星定位信号的观测值是否落在预测轨迹附近,即当前的卫星定位信号的观测值是否落在预测轨迹上的某一轨迹点两侧的预设横向偏移误差范围内。由于实际控制中,横向误差带来的影响远远大于纵向误差,因此这里的预设横向偏差范围应当能够满足车道级定位的需求。如果当前的卫星定位信号的观测值落在预设范围内,则可以用于观测融合,否则,此观测值为异常值,不能用于观测融合。
在本申请的一些实施例中,所述确定所述自动驾驶车辆是否发生变道包括:基于所述当前定位信息,利用预设航迹推演策略进行航迹推演,得到航迹推演轨迹;根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
本申请实施例对自动驾驶车辆是否发生变道的判断可以基于航迹推演来实现,具体可以根据误差补偿后的车身速度以及横摆角速度Yawrate计算出自动驾驶车辆在后续预设时间内的航迹推演轨迹,这里的预设时间的长短主要与自动驾驶车辆的变道时间相关,由于车辆变道的时间一般是3-6秒,那么预设时间例如可以设置为10秒,以便于能够对变道情况进行充分判断,进而为预测轨迹的更新提供依据。
在本申请的一些实施例中,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:确定航迹推演的时间阈值;获取航迹推演的当前持续时间;若所述航迹推演的当前持续时间未达到所述航迹推演的时间阈值,则根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
由于航迹推演存在随时间累计误差变大的问题,因此当航迹推演的持续时间超过一定时长时,累计误差将大大增加,航迹推演结果将不再可用,因此本申请实施例可以事先确定一个航迹推演的最长时间如15秒,作为航迹推演的时间阈值T,如果当前航迹推演的累计时间还没有到达时间阈值T,则可用于后续对于预测轨迹的更新判断,而如果当前航迹推演的累计时间已经到达时间阈值T,且当前也没有可靠的观测输入,那么这时可以触发报警操作,从而保证自动驾驶车辆的安全性。
上述航迹推演的时间阈值T可以根据实际场景需求事先确定好,例如可以通过采集不同场景、不同气候下的组合导航原始数据,包括惯导数据和GNSS定位数据,然后基于组合导航原始数据计算出组合导航系统依赖航迹推演的有效时长,也即航迹推演出的位置在位置误差范围内的最长时间,作为航迹推演的时间阈值T。
在本申请的一些实施例中,所述变道包括非主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:利用预设相似度度量算法,确定所述预测轨迹与所述航迹推演轨迹的相似度;根据所述预测轨迹与所述航迹推演轨迹的相似度,确定所述自动驾驶车辆是否发生所述非主动变道;所述若发生变道,则根据变道结果更新所述预测轨迹包括:若发生所述非主动变道,则根据所述航迹推演轨迹确定非主动变道结果,并根据所述非主动变道结果更新所述预测轨迹。
本申请实施例的变道类型可以包括非主动变道的情况,非主动变道主要是指车道数量的变化,例如由直行三车道变为直行四车道,或者由直行四车道变为直行三车道等等。这种情况下,自动驾驶车辆的航迹推演轨迹可能会发生一定程度的弯曲,但这种非主动变道情况下的轨迹弯曲程度一般相对于主动变道情况下的轨迹弯曲程度更小。
基于此,本申请实施例可以先利用预设相似度度量算法计算当前的预测轨迹与航迹推演轨迹的相似度,也即衡量两个轨迹之间的偏差情况,然后根据相似度的大小能够判断出自动驾驶车辆是否发生非主动变道,例如,如果没有发生变道,那么二者之间的相似度应该很高,而如果发生非主动变道,那么这时根据航迹推演轨迹能够进一步确定出非主动变道后自动驾驶车辆所在的车道,进而可以根据非主动变道后自动驾驶车辆所在的车道对预测轨迹的车道信息进行更新,也即根据非主动变道后的车道信息重新进行轨迹预测。
上述预设相似度度量算法例如可以采用Frechet Distance算法来实现,FrechetDistance是计算两曲线距离的算法,用来判断两曲线的相似度,计算结果越小说明相似度越高。当然,本领域技术人员也可以根据实际需求灵活选择其他相似度度量算法,在此不作具体限定。
在本申请的一些实施例中,所述变道包括主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:获取自动驾驶车辆的控制反馈信息;根据所述航迹推演轨迹的形状以及所述控制反馈信息,确定所述自动驾驶车辆是否发生主动变道;所述若发生变道,则根据变道结果更新所述预测轨迹包括:若发生所述主动变道,则根据所述航迹推演轨迹的形状以及所述控制反馈信息确定主动变道结果,并根据所述主动变道结果更新所述预测轨迹。
本申请实施例的变道类型还包括主动变道的情况,主动变道是指自动驾驶车辆基于规划控制信息或者避障等情况而作出的变道行为,例如直行三车道中由左侧车道变道至中间车道。
在主动变道的情况下,航迹推演轨迹的形状会有明显的弯曲程度变化,因此可以根据航迹推演轨迹的形状来判断自动驾驶车辆是否发生主动变道。此外,为了提高判断的准确性,还可以进一步获取自动驾驶车辆的控制反馈信息对变道情况的判断结果进行确认,例如控制模块下发变道指令,基于变道指令获取成功变道、连续变道或变道避障后回到原车道等反馈信息,从而可以确认自动驾驶车辆发生了主动变道,这时可以根据主动变道过程以及变道后自动驾驶车辆所在的车道更新预测轨迹的车道信息。
在本申请的一些实施例中,所述根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:在所述自动驾驶车辆发生主动变道的情况下,获取所述自动驾驶车辆在变道过程对应的卫星定位数据;根据所述自动驾驶车辆在变道过程对应的卫星定位数据,生成所述变道过程对应的卫星定位轨迹;获取所述变道过程对应的航迹推演轨迹,并利用预设相似度度量算法,确定所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度;根据所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
如果判断出自动驾驶车辆发生主动变道且变道时间较长,但仍小于航迹推演的时间阈值T,那么变道后的预测值和GNSS观测值之间会产生一定的偏差,因此对于由变道而引起的GNSS观测值融合失败的情况可以在变道后进行补偿。
由于预测轨迹是在某一车道内对行驶轨迹进行的预测,因此在变道的这个过程中并没有正确的预测轨迹,因此这里可以根据变道期间获取到的卫星定位信号生成变道期间的GNSS定位轨迹,然后同样可以采用预设相似度度量算法计算变道期间的GNSS定位轨迹与变道期间的航迹推演轨迹的相似度,如果相似度大于预设相似度阈值,则认为变道后的GNSS观测值是正常值,可以跳过卡方检测的逻辑,直接融合变道后的GNSS观测值,从而保证自动驾驶车辆的定位稳定性。
本申请实施例还提供了一种卫星定位信号的异常检测装置200,如图2所示,提供了本申请实施例中一种卫星定位信号的异常检测装置的结构示意图,所述卫星定位信号的异常检测装置200包括:第一获取单元210、第一确定单元220、第二获取单元230以及第二确定单元240,其中:
第一获取单元210,用于获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
第一确定单元220,用于根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
第二获取单元230,用于获取所述自动驾驶车辆的卫星定位信号;
第二确定单元240,用于根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
在本申请的一些实施例中,所述第二确定单元240具体用于:确定所述自动驾驶车辆是否发生变道;若发生变道,则根据变道结果更新所述预测轨迹,并利用更新后的预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果;若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
在本申请的一些实施例中,所述第二确定单元240具体用于:确定所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差;若所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差小于预设横向偏差阈值,则确定所述卫星定位信号正常;否则,则确定所述卫星定位信号异常。
在本申请的一些实施例中,所述第二确定单元240具体用于:基于所述当前定位信息,利用预设航迹推演策略进行航迹推演,得到航迹推演轨迹;根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
在本申请的一些实施例中,所述变道包括非主动变道,所述第二确定单元240具体用于:利用预设相似度度量算法,确定所述预测轨迹与所述航迹推演轨迹的相似度;根据所述预测轨迹与所述航迹推演轨迹的相似度,确定所述自动驾驶车辆是否发生所述非主动变道;若发生所述非主动变道,则根据所述航迹推演轨迹确定非主动变道结果,并根据所述非主动变道结果更新所述预测轨迹。
在本申请的一些实施例中,所述变道包括主动变道,所述第二确定单元240具体用于:获取自动驾驶车辆的控制反馈信息;根据所述航迹推演轨迹的形状以及所述控制反馈信息,确定所述自动驾驶车辆是否发生主动变道;若发生所述主动变道,则根据所述航迹推演轨迹的形状以及所述控制反馈信息确定主动变道结果,并根据所述主动变道结果更新所述预测轨迹。
在本申请的一些实施例中,所述第二确定单元240具体用于:在所述自动驾驶车辆发生主动变道的情况下,获取所述自动驾驶车辆在变道过程对应的卫星定位数据;根据所述自动驾驶车辆在变道过程对应的卫星定位数据,生成所述变道过程对应的卫星定位轨迹;获取所述变道过程对应的航迹推演轨迹,并利用预设相似度度量算法,确定所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度;根据所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
在本申请的一些实施例中,所述第二确定单元240具体用于:确定航迹推演的时间阈值;获取航迹推演的当前持续时间;若所述航迹推演的当前持续时间未达到所述航迹推演的时间阈值,则根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
能够理解,上述卫星定位信号的异常检测装置,能够实现前述实施例中提供的卫星定位信号的异常检测方法的各个步骤,关于卫星定位信号的异常检测方法的相关阐释均适用于卫星定位信号的异常检测装置,此处不再赘述。
图3是本申请的一个实施例电子设备的结构示意图。请参考图3,在硬件层面,该电子设备包括处理器,可选地还包括内部总线、网络接口、存储器。其中,存储器可能包含内存,例如高速随机存取存储器(Random-Access Memory,RAM),也可能还包括非易失性存储器(non-volatile memory),例如至少1个磁盘存储器等。当然,该电子设备还可能包括其他业务所需要的硬件。
处理器、网络接口和存储器可以通过内部总线相互连接,该内部总线可以是ISA(Industry Standard Architecture,工业标准体系结构)总线、PCI(PeripheralComponent Interconnect,外设部件互连标准)总线或EISA(Extended Industry StandardArchitecture,扩展工业标准结构)总线等。所述总线可以分为地址总线、数据总线、控制总线等。为便于表示,图3中仅用一个双向箭头表示,但并不表示仅有一根总线或一种类型的总线。
存储器,用于存放程序。具体地,程序可以包括程序代码,所述程序代码包括计算机操作指令。存储器可以包括内存和非易失性存储器,并向处理器提供指令和数据。
处理器从非易失性存储器中读取对应的计算机程序到内存中然后运行,在逻辑层面上形成卫星定位信号的异常检测装置。处理器,执行存储器所存放的程序,并具体用于执行以下操作:
获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
获取所述自动驾驶车辆的卫星定位信号;
根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
上述如本申请图1所示实施例揭示的卫星定位信号的异常检测装置执行的方法可以应用于处理器中,或者由处理器实现。处理器可能是一种集成电路芯片,具有信号的处理能力。在实现过程中,上述方法的各步骤可以通过处理器中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器可以是通用处理器,包括中央处理器(CentralProcessing Unit,CPU)、网络处理器(Network Processor,NP)等;还可以是数字信号处理器(Digital Signal Processor,DSP)、专用集成电路(Application Specific IntegratedCircuit,ASIC)、现场可编程门阵列(Field-Programmable Gate Array,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本申请实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成上述方法的步骤。
该电子设备还可执行图1中卫星定位信号的异常检测装置执行的方法,并实现卫星定位信号的异常检测装置在图1所示实施例的功能,本申请实施例在此不再赘述。
本申请实施例还提出了一种计算机可读存储介质,该计算机可读存储介质存储一个或多个程序,该一个或多个程序包括指令,该指令当被包括多个应用程序的电子设备执行时,能够使该电子设备执行图1所示实施例中卫星定位信号的异常检测装置执行的方法,并具体用于执行:
获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
获取所述自动驾驶车辆的卫星定位信号;
根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
本领域内的技术人员应明白,本发明的实施例可提供为方法、系统、或计算机程序产品。因此,本发明可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本发明可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本发明是参照根据本发明实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
在一个典型的配置中,计算设备包括一个或多个处理器(CPU)、输入/输出接口、网络接口和内存。
内存可能包括计算机可读介质中的非永久性存储器,随机存取存储器(RAM)和/或非易失性内存等形式,如只读存储器(ROM)或闪存(flash RAM)。内存是计算机可读介质的示例。
计算机可读介质包括永久性和非永久性、可移动和非可移动媒体可以由任何方法或技术来实现信息存储。信息可以是计算机可读指令、数据结构、程序的模块或其他数据。计算机的存储介质的例子包括,但不限于相变内存(PRAM)、静态随机存取存储器(SRAM)、动态随机存取存储器(DRAM)、其他类型的随机存取存储器(RAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、快闪记忆体或其他内存技术、只读光盘只读存储器(CD-ROM)、数字多功能光盘(DVD)或其他光学存储、磁盒式磁带,磁带磁磁盘存储或其他磁性存储设备或任何其他非传输介质,可用于存储可以被计算设备访问的信息。按照本文中的界定,计算机可读介质不包括暂存电脑可读媒体(transitory media),如调制的数据信号和载波。
还需要说明的是,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、商品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、商品或者设备所固有的要素。在没有更多限制的情况下,由语句“包括一个……”限定的要素,并不排除在包括所述要素的过程、方法、商品或者设备中还存在另外的相同要素。
本领域技术人员应明白,本申请的实施例可提供为方法、系统或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
以上所述仅为本申请的实施例而已,并不用于限制本申请。对于本领域技术人员来说,本申请可以有各种更改和变化。凡在本申请的精神和原理之内所作的任何修改、等同替换、改进等,均应包含在本申请的权利要求范围之内。

Claims (10)

1.一种卫星定位信号的异常检测方法,其中,所述卫星定位信号的异常检测方法包括:
获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
获取所述自动驾驶车辆的卫星定位信号;
根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
2.如权利要求1所述卫星定位信号的异常检测方法,其中,所述根据所述预测轨迹确定所述卫星定位信号是否异常包括:
确定所述自动驾驶车辆是否发生变道;
若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果;
若发生变道,则根据变道结果更新所述预测轨迹,并利用更新后的预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
3.如权利要求2所述卫星定位信号的异常检测方法,其中,所述若未发生变道,则直接根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:
确定所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差;
若所述卫星定位信号的定位位置与所述预测轨迹中的车道中心线的横向偏差小于预设横向偏差阈值,则确定所述卫星定位信号正常;
否则,则确定所述卫星定位信号异常。
4.如权利要求2所述卫星定位信号的异常检测方法,其中,所述确定所述自动驾驶车辆是否发生变道包括:
基于所述当前定位信息,利用预设航迹推演策略进行航迹推演,得到航迹推演轨迹;
根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道。
5.如权利要求4所述卫星定位信号的异常检测方法,其中,所述变道包括非主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:
利用预设相似度度量算法,确定所述预测轨迹与所述航迹推演轨迹的相似度;
根据所述预测轨迹与所述航迹推演轨迹的相似度,确定所述自动驾驶车辆是否发生所述非主动变道;
所述若发生变道,则根据变道结果更新所述预测轨迹包括:
若发生所述非主动变道,则根据所述航迹推演轨迹确定非主动变道结果,并根据所述非主动变道结果更新所述预测轨迹。
6.如权利要求4所述卫星定位信号的异常检测方法,其中,所述变道包括主动变道,所述根据所述航迹推演轨迹,确定所述自动驾驶车辆是否发生变道包括:
获取自动驾驶车辆的控制反馈信息;
根据所述航迹推演轨迹的形状以及所述控制反馈信息,确定所述自动驾驶车辆是否发生主动变道;
所述若发生变道,则根据变道结果更新所述预测轨迹包括:
若发生所述主动变道,则根据所述航迹推演轨迹的形状以及所述控制反馈信息确定主动变道结果,并根据所述主动变道结果更新所述预测轨迹。
7.如权利要求4所述卫星定位信号的异常检测方法,其中,所述根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果包括:
在所述自动驾驶车辆发生主动变道的情况下,获取所述自动驾驶车辆在变道过程对应的卫星定位数据;
根据所述自动驾驶车辆在变道过程对应的卫星定位数据,生成所述变道过程对应的卫星定位轨迹;
获取所述变道过程对应的航迹推演轨迹,并利用预设相似度度量算法,确定所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度;
根据所述变道过程对应的卫星定位轨迹与所述变道过程对应的航迹推演轨迹的相似度确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
8.一种卫星定位信号的异常检测装置,其中,所述卫星定位信号的异常检测装置包括:
第一获取单元,用于获取自动驾驶车辆的当前定位信息和对应的高精地图数据;
第一确定单元,用于根据所述当前定位信息和对应的高精地图数据,确定所述自动驾驶车辆在预设距离内的预测轨迹,所述预测轨迹包括不变道行驶轨迹;
第二获取单元,用于获取所述自动驾驶车辆的卫星定位信号;
第二确定单元,用于根据所述预测轨迹确定所述卫星定位信号是否异常,得到所述卫星定位信号的异常检测结果。
9.一种电子设备,包括:
处理器;以及
被安排成存储计算机可执行指令的存储器,所述可执行指令在被执行时使所述处理器执行所述权利要求1~7之任一所述卫星定位信号的异常检测方法。
10.一种计算机可读存储介质,所述计算机可读存储介质存储一个或多个程序,所述一个或多个程序当被包括多个应用程序的电子设备执行时,使得所述电子设备执行所述权利要求1~7之任一所述卫星定位信号的异常检测方法。
CN202211041137.2A 2022-08-29 2022-08-29 卫星定位信号的异常检测方法、装置及电子设备 Active CN115390103B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211041137.2A CN115390103B (zh) 2022-08-29 2022-08-29 卫星定位信号的异常检测方法、装置及电子设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211041137.2A CN115390103B (zh) 2022-08-29 2022-08-29 卫星定位信号的异常检测方法、装置及电子设备

Publications (2)

Publication Number Publication Date
CN115390103A true CN115390103A (zh) 2022-11-25
CN115390103B CN115390103B (zh) 2024-10-01

Family

ID=84122014

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211041137.2A Active CN115390103B (zh) 2022-08-29 2022-08-29 卫星定位信号的异常检测方法、装置及电子设备

Country Status (1)

Country Link
CN (1) CN115390103B (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116794692A (zh) * 2023-08-25 2023-09-22 华信正能集团有限公司 一种卫星导航定位服务异常检测方法
CN117092665A (zh) * 2023-08-03 2023-11-21 广州海格晶维信息产业有限公司 一种组合导航设备抗多径干扰的方法及系统

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090303122A1 (en) * 2008-04-15 2009-12-10 Mediatek Inc. Method and device for using gnss satellite trajectory extension data in mobile apparatus
KR20140078158A (ko) * 2012-12-17 2014-06-25 주식회사 만도 카메라를 이용한 추측항법 기반 네비게이션 시스템 및 그 제어방법
JP2017058235A (ja) * 2015-09-16 2017-03-23 株式会社デンソー 車両位置補正装置
CN110869864A (zh) * 2017-07-07 2020-03-06 罗伯特·博世有限公司 用于定位较高程度自动化的车辆的方法以及相应的驾驶员辅助系统和计算机程序
CN111337953A (zh) * 2020-05-21 2020-06-26 深圳市西博泰科电子有限公司 卫星导航欺骗检测方法、装置、设备及介质
CN111856541A (zh) * 2020-07-24 2020-10-30 苏州中亿通智能系统有限公司 一种固定线路车辆轨迹监测系统及方法
CN114637770A (zh) * 2022-02-23 2022-06-17 中国第一汽车股份有限公司 车辆轨迹的预测方法、装置
WO2022176093A1 (ja) * 2021-02-18 2022-08-25 三菱重工機械システム株式会社 異常検知システム、車載器、異常検知方法、及びプログラム

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20090303122A1 (en) * 2008-04-15 2009-12-10 Mediatek Inc. Method and device for using gnss satellite trajectory extension data in mobile apparatus
KR20140078158A (ko) * 2012-12-17 2014-06-25 주식회사 만도 카메라를 이용한 추측항법 기반 네비게이션 시스템 및 그 제어방법
JP2017058235A (ja) * 2015-09-16 2017-03-23 株式会社デンソー 車両位置補正装置
CN110869864A (zh) * 2017-07-07 2020-03-06 罗伯特·博世有限公司 用于定位较高程度自动化的车辆的方法以及相应的驾驶员辅助系统和计算机程序
CN111337953A (zh) * 2020-05-21 2020-06-26 深圳市西博泰科电子有限公司 卫星导航欺骗检测方法、装置、设备及介质
CN111856541A (zh) * 2020-07-24 2020-10-30 苏州中亿通智能系统有限公司 一种固定线路车辆轨迹监测系统及方法
WO2022176093A1 (ja) * 2021-02-18 2022-08-25 三菱重工機械システム株式会社 異常検知システム、車載器、異常検知方法、及びプログラム
CN114637770A (zh) * 2022-02-23 2022-06-17 中国第一汽车股份有限公司 车辆轨迹的预测方法、装置

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
WON, DH 等: "GNSS Carrier Phase Anomaly Detection and Validation for Precise Land Vehicle Positioning", IEEE TRANSACTIONS ON INSTRUMENTATION AND MEASUREMENT, vol. 64, no. 9, 1 September 2015 (2015-09-01), pages 2389 - 2398, XP011665372, DOI: 10.1109/TIM.2015.2415091 *
范顺西 等: "GNSS卫星运行异常状态监测及实现", 中国卫星导航系统管理办公室学术交流中心.第七届中国卫星导航学术年会论文集, 18 May 2016 (2016-05-18), pages 1 - 8 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117092665A (zh) * 2023-08-03 2023-11-21 广州海格晶维信息产业有限公司 一种组合导航设备抗多径干扰的方法及系统
CN117092665B (zh) * 2023-08-03 2024-04-19 广州海格晶维信息产业有限公司 一种组合导航设备抗多径干扰的方法及系统
CN116794692A (zh) * 2023-08-25 2023-09-22 华信正能集团有限公司 一种卫星导航定位服务异常检测方法

Also Published As

Publication number Publication date
CN115390103B (zh) 2024-10-01

Similar Documents

Publication Publication Date Title
US10800451B2 (en) Vehicle drive assist apparatus
CN115390103B (zh) 卫星定位信号的异常检测方法、装置及电子设备
US11408741B2 (en) Self-localization estimation device
WO2015122121A1 (ja) ホスト車走行位置特定装置及びホスト車走行位置特定プログラム製品
CN113791435B (zh) Gnss信号异常值的检测方法、装置及电子设备、存储介质
CN115184976B (zh) 自动驾驶车辆的定位方法、装置及电子设备、存储介质
CN115257787A (zh) 自动驾驶车辆的行驶方法和装置、电子设备和存储介质
US20140200768A1 (en) Vehicle travel assisting device
CN113899374B (zh) 自动驾驶车辆定位方法、装置及电子设备、存储介质
CN115056801B (zh) 自动驾驶的多路径识别方法、装置及电子设备、存储介质
JP6330732B2 (ja) 制御装置,及び支援システム
CN115390086B (zh) 用于自动驾驶的融合定位方法、装置及电子设备、存储介质
US11577736B2 (en) Method and device for ascertaining a highly accurate estimated value of a yaw rate for controlling a vehicle
CN114894214A (zh) 自动驾驶车辆的融合定位方法、装置及电子设备
CN113232658A (zh) 一种车辆定位方法、装置、电子设备和存储介质
CN114812595A (zh) 用于融合定位的状态预警方法、装置及电子设备、存储介质
CN115950441B (zh) 自动驾驶车辆的融合定位方法、装置及电子设备
CN115856976B (zh) 自动驾驶车辆的融合定位方法、装置及电子设备
CN115856979B (zh) 自动驾驶车辆的定位方法、装置及电子设备、存储介质
CN114739416A (zh) 自动驾驶车辆定位方法、装置及电子设备、存储介质
CN116148821A (zh) 激光雷达的外参修正方法和装置、电子设备和存储介质
CN115900735A (zh) 车辆定位方法、装置、车辆及存储介质
CN114910083A (zh) 定位方法以及定位装置、电子设备、存储介质
CN116559899B (zh) 自动驾驶车辆的融合定位方法、装置和电子设备
CN116518986B (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