CN112638738A - 车辆测速装置的故障诊断方法和故障诊断装置 - Google Patents

车辆测速装置的故障诊断方法和故障诊断装置 Download PDF

Info

Publication number
CN112638738A
CN112638738A CN202080004603.2A CN202080004603A CN112638738A CN 112638738 A CN112638738 A CN 112638738A CN 202080004603 A CN202080004603 A CN 202080004603A CN 112638738 A CN112638738 A CN 112638738A
Authority
CN
China
Prior art keywords
vehicle
speed
vehicle speed
moments
reference object
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
CN202080004603.2A
Other languages
English (en)
Other versions
CN112638738B (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.)
Huawei Technologies Co Ltd
Original Assignee
Huawei Technologies 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 Huawei Technologies Co Ltd filed Critical Huawei Technologies Co Ltd
Publication of CN112638738A publication Critical patent/CN112638738A/zh
Application granted granted Critical
Publication of CN112638738B publication Critical patent/CN112638738B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/0205Diagnosing or detecting failures; Failure detection models
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W40/00Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models
    • B60W40/10Estimation or calculation of non-directly measurable driving parameters for road vehicle drive control systems not related to the control of a particular sub unit, e.g. by using mathematical models related to vehicle motion
    • B60W40/105Speed
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01PMEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
    • G01P21/00Testing or calibrating of apparatus or devices covered by the preceding groups
    • G01P21/02Testing or calibrating of apparatus or devices covered by the preceding groups of speedometers
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/0205Diagnosing or detecting failures; Failure detection models
    • B60W2050/021Means for detecting failure or malfunction
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W50/00Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
    • B60W50/02Ensuring safety in case of control system failures, e.g. by diagnosing, circumventing or fixing failures
    • B60W50/0205Diagnosing or detecting failures; Failure detection models
    • B60W2050/0215Sensor drifts or sensor failures
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/20Static objects
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B60VEHICLES IN GENERAL
    • B60WCONJOINT CONTROL OF VEHICLE SUB-UNITS OF DIFFERENT TYPE OR DIFFERENT FUNCTION; CONTROL SYSTEMS SPECIALLY ADAPTED FOR HYBRID VEHICLES; ROAD VEHICLE DRIVE CONTROL SYSTEMS FOR PURPOSES NOT RELATED TO THE CONTROL OF A PARTICULAR SUB-UNIT
    • B60W2554/00Input parameters relating to objects
    • B60W2554/80Spatial relation or speed relative to objects

Landscapes

  • Engineering & Computer Science (AREA)
  • Automation & Control Theory (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Mathematical Physics (AREA)
  • Human Computer Interaction (AREA)
  • General Physics & Mathematics (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)

Abstract

本申请提供了一种车辆测速装置的故障诊断方法和故障诊断装置,该方法包括:获取测速装置测得的第一车速;获取静态参照物的N个时刻的参照信息,N为大于1的整数,该参照信息包括静态参照物在该N个时刻中的每个时刻相对于测速装置所在的车辆的位置关系的信息;根据参照信息计算第二车速;根据第一车速和第二车速,判断测速装置是否故障。在该方案中不需要依赖于车辆的自车动力信息,因此不会受每种自车动力信息所覆盖范围的局限,应用在智能汽车、网联汽车、新能源汽车、自动驾驶/智能驾驶汽车上,具有更广的诊断范围,从而可以更为准确地诊断出测速装置的故障。

Description

车辆测速装置的故障诊断方法和故障诊断装置
技术领域
本申请涉及车辆技术领域,尤其涉及一种车辆测速装置的故障诊断方法和装置。
背景技术
车速信息是车辆行驶控制的重要信息,汽车的各类电子控制装置,例如车身电子稳定系统(electronic stability program,ESP)、防抱死制动系统(anti-lock brakingsystem,ABS)、牵引力控制系统(traction control system,TCS)、车辆导航等等,都需要利用车速信息来产生控制信号,而如果测速装置(例如车速传感器)导致车速测量不准,就会导致控制信号的错误,还会带来严重的安全问题,因此确定测速装置是否存在故障是十分重要的。
常见的测速装置的诊断方法均是将除了车速信息以外的自车动力信息(可以理解为与车辆运动相关的信息,或者可以理解为会影响车速的信息)作为诊断的依据,从而判断车速是否准确,进而确定测速装置是否工作正常。例如,采用电气性故障诊断方法,当检测到电气故障的时候就可以判定初速传感器无法正常工作,但这种方法只能检测开路或短路等连接性故障。又例如,依据发动机转速转矩及换挡制动信号来诊断的方式,相当于根据转速转矩、制动信号这些信息来推算出一个车速跟测速装置测到的车速来比较,如果不一致就认为测速装置存在故障,但这种方式在车辆爬坡的时候是无法诊断的。再例如,依据车轮的轮速来诊断的方式,相当于根据轮速推断出一个车速跟测速装置测到的车速来比较,如果不一致就认为测速装置存在故障,但这种方式在车轮打滑或卡死的时候是无法诊断的。
简而言之,上述利用其他自车动力信息作为诊断依据的诊断方法,但只能在其各自特定的情况下才能有效,诊断范围非常局限,一旦超出其诊断范围就会失效。
因此,如何更准确地诊断出测速装置的故障,是亟待解决的问题。
发明内容
本申请提供了一种车辆测速装置的故障诊断方法和装置,诊断范围广,能够更准确地诊断出测速装置的故障。
第一方面,提供一种车辆测速装置的故障诊断方法,该方法包括:获取测速装置测得的第一车速;获取静态参照物的N个时刻的参照信息,N为大于1的整数,参照信息包括静态参照物在N个时刻中的每个时刻相对于测速装置所在的车辆的位置关系的信息;根据参照信息计算第二车速;根据第一车速和第二车速,判断测速装置是否故障。
在本申请技术方案中,利用车辆以外的参照物估算车速,进而跟测速装置测得的车速进行比较,从而可以判定测速装置是否故障,这种方案不需要依赖于车辆的自车动力信息,因此不会受每种自车动力信息所覆盖范围的局限,所以可以具有更广的诊断范围,从而可以更为准确地诊断出测速装置的故障。
需要说明的是,在本申请实施例中,第二车速用于表示估计得到的车速,或者可以理解为推算出的车速,还可以理解为非测速装置测得的车速。
可选地,该N个时刻可以是连续的时刻,也可以是不连续的时刻,只要与第一车速所对应的时刻接近即可。
可选地,可以选取与第一车速所对应的时刻的是时间长度在一定阈值范围内的N个时刻。也就是说,假设第一车速是在T1时刻测得的,时间长度阈值范围为Δt,就可以选取[T1-Δt,T1+Δt]范围内的N个时刻。应理解,该N个时刻不一定必须包括T1,例如可以选取T1+1到T1+N这N个时刻,还应理解N个时刻可以是连续的,也可是不连续的,不存在限定。
可选地,可以直接设定静态参照物为某种路标或交通设施等,使得一旦识别到该路标或交通设施就开始执行故障诊断的各个步骤。
可选地,还可以通过获取车辆周围物体,从识别出的物体中选择出静态的物体,以及从静态的物体中选取静态参照物。
结合第一方面,在第一方面的某些实现方式中,在获取静态参照物的参照信息之前,故障诊断方法还包括:利用车辆的感知设备,识别车辆周围的物体;以及从识别出的物体中选取静态参照物。
可选地,该感知设备可以包括摄像头或雷达。
需要说明的是,在本申请实施例中,无论是平面道路还是有坡度的道路、无论是车辆直线行驶还是转弯行驶,都可以根据静态参照物与车辆的相对关系以及获取静态参照物的时间间隔来估算出第二车速。下面分别针对不同的道路情况和不同的车辆行驶情况进行介绍。
结合第一方面,在第一方面的某些实现方式中,在计算第二车速时,还可以采用下面的方法:利用N个时刻的参照信息,也就是N个时刻的静态参照物相对于车辆的位置关系,计算得到至少一个估计车速,估计车速为N个时刻中的任意两个时刻之间的平均车速;对至少一个估计车速进行处理,得到第二车速。
结合第一方面,在第一方面的某些实现方式中,当车辆与静态参照物在同一道路平面且车辆为直线行驶时,可以执行下面的操作:
利用静态参照物相对于车辆的距离、静态参照物与车辆行驶方向之间夹角,计算得到两个时刻之间车辆相对于静态参照物的位移;
利用位移和两个时刻之间的时间长度,计算得到两个时刻之间的平均速度。
结合第一方面,在第一方面的某些实现方式中,当车辆与静态参照物在同一道路平面且车辆为转弯行驶时,可以执行下面的操作:
利用静态参照物与车辆之间的距离、车辆的车轮转向角、车辆的长度,计算得到两个时刻之间车辆的转向角度、车辆的转向半径;
利用转向角度、转向半径和两个时刻之间的时间长度,计算得到两个时刻之间的平均速度。
结合第一方面,在第一方面的某些实现方式中,当车辆与静态参照物不在同一道路平面且车辆为直线行驶时,可以执行下面的操作:
建立任意三维坐标系,并表示出静态参照物的坐标、车辆在两个时刻的位置坐标;
根据静态参照物的坐标、车辆在两个时刻的位置坐标,计算得到两个时刻之间车辆相对于静态参照物的位移;
利用位移和两个时刻之间的时间长度,计算得到两个时刻之间的平均速度。
结合第一方面,在第一方面的某些实现方式中,当车辆与静态参照物不在同一道路平面且车辆为转弯行驶时,可以执行下面的操作:
建立任意三维坐标系,并表示出静态参照物的坐标、车辆在两个时刻的位置的坐标;
利用静态参照物与车辆之间的距离、车辆的车轮转向角、车辆的长度,计算得到两个时刻之间车辆的转向角度、车辆的转向半径;
利用转向角度、转向半径和两个时刻之间的时间长度,计算得到两个时刻之间的平均速度。
可选地,可以通过求均值、取最大值、取最小值等方式获得第二车速。下面分别举例说明。应理解,只有一个估计车速的时候,无论是上述求平均值、取最大值、取最小值中的任意一种方式,计算结果都等于估计车速本身,在这种情况下,该估计车速即为第二车速。下面主要介绍当为多个估计车速的时候的处理方式,但应理解,只有一个估计车速可以看作是多个估计车速的特例。
例如,可以将多个估计车速求平均值,得到平均估计车速,并将该平均估计车速作为第二车速。
又例如,可以从多个估计车速中,选择最大值作为第二车速。
又例如,可以从多个估计车速中,选择最小值作为第二车速。
又例如,可以去掉一个最大值和/或去掉一个最小值,再将剩余的估计车速的平均值作为第二车速。
结合第一方面,在第一方面的某些实现方式中,在对至少一个估计车速进行处理得到第二车速时,可以对至少一个估计车速进行均值滤波或中值滤波,将滤波之后得到的车速作为第二车速。
可选地,可以根据第一车速和第二车速的差值,判断测速装置是否故障。当该差值在一定阈值范围内的时候,认为第一车速正确,测速装置无故障。当该差值不在该阈值范围内的时候,认为第一车速错误,测速装置故障。
结合第一方面,在第一方面的某些实现方式中,在根据第一车速和第二车速判断测速装置是否故障时,可以采用下面的方法:
当第一车速与第二车速之间的差距大于第一预设阈值时,认为测速装置故障;
当第一车速与第二车速之间的差距小于或等于第一预设阈值时,认为测速装置没有故障。
可选地,为了防止第二车速估算错误或者误差较大,导致对于故障的诊断出现错误,可以计算得到多个第二车速,之后当多个第二车速之间的误差较大的时候,不进行故障诊断,也就是说,估算不准确的时候不作为诊断依据。
可选地,可以利用同一个静态参照物,根据上述方法得到多个第二车速,也可以设置多个静态参照物,根据上述方法得到该多个参照物的第二车速。
以两个第二车速为例,可以分别比较两个第二车速与第一车速之间的差值,只有当两个差值均小于或等于设定阈值的时候才认为车速传感器故障,否则重新获取第二车速。
又例如还可以设定为,当两个第二车速中任意一个第二车速与第一车速的差值大于某一阈值的时候,就重新获取第二车速。
三个以上第二车速的情况与之相似,不再重复介绍。
结合第一方面,在第一方面的某些实现方式中,静态参照物可以为多个,在这种情况下可以获取该多个静态参照物的参照信息;根据参照信息,计算得到多个第二车速;根据第一车速和多个第二车速,判断测速装置是否故障。
需要说明的是,获取该多个静态参照物的参照信息,可以理解为获取该多个静态参照物中的每个静态参照物的多个时刻的参照信息。
结合第一方面,在第一方面的某些实现方式中,在根据第一车速和多个第二车速,判断测速装置是否故障时,当多个第二车速之间的差距大于第二预设阈值时,可以重新获取第二车速;当多个第二车速之间的差距小于或等于第二预设阈值时,可以判断测速装置是否故障。
第二方面,提供一种车辆测速装置的故障诊断装置,该装置包括用于执行上述第一方面的任意一种实现方式的方法的单元。
第三方面,提供一种芯片,所述芯片包括处理器与数据接口,所述处理器通过所述数据接口读取存储器上存储的指令,执行上述第一方面的任意一种实现方式中的方法。
可选地,作为一种实现方式,所述芯片还可以包括存储器,所述存储器中存储有指令,所述处理器用于执行所述存储器上存储的指令,当所述指令被执行时,所述处理器用于执行第一方面的任意一种实现方式中的方法。
第四方面,提供一种车辆,该车辆包括第二方面任意一种故障诊断装置,以及测速装置,该故障诊断装置用于对该测速装置进行故障诊断。
第五方面,提供一种计算机可读介质,该计算机可读介质存储用于设备执行的程序代码,该程序代码包括用于执行第一方面的任意一种实现方式中的方法。
第六方面,提供一种包含指令的计算机程序产品,当该计算机程序产品在计算机上运行时,使得计算机执行上述第一方面的任意一种实现方式中的方法。
附图说明
图1是本申请实施例适用的一种车辆的功能框图。
图2是本申请实施例适用的一种自动驾驶系统的示意图。
图3是本申请实施例的一种云侧指令自动驾驶车辆的应用示意图。
图4是本申请实施例的故障诊断装置及其应用的示意图。
图5是本申请实施例的测速装置的故障诊断方法的示意性流程图。
图6是本申请实施例的选择静态参照物的示意性流程图。
图7是本申请实施例的一种估算车速的方法的示意性流程图。
图8是本申请实施例的平面道路场景的直行车速估算示意图。
图9是本申请实施例的另一种估算车速的方法的示意性流程图。
图10是本申请实施例的平面道路场景的转弯车速估算示意图。
图11是本申请实施例的一种坡道场景的车速估算示意图。
图12是本申请实施例的另一种坡道场景的车速估算示意图。
图13是本申请实施例的一种车辆测速装置的故障诊断装置的示意图。
图14是本申请实施例的一种车辆测速装置的故障诊断装置的示意图。
具体实施方式
本申请实施例所提供的车辆测速装置的故障诊断方法和/或装置可以应用于各类车辆。这些方法和/或装置既可以应用于人工驾驶,又可以应用于辅助驾驶,还可以应用于自动驾驶。下面结合附图,对本申请实施例的技术方案进行介绍。
图1是本申请实施例适用的一种车辆的功能框图。其中,车辆100可以是人工驾驶车辆,或者可以将车辆100配置可以为完全或部分地自动驾驶模式。
在一个示例中,车辆100可以在处于自动驾驶模式中的同时控制自车,并且可通过人为操作来确定车辆及其周边环境的当前状态,确定周边环境中的至少一个其他车辆的可能行为,并确定其他车辆执行可能行为的可能性相对应的置信水平,基于所确定的信息来控制车辆100。在车辆100处于自动驾驶模式中时,可以将车辆100置为在没有和人交互的情况下操作。
车辆100中可以包括各种子系统,例如,行进系统110、传感系统120、控制系统130、一个或多个外围设备140以及电源160、计算机系统150和用户接口170。
可选地,车辆100可以包括更多或更少的子系统,并且每个子系统可包括多个元件。另外,车辆100的每个子系统和元件可以通过有线或者无线互连。
示例性地,行进系统110可以包括用于向车辆100提供动力运动的组件。在一个实施例中,行进系统110可以包括引擎111、传动装置112、能量源113和车轮114/轮胎。其中,引擎111可以是内燃引擎、电动机、空气压缩引擎或其他类型的引擎组合;例如,汽油发动机和电动机组成的混动引擎,内燃引擎和空气压缩引擎组成的混动引擎。引擎111可以将能量源113转换成机械能量。
示例性地,能量源113可以包括汽油、柴油、其他基于石油的燃料、丙烷、其他基于压缩气体的燃料、乙醇、太阳能电池板、电池和其他电力来源。能量源113也可以为车辆100的其他系统提供能量。
示例性地,传动装置112可以包括变速箱、差速器和驱动轴;其中,传动装置112可以将来自引擎111的机械动力传送到车轮114。
在一个实施例中,传动装置112还可以包括其他器件,比如离合器。其中,驱动轴可以包括可耦合到一个或多个车轮114的一个或多个轴。
示例性地,传感系统120可以包括感测关于车辆100周边的环境的信息的若干个传感器。
例如,传感系统120可以包括定位系统121(例如,全球定位系统(globalpositioning system,GPS)、北斗系统或者其他定位系统)、惯性测量单元(inertialmeasurement unit,IMU)122、雷达123、激光测距仪124、相机125以及车速传感器126。传感系统120还可以包括被监视车辆100的内部系统的传感器(例如,车内空气质量监测器、燃油量表、机油温度表等)。来自这些传感器中的一个或多个的传感器数据可用于检测对象及其相应特性(位置、形状、方向、速度等)。这种检测和识别是自主车辆100的安全操作的关键功能。
其中,定位系统121可以用于估计车辆100的地理位置。IMU 122可以用于基于惯性加速度来感测车辆100的位置和朝向变化。在一个实施例中,IMU 122可以是加速度计和陀螺仪的组合。
示例性地,雷达123可以利用无线电信号来感测车辆100的周边环境内的物体。在一些实施例中,除了感测物体以外,雷达123还可用于感测物体的速度和/或前进方向。
示例性地,激光测距仪124可以利用激光来感测车辆100所位于的环境中的物体。在一些实施例中,激光测距仪124可以包括一个或多个激光源、激光扫描器以及一个或多个检测器,以及其他系统组件。
示例性地,相机125可以用于捕捉车辆100的周边环境的多个图像。例如,相机125可以是静态相机或视频相机。
示例性地,车速传感器126可以用于测量车辆100的速度。例如,可以对车辆进行实时测速。测得的车速可以传送给控制系统130以实现对车辆的控制。
如图1所示,控制系统130为控制车辆100及其组件的操作。控制系统130可以包括各种元件,比如可以包括转向系统131、油门132、制动单元133、计算机视觉系统134、路线控制系统135以及障碍规避系统136。
示例性地,转向系统131可以操作来调整车辆100的前进方向。例如,在一个实施例中可以为方向盘系统。油门132可以用于控制引擎111的操作速度并进而控制车辆100的速度。
示例性地,制动单元133可以用于控制车辆100减速;制动单元133可以使用摩擦力来减慢车轮114。在其他实施例中,制动单元133可以将车轮114的动能转换为电流。制动单元133也可以采取其他形式来减慢车轮114转速从而控制车辆100的速度。
如图1所示,计算机视觉系统134可以操作来处理和分析由相机125捕捉的图像以便识别车辆100周边环境中的物体和/或特征。上述物体和/或特征可以包括交通信号、道路边界和障碍物。计算机视觉系统134可以使用物体识别算法、运动中恢复结构(structurefrom motion,SFM)算法、视频跟踪和其他计算机视觉技术。在一些实施例中,计算机视觉系统134可以用于为环境绘制地图、跟踪物体、估计物体的速度等等。
示例性地,路线控制系统135可以用于确定车辆100的行驶路线。在一些实施例中,路线控制系统135可结合来自传感器、GPS和一个或多个预定地图的数据以为车辆100确定行驶路线。
如图1所示,障碍规避系统136可以用于识别、评估和避免或者以其他方式越过车辆100的环境中的潜在障碍物。
在一个实例中,控制系统130可以增加或替换地包括除了所示出和描述的那些以外的组件。或者也可以减少一部分上述示出的组件。
如图1所示,车辆100可以通过外围设备140与外部传感器、其他车辆、其他计算机系统或用户之间进行交互;其中,外围设备140可包括无线通信系统141、车载电脑142、麦克风143和/或扬声器144。
在一些实施例中,外围设备140可以提供车辆100与用户接口170交互的手段。例如,车载电脑142可以向车辆100的用户提供信息。用户接口116还可操作车载电脑142来接收用户的输入;车载电脑142可以通过触摸屏进行操作。在其他情况中,外围设备140可以提供用于车辆100与位于车内的其它设备通信的手段。例如,麦克风143可以从车辆100的用户接收音频(例如,语音命令或其他音频输入)。类似地,扬声器144可以向车辆100的用户输出音频。
如图1所述,无线通信系统141可以直接地或者经由通信网络来与一个或多个设备无线通信。例如,无线通信系统141可以使用3G蜂窝通信;例如,码分多址(code divisionmultiple access,CDMA))、EVD0、全球移动通信系统(global system for mobilecommunications,GSM)/通用分组无线服务(general packet radio service,GPRS),或者4G蜂窝通信,例如长期演进(long term evolution,LTE);或者,5G蜂窝通信。无线通信系统141可以利用无线上网(WiFi)与无线局域网(wireless local area network,WLAN)通信。
在一些实施例中,无线通信系统141可以利用红外链路、蓝牙或者紫蜂协议(ZigBee)与设备直接通信;其他无线协议,例如各种车辆通信系统,例如,无线通信系统141可以包括一个或多个专用短程通信(dedicated short range communications,DSRC)设备,这些设备可包括车辆和/或路边台站之间的公共和/或私有数据通信。
如图1所示,电源160可以向车辆100的各种组件提供电力。在一个实施例中,电源160可以为可再充电锂离子电池或铅酸电池。这种电池的一个或多个电池组可被配置为电源为车辆100的各种组件提供电力。在一些实施例中,电源160和能量源113可一起实现,例如一些全电动车中那样。
示例性地,车辆100的部分或所有功能可以受计算机系统150控制,其中,计算机系统150可以包括至少一个处理器151,处理器151执行存储在例如存储器152中的非暂态计算机可读介质中的指令153。计算机系统150还可以是采用分布式方式控制车辆100的个体组件或子系统的多个计算设备。
例如,处理器151可以是任何常规的处理器,诸如商业可获得的中央处理器(central processing unit,CPU)。
可选地,该处理器可以是诸如专用集成电路(application specific integratedcircuit,ASIC)或其它基于硬件的处理器的专用设备。尽管图1功能性地图示了处理器、存储器、和在相同块中的计算机的其它元件,但是本领域的普通技术人员应该理解该处理器、计算机、或存储器实际上可以包括可以或者可以不存储在相同的物理外壳内的多个处理器、计算机或存储器。例如,存储器可以是硬盘驱动器或位于不同于计算机的外壳内的其它存储介质。因此,对处理器或计算机的引用将被理解为包括对可以或者可以不并行操作的处理器或计算机或存储器的集合的引用。不同于使用单一的处理器来执行此处所描述的步骤,诸如转向组件和减速组件的一些组件每个都可以具有其自己的处理器,所述处理器只执行与特定于组件的功能相关的计算。
在此处所描述的各个方面中,处理器可以位于远离该车辆并且与该车辆进行无线通信。在其它方面中,此处所描述的过程中的一些在布置于车辆内的处理器上执行而其它则由远程处理器执行,包括采取执行单一操纵的必要步骤。
在一些实施例中,存储器152可包含指令153(例如,程序逻辑),指令153可以被处理器151来执行车辆100的各种功能,包括以上描述的那些功能。存储器152也可包括额外的指令,比如包括向行进系统110、传感系统120、控制系统130和外围设备140中的一个或多个发送数据、从其接收数据、与其交互和/或对其进行控制的指令。
示例性地,除了指令153以外,存储器152还可存储数据,例如,道路地图、路线信息,车辆的位置、方向、速度以及其它这样的车辆数据,以及其他信息。这种信息可在车辆100在自主、半自主和/或手动模式中操作期间被车辆100和计算机系统150使用。
如图1所示,用户接口170可以用于向车辆100的用户提供信息或从其接收信息。可选地,用户接口170可以包括在外围设备140的集合内的一个或多个输入/输出设备,例如,无线通信系统141、车载电脑142、麦克风143和扬声器144。
在本申请的实施例中,计算机系统150可以基于从各种子系统(例如,行进系统110、传感系统120和控制系统130)以及从用户接口170接收的输入来控制车辆100的功能。例如,计算机系统150可以利用来自控制系统130的输入以便控制制动单元133来避免由传感系统120和障碍规避系统136检测到的障碍物。在一些实施例中,计算机系统150可操作来对车辆100及其子系统的许多方面提供控制。
可选地,上述这些组件中的一个或多个可与车辆100分开安装或关联。例如,存储器152可以部分或完全地与车辆100分开存在。上述组件可以按有线和/或无线方式来通信地耦合在一起。
可选地,上述组件只是一个示例,实际应用中,上述各个模块中的组件有可能根据实际需要增添或者删除,图1不应理解为对本申请实施例的限制。
可选地,车辆100可以是在道路行进的自动驾驶汽车,可以识别其周围环境内的物体以确定对当前速度的调整。物体可以是其它车辆、交通控制设备、或者其它类型的物体。在一些示例中,可以独立地考虑每个识别的物体,并且基于物体的各自的特性,诸如它的当前速度、加速度、与车辆的间距等,可以用来确定自动驾驶汽车所要调整的速度。
可选地,车辆100或者与车辆100相关联的计算设备(如图1的计算机系统150、计算机视觉系统134、存储器152)可以基于所识别的物体的特性和周围环境的状态(例如,交通、雨、道路上的冰等等)来预测所述识别的物体的行为。
可选地,每一个所识别的物体都依赖于彼此的行为,因此,还可以将所识别的所有物体全部一起考虑来预测单个识别的物体的行为。车辆100能够基于预测的所述识别的物体的行为来调整它的速度。换句话说,自动驾驶汽车能够基于所预测的物体的行为来确定车辆将需要调整到(例如,加速、减速、或者停止)稳定状态。在这个过程中,也可以考虑其它因素来确定车辆100的速度,诸如,车辆100在行驶的道路中的横向位置、道路的曲率、静态和动态物体的接近度等等。
除了提供调整自动驾驶汽车的速度的指令之外,计算设备还可以提供修改车辆100的转向角的指令,以使得自动驾驶汽车遵循给定的轨迹和/或维持与自动驾驶汽车附近的物体(例如,道路上的相邻车道中的轿车)的安全横向和纵向距离。
上述车辆100可以为轿车、卡车、摩托车、公共汽车、船、飞机、直升飞机、割草机、娱乐车、游乐场车辆、施工设备、电车、高尔夫球车、火车、和手推车等,本申请实施例不做特别的限定。
在一种可能的实现方式中,上述图1所示的车辆100可以是自动驾驶车辆,下面对自动驾驶系统的进行详细描述。
图2是本申请实施例适用的一种自动驾驶系统的示意图。
如图2所示的自动驾驶系统包括计算机系统201,其中,计算机系统201包括处理器203,处理器203和系统总线205耦合。处理器203可以是一个或者多个处理器,其中,每个处理器都可以包括一个或多个处理器核。显示适配器207(video adapter),显示适配器可以驱动显示器209,显示器209和系统总线205耦合。系统总线205可以通过总线桥211和输入输出(I/O)总线213耦合,I/O接口215和I/O总线耦合。I/O接口215和多种I/O设备进行通信,比如,输入设备217(如:键盘,鼠标,触摸屏等),媒体盘221(media tray),(例如,CD-ROM,多媒体接口等)。收发器223可以发送和/或接受无线电通信信号,摄像头255可以捕捉景田和动态数字视频图像。其中,和I/O接口215相连接的接口可以是USB端口225。
其中,处理器203可以是任何传统处理器,比如,精简指令集计算(reducedinstruction set computer,RISC)处理器、复杂指令集计算(complex instruction setcomputer,CISC)处理器或上述的组合。
可选地,处理器203可以是诸如专用集成电路(ASIC)的专用装置;处理器203可以是神经网络处理器或者是神经网络处理器和上述传统处理器的组合。
可选地,在一些实施例中,计算机系统201可位于远离自动驾驶车辆的地方,并且可与自动驾驶车辆无线通信。在其它方面,本申请所述的一些过程在设置在自动驾驶车辆内的处理器上执行,其它由远程处理器执行,包括采取执行单个操纵所需的动作。
计算机系统201可以通过网络接口229和软件部署服务器249通信。网络接口229可以是硬件网络接口,比如,网卡。网络227可以是外部网络,比如,因特网,也可以是内部网络,比如以太网或者虚拟私人网络(virtual private network,VPN)。可选地,网络227还可以是无线网络,比如WiFi网络,蜂窝网络等。
如图2所示,硬盘驱动接口和系统总线205耦合,硬件驱动器接口231可以与硬盘驱动器233相连接,系统内存235和系统总线205耦合。运行在系统内存235的数据可以包括操作系统237和应用程序243。其中,操作系统237可以包括解析器(shell)239和内核(kernel)241。shell 239是介于使用者和操作系统之内核(kernel)间的一个接口。shell可以是操作系统最外面的一层;shell可以管理使用者与操作系统之间的交互,比如,等待使用者的输入,向操作系统解释使用者的输入,并且处理各种各样的操作系统的输出结果。内核241可以由操作系统中用于管理存储器、文件、外设和系统资源的那些部分组成。直接与硬件交互,操作系统内核通常运行进程,并提供进程间的通信,提供CPU时间片管理、中断、内存管理、IO管理等等。应用程序243包括控制汽车自动驾驶相关的程序,比如,管理自动驾驶的汽车和路上障碍物交互的程序,控制自动驾驶汽车路线或者速度的程序,控制自动驾驶汽车和路上其他自动驾驶汽车交互的程序。应用程序243也存在于软件部署服务器249的系统上。在一个实施例中,在需要执行自动驾驶相关程序247时,计算机系统201可以从软件部署服务器249下载应用程序。
例如,应用程序243还可以是自动驾驶汽车和路上车道线交互的程序,也就是说可以实时跟踪车道线的程序。
例如,应用程序243还可以是控制自动驾驶车辆进行自动泊车的程序。
示例性地,传感器253可以与计算机系统201关联,传感器253可以用于探测计算机201周围的环境。
举例来说,传感器253可以探测路上的车道,比如可以探测到车道线,并能够在车辆移动(如正在行驶)过程中实时跟踪到车辆前方一定范围内的车道线变化。又例如,传感器253可以探测动物,汽车,障碍物和人行横道等,进一步传感器还可以探测上述动物,汽车,障碍物和人行横道等物体周围的环境,比如:动物周围的环境,例如,动物周围出现的其他动物,天气条件,周围环境的光亮度等。
可选地,如果计算机201位于自动驾驶的汽车上,传感器可以是摄像头,红外线感应器,化学检测器,麦克风等。
示例性地,在车道线跟踪的场景中,传感器253可以用于探测车辆前方的车道线,从而使得车辆能够感知在行进过程中车道的变化,以据此对车辆的行驶进行实时规划和调整。
示例性地,在自动泊车的场景中,传感器253可以用于探测车辆周围的库位和周边障碍物的尺寸或者位置,从而使得车辆能够感知库位和周边障碍物的距离,在泊车时进行碰撞检测,防止车辆与障碍物发生碰撞。
在一个示例中,图1所示的计算机系统150还可以从其它计算机系统接收信息或转移信息到其它计算机系统。或者,从车辆100的传感系统120收集的传感器数据可以被转移到另一个计算机对此数据进行处理,下面以图3为例进行介绍。
图3是本申请实施例的一种云侧指令自动驾驶车辆的应用示意图。如图3所示,来自计算机系统312的数据可以经由网络被传送到云侧的服务器320用于进一步的处理。网络以及中间节点可以包括各种配置和协议,包括因特网、万维网、内联网、虚拟专用网络、广域网、局域网、使用一个或多个公司的专有通信协议的专用网络、以太网、WiFi和HTTP、以及前述的各种组合;这种通信可以由能够传送数据到其它计算机和从其它计算机传送数据的任何设备,诸如调制解调器和无线接口。
在一个示例中,服务器320可以包括具有多个计算机的服务器,例如负载均衡服务器群,为了从计算机系统312接收、处理并传送数据的目的,其与网络的不同节点交换信息。该服务器可以被类似于计算机系统312配置,具有处理器330、存储器340、指令350、和数据360。
示例性地,服务器320的数据360可以包括车辆周围道路情况的相关信息。例如,服务器320可以接收、检测、存储、更新、以及传送与车辆道路情况的相关信息。
例如,车辆周围道路情况的相关信息包括与车辆周围的其它车辆信息以及障碍物信息。
目前车辆的测速装置主要为车速传感器,但在实际使用过程中,车速传感器会出现故障或短路断路等情况,导致不能测速或者测得的车速不准确,为了保证车辆的安全就需要及时发现车速传感器的故障。在现有技术的方案中,往往借助于其他自车动力信息来推算出一个车速,与测得的车速比较就可以判断出测得的车速是否正常,从而推断出测速装置是否正常工作。但是现有方案的每种方案都没有办法覆盖所有工况,正如上文提到的,只能在一些特定的情况下才能有效,导致诊断范围非常局限。
针对上述问题,本申请实施例提供一种新的测速装置的故障诊断方法和装置,诊断范围广,能够更准确地诊断出测速装置的故障。主要通过利用车辆外部的静态参照物来估算车辆的车速,然后以估算的车速为依据来判断测速装置测得的车速是否正常,从而可以诊断出测速装置是否存在故障。这种方案不需要依赖于车辆的自车动力信息,因此不会受每种自车动力信息所覆盖范围的局限,所以可以具有更广的诊断范围,从而可以更为准确地诊断出测速装置的故障。
需要说明的是,自车动力信息可以理解为与车辆运动相关的信息,或者可以理解为会影响车速的信息,由于自车动力信息(例如转矩、轮速等)与车速是有直接关联性的,也就是说,自车动力信息会直接影响到车速。但是自车动力信息会存在变化,在一些场景下不符合已知的关联性关系,就会导致不能正确推断出车速。例如,在爬坡的时候,转矩与车速的关联性关系被打破,导致不能再利用转矩推算出车速。又例如,在车轮打滑的时候,车辆是继续移动的(车速不为零),但根据轮速推断出来的车速却为零。还有众多其他例子,不再一一列举。简而言之,虽然可以利用自车动力信息推断出车速,从而判断测速装置是否正常工作,但是存在很大的局限性。而在本本申请实施例用来估算车速的是车辆相对于外部参照物的移动,所以只要车辆在动就可以测得,可以覆盖更广的诊断范围。
图4是本申请实施例的故障诊断装置及其应用的示意图。如图4所示,故障诊断装置420从其他装置中获取一些信息,经过一定处理后就可以得到故障诊断结果。
可选地,故障诊断装置420可以包括获取单元421和诊断单元422。
获取单元421可以用于获取一些信息(在本申请实施例中信息可以理解为数据),例如可以获取来自于测速装置411的车速信息,该车速信息包括测速装置所测得的车速。又例如还可以获取来自于环境检测装置413的参照物信息,该参照物中包括至少一个静态参照物的信息。
可选地,环境检测装置413可以是雷达探测装置、摄像头等,例如可以是图1或图2所示的雷达123、激光测距仪124、相机125或摄像头255等。
诊断单元422可以用于对获取单元421获取的信息进行处理,得到故障诊断结果。
可选地,诊断单元422可以根据参照物信息推算出估计车速,再根据估计车速判断测速装置测得的车速是否正确。当判定车速正确时,故障诊断结果即为“无故障”或“正常工作”。当判定车速错误时(没有测得车速为车速错误的一个例子),故障诊断结果即为“故障”或“未正常工作”。需要说明的是,诊断单元422的具体诊断过程会在下面结合各图进行介绍,在此不再展开介绍。
在该方案中,利用车辆以外的参照物估算车速,进而跟测速装置测得的车速进行比较,从而可以判定测速装置是否故障,不需要依赖于车辆的自车动力装置。
需要说明的是,虽然本申请实施例不需要依赖于车辆的自车动力装置就可以判断测速装置是否正常,但是依然可以加入自车动力信息进行诊断,也就是说,可以在上述方案的基础上,增加自车动力信息作为诊断依据的扩充,并不会影响上述方案的实现效果。
可选地,故障检测装置420还可以包括发送单元,用于将故障诊断结果发送给其他模块或装置,例如发送给控制系统,用于生成控制信号,对车辆进行控制。
图5是本申请实施例的测速装置的故障诊断方法的示意性流程图。下面对图5各个步骤进行介绍。
501、获取测速装置测得的第一车速。
502、获取静态参照物的参照信息。
可选地,可以获取N个时刻的参照信息,N为大于1的整数。N个时刻可以为连续的,也可以为非连续的,不存在限定。
可选地,该参照信息可以包括该静态参照物相对于车辆的位置关系的信息,该车辆可以理解为待诊断的测速装置所在的车辆。也就是说,可以获取上述N个时刻中的每个时刻时该静态参照物相对于车辆的位置关系。
可选地,该位置关系可以包括静态参照物相对于车辆的距离和方向。
可选地,静态参照物相对于车辆的方向可以利用静态参照物与车辆的连线与车辆行进方向之间的夹角表示。
需要说明的是,步骤501和步骤502不存在执行顺序的限定,可以同时执行,也可以先执行步骤501,还可以先执行步骤502。
可选地,可以直接设定静态参照物为某种路标或交通设施等,使得一旦识别到该路标或交通设施就开始执行故障诊断的各个步骤。
可选地,还可以通过获取车辆周围物体,从识别出的物体中选择出静态的物体,以及从静态的物体中选取静态参照物。
图6是本申请实施例的选择静态参照物的示意性流程图,下面对图6各个步骤进行介绍。
601、利用感知设备识别车辆周围物体。
可选地,该感知设备可以包括摄像头、雷达。
可选地,可以利用摄像头获取图像或视频,然后对图像进行处理,识别出图像中的物体。
可选地,还可以利用雷达感测物体以及物体是否移动。
602、从识别出的物体中选取至少一个静态参照物。
也就是说,可以从识别出的物体中选取出至少一个静态的物体,以及将静态的物体作为静态参照物。
当选定静态参照物之后,就可以获取静态参照物信息,该静态参照物信息包括静态参照物相对于车辆的距离和静态参照物相对于车辆的方位/方向。即可以执行步骤603。
603、获取静态参照物相对于车辆的距离和方向信息。
需要说明的是,图6主要提供了一种确定静态参照物的方法,步骤603可以执行也可以不执行。
503、根据参照信息,计算第二车速。
需要说明的是,在本申请实施例中,第二车速用于表示估计得到的车速,或者可以理解为推算出的车速,还可以理解为非测速装置测得的车速。
可选地,可以利用上述N个时刻的参照信息计算得到第二车速,也就是说,可以根据一段时间内车辆相对于静态参照物的位移和/或角度的变化量来计算得到这段时间内的平均车速,并将该平均车速作为第二车速,或者还可以得到多个平均车速,然后基于该多个平均车速来得到一个第二车速。由于涉及内容较多,下面会结合图7至图12进行介绍,在此不再展开。
需要说明的是,步骤503需要在步骤502之后执行,但不一定需要在步骤501之后执行,也就是说,可以先执行步骤502和步骤503,再执行步骤501。还可以在执行步骤502和步骤503的任意期间执行步骤501,等等,不存在限定。
504、根据第一车速和第二车速,判断测速装置是否故障。
可选地,可以根据第一车速和第二车速的差值,判断测速装置是否故障。当该差值在一定阈值范围内的时候,认为第一车速正确,测速装置无故障。当该差值不在该阈值范围内的时候,认为第一车速错误,测速装置故障。
可选地,为了防止第二车速估算错误或者误差较大,导致对于故障的诊断出现错误,可以计算得到多个第二车速,之后当多个第二车速之间的误差较大的时候,不进行故障诊断,也就是说,估算不准确的时候不作为诊断依据。
可选地,可以利用同一个静态参照物,根据上述方法得到多个第二车速,也可以设置多个静态参照物,根据上述方法得到该多个参照物的第二车速。
以两个第二车速为例,可以分别比较两个第二车速与第一车速之间的差值,只有当两个差值均小于或等于设定阈值的时候才认为车速传感器故障,否则重新获取第二车速。
又例如还可以设定为,当两个第二车速中任意一个第二车速与第一车速的差值大于某一阈值的时候,就重新获取第二车速。
三个以上第二车速的情况与之相似,不再重复介绍。
图7是本申请实施例的一种估算车速的方法的示意性流程图,图7所示方法可以适用于车辆在平面道路上直线行驶的估算,例如图8所示的平面道路场景中直线行驶的估算。下面对图7各个步骤进行介绍。
701、获取静态参照物的N个时刻的参照信息,N为大于1的整数。
可选地,该参照信息可以包括该静态参照物相对于车辆的位置关系的信息,该车辆可以理解为待诊断的测速装置所在的车辆。也就是说,获取上述N个时刻中的每个时刻时该静态参照物相对于车辆的位置关系。
可选地,该N个时刻可以是连续的时刻,也可以是不连续的时刻,只要与第一车速所对应的时刻接近即可。
可选地,可以选取与第一车速所对应的时刻的是时间长度在一定阈值范围内的N个时刻。也就是说,假设第一车速是在T1时刻测得的,时间长度阈值范围为Δt,就可以选取[T1-Δt,T1+Δt]范围内的N个时刻。应理解,该N个时刻不一定必须包括T1,例如可以选取T1+1到T1+N这N个时刻,还应理解N个时刻可以是连续的,也可是不连续的,不存在限定。
702、计算至少两个时刻之间的至少一个位移ΔS。
需要说明的是,该至少两个时刻是指上述N个时刻中的至少两个时刻,该两个时刻不要求必须是连续的。
还应理解,由于可以计算多于两个时刻之间的位移ΔS,所以位移ΔS可以为一个,也可以为多个。
可选地,可以根据两个时刻静态参照物相对于车辆的距离、车辆前进方向与静态参照物和车辆的连线之间的夹角,计算得到位移。
703、根据上述至少一个位移ΔS和上述至少两个时刻之间的时间长度,计算得到至少一个估计车速V’。
704、根据上述至少一个估计车速V’,得到第二车速。
可选地,可以通过求均值、取最大值、取最小值等方式获得第二车速。下面分别举例说明。应理解,只有一个估计车速的时候,无论是上述求平均值、取最大值、取最小值中的任意一种方式,计算结果都等于估计车速本身,在这种情况下,该估计车速即为第二车速。下面主要介绍当为多个估计车速的时候的处理方式,但应理解,只有一个估计车速可以看作是多个估计车速的特例。
例如,可以将多个估计车速求平均值,得到平均估计车速,并将该平均估计车速作为第二车速。
又例如,可以从多个估计车速中,选择最大值作为第二车速。
又例如,可以从多个估计车速中,选择最小值作为第二车速。
又例如,可以去掉一个最大值和/或去掉一个最小值,再将剩余的估计车速的平均值作为第二车速。
图8是本申请实施例的平面道路场景的直行车速估算示意图。在图8所示场景中,车辆在平地上直线行驶,通过图8所示车辆在两个不同时刻与静态参照物的相对关系,就可以获得两个相邻时刻间的车辆位移,从而获得当前的车辆速度,下面对具体计算过程进行举例介绍。
假设从摄像头获取了相邻N+1个采样时刻下静态参照物与车辆的位置关系。在第i时刻,所选静态参照物与车辆的距离Li,所选静态参照物与当前车辆连线和车辆行驶方向的夹角αi;在第i+1时刻,所选静态参照物与车辆的距离Li+1,所选静态参照物与当前车辆连线和车辆行驶方向的夹角αi+1
可以根据车辆在第i时刻和第i+1时刻两个相邻时刻与静态参照物的位置关系,计算车辆在两个时刻的位移ΔS,由图8中几何关系可以推算出:
Figure BDA0002945141440000141
第i时刻和第i+1时刻的时间间隔为Δt,因此,可以推算出第i时刻至第i+1时刻之间的平均速度vi为:vi=ΔS/Δt。
可以将vi看作是图7中所述的估计车速V’。
可选地,可以根据上述同样的方法,计算得到1至N+1时刻之间的N个时间间隔的N个平均速度。
可选地,还可以通过滤波的方式确定第二车速,滤波方式可以是均值滤波、中值滤波等滤波方式的一种,具体可以参考图7相关介绍,不再重复。
图9是本申请实施例的另一种估算车速的方法的示意性流程图,图9所示方法可以适用于车辆在平面道路上转弯行驶的车速估算,例如图10所示的平面道路转弯场景的车速估算。下面对图9各个步骤进行介绍。
901、获取静态参照物的N个时刻的参照信息,N为大于1的整数。
可选地,该参照信息可以包括该静态参照物相对于车辆的位置关系的信息,该车辆可以理解为待诊断的测速装置所在的车辆。也就是说,获取上述N个时刻中的每个时刻时该静态参照物相对于车辆的位置关系。
可选地,该N个时刻可以是连续的时刻,也可以是不连续的时刻,只要与第一车速所对应的时刻接近即可。
可选地,可以选取与第一车速所对应的时刻的是时间长度在一定阈值范围内的N个时刻。也就是说,假设第一车速是在T1时刻测得的,时间长度阈值范围为Δt,就可以选取[T1-Δt,T1+Δt]范围内的N个时刻。应理解,该N个时刻不一定必须包括T1,例如可以选取T1+1到T1+N这N个时刻,还应理解N个时刻可以实连续的,也可是不连续的,不存在限定。
902、计算至少两个时刻之间的至少一个转向角度x。
可选地,可以根据车身长度和车轮转向角计算得到转向半径,再根据转向半径、转向角度之间的几何关系来计算得到转向角度。
需要说明的是,该至少两个时刻是指上述N个时刻中的至少两个时刻,该两个时刻不要求必须是连续的。
还应理解,由于可以计算多于两个时刻之间的转向角度x,所以转向角度x可以为一个,也可以为多个。
903、根据上述至少一个转向角度x,计算得到至少一个估计车速V’。
904、根据上述至少一个估计车速V’,得到第二车速。
可选地,可选采用与步骤704相同的方法得到第二车速,不再重复介绍。
图10是本申请实施例的平面道路场景的转弯车速估算示意图。在图10所示场景中,车辆在平地上转弯行驶,通过图10所示车辆在两个不同时刻与静态参照物的相对关系,就可以获得两个相邻时刻间的车辆转向角度x,从而获得当前的车辆速度,下面对具体计算过程进行举例介绍。
假设从摄像头获取了相邻N个采样时刻下静态参照物与车辆的位置关系,在第i时刻,所选静态参照物与车辆的距离Li,所选静态参照物与当前车辆连线和车辆行驶方向的夹角αi,以及车辆的车轮转向角δi;在第i+1时刻,所选静态参照物与车辆的距离Li+1,所选静态参照物与当前车辆连线和车辆行驶方向的夹角αi+1,以及车辆的车轮转向角δi+1
可以根据车身长度L和第i时刻的车轮转向角δi,计算得到第i时刻的转向半径Ri,并将Ri作为第i时刻至第i+1时刻的转向半径,如图10中标注。
根据图10所示的几何关系,第i时刻至第i+1时刻车辆所行驶过的转向角度x与转向半径Ri等几何量之间的关系为:
x+(90°-αi)=y+(90°-αi+1),
Li 2+Li+1 2-2Li Li+1cosy=2Ri 2-2Ri 2cosx。
通过上面两个式子就可以求解出转向角x。
第i时刻和第i+1时刻的时间间隔为Δt,因此,可以推算出第i时刻至第i+1时刻之间的平均速度vi为:vi=x Ri/Δt。
可以将vi看作是图9中所述的估计车速V’。
可选地,可以根据上述同样的方法,计算得到1至N+1时刻之间的N个时间间隔的N个平均速度。
可选地,还可以通过滤波的方式确定第二车速,滤波方式可以是均值滤波、中值滤波等滤波方式的一种,具体可以参考上文相关介绍,不再重复。
图11是本申请实施例的一种坡道场景的车速估算示意图。在图11所示场景中,静态参照物与车辆同处于坡道,从图11中可以看出,在这种情况下,相当于静态参照物和车辆在同一个平面道路中,此处为在坡道所在平面道路中,因此可以采用与平面道路时完全相同的计算方法,例如,当为直线行驶时可以采用图7或图8所示方法,当为转弯行驶时,可以采用图9或图10所示的方法,为了简洁,在此不再重复介绍。
图12是本申请实施例的另一种坡道场景的车速估算示意图。如图12所示,车辆在坡道上行驶,但静态参照物在坡道前方的平面道路上。可以理解为,图12所示是一种静态参照物与车辆不共面的情况,但应理解,图12所示场景可以看作是车辆在坡道静态参照物在平面道路,但也可以看作是车辆在平面道路,静态参照物在坡道。
对于图12所示场景,可以通过建立三维坐标系的方法,标注出静态参照物的坐标(图12中A点坐标)、车辆在第i时刻的坐标(图12中B点坐标)、车辆在第i+1时刻的坐标(图12中C点坐标),从而可以根据三者的几何关系估算出车辆在第i时刻至第i+1时刻之间的平均车速vi,进而可以得到第二车速。下面进行举例说明。
假设通过车辆加速度传感器估算所处坡道的坡度为γ,通过摄像头获得第i时刻和第i+1时刻相邻两个时刻,静态参照物的距离Li、Li+1及与行驶方向的夹角αi、αi+1
以车辆行驶方向与地平线(图12中所示虚线)所在的面为XZ面建立坐标系,假设B点与原点距离为P,C点与原点距离为Q,则B、C两点的坐标分别为B(-M cosγ,0,M sinγ)、C(-N cosγ,0,N sinγ)。设静态参照物的坐标为:A(X,Y,0)。
三者之间的几何关系满足下面的式子:
cosαi=(X+P cosγ,Y,-P sinγ)(-cosγ,0,-sinγ)/(P-Q)/Li
cosαi+1=(X+Q cosγ,Y,-Q sinγ)(-cosγ,0,-sinγ)/(P-Q)/Li+1
Li 2=(X+P cosγ)2+Y2+(P sinγ)2
Li+1 2=(X+Q cosγ)2+Y2+(Q sinγ)2
通过上面几个式子,可以求解出P和Q的值。
第i时刻和第i+1时刻的时间间隔为Δt,因此,可以推算出第i时刻至第i+1时刻之间的平均速度vi为:vi=(P-Q)/Δt。
需要说明的是,图12所示方法可以理解为是将图7和图8所示方法从二维空间推广到了三维空间,因此,对于平面道路可以看作是图12所示场景的一个特例,也就是说,图7和图8所示场景可以看作是图11和图12中坡度γ为0的特例,此时,上面的公式同样适用。
还应理解,对于车辆和静态参照物不在同一道路平面且车辆为转弯行驶的情况,同样可以采用建立坐标系的方式进行计算,可以看作是将图9和图10所示方法从二维空间推广到三维空间,为了简洁,不再重复介绍。
还需理解,图7至图11均为车辆和静态参照物在同一道路平面的情况,其中,图7至图10是在水平地面上,图11是在有坡度的地面上。而图12是车辆和静态参照物不再同一道路平面上。可以看出,无论车辆和静态参照五是不是在同一道路平面,无论车辆是直线行驶还是转弯行驶,都可以利用车辆与静态参照物之间的位置关系来求算出一端时间间隔内的平均车速,从而得到第二车速,以及利用第二车速来判断第一车速是否准确。
在本申请实施例中,通过利用车辆外部的静态参照物来估算车辆的车速,然后以估算的车速为依据来判断测速装置测得的车速是否正常,从而可以诊断出测速装置是否存在故障。这种方案不需要依赖于车辆的自车动力信息,因此不会受每种自车动力信息所覆盖范围的局限,所以可以具有更广的诊断范围,从而可以更为准确地诊断出测速装置的故障。
上文对本申请实施例的车辆测速装置的故障诊断方法进行了介绍,下面对本申请实施例的车辆测速装置的故障诊断装置进行介绍。应理解,下文中介绍的故障诊断装置能够执行本申请实施例的故障诊断方法的各个过程,下面在介绍装置的实施例时,会适当省略重复的描述。
图13是本申请实施例的一种车辆测速装置的故障诊断装置的示意图,该装置2000包括获取单元2001和处理单元2002。该装置2000可以用于执行本申请实施例的车辆测速装置的故障诊断方法的各步骤。例如,获取单元2001可以用于执行图5所示方法中的步骤501和步骤502,处理单元2002可以用于执行图5所示方法中的步骤503和步骤504。又例如,获取单元2001可以用于执行图6所示方法中的步骤601,处理单元2002可以用于执行图6所示方法中的步骤602,当图6所示方法包括执行步骤603时,获取单元2001还可以用于执行步骤603。又例如,获取单元2001可以用于执行图7所示方法中的步骤701,处理单元2002可以用于执行图7所示方法中的步骤702至步骤704。又例如,获取单元2001可以用于执行图9所示方法中的步骤901,处理单元2002可以用于执行图9所示方法中的步骤902至步骤904。
又例如,上述装置2000还可以用于执行图8、图10、图11、图12所示方法中的各步骤。
上述装置2000可以为图4所示故障诊断装置420,其中获取单元2001可以相当于获取单元421,处理单元2002可以相当于诊断单元422。
图14是本申请实施例的一种车辆测速装置的故障诊断装置的示意图。该装置3000包括存储器3001、处理器3002、通信接口3003以及总线3004。其中,存储器3001、处理器3002、通信接口3003通过总线3004实现彼此之间的通信连接。
可选地,存储器3001可以是只读存储器(read only memory,ROM),静态存储设备,动态存储设备或者随机存取存储器(random access memory,RAM)。存储器3001可以存储程序,当存储器3001中存储的程序被处理器3002执行时,处理器3002和通信接口3003用于执行本申请实施例的车辆测速装置的故障诊断方法的各个步骤。
可选地,存储器3001可以具有图1所示存储器152的功能或者具有图2所示系统内存235的功能,或者具有图4所示存储器340的功能,以实现上述存储程序的功能。可选地,处理器3002可以采用通用的CPU,微处理器,ASIC,图形处理器(graphic processing unit,GPU)或者一个或多个集成电路,用于执行相关程序,以实现本申请实施例的故障诊断装置中的单元所需执行的功能,或者执行本申请实施例的故障诊断方法的各个步骤。
可选地,处理器3002可以具有图1所示处理器151的功能或者具有图2所示处理器203的功能,或者具有图3所示处理器330的功能,以实现上述执行相关程序的功能。
可选地,处理器3002还可以是一种集成电路芯片,具有信号的处理能力。在实现过程中,本申请实施例的故障诊断方法的各个步骤可以通过处理器中的硬件的集成逻辑电路或者软件形式的指令完成。
可选地,上述处理器3002还可以是通用处理器、数字信号处理器(digital signalprocessing,DSP)、专用集成电路(ASIC)、现成可编程门阵列(field programmable gatearray,FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本申请实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成本申请实施例的车辆测速装置的故障诊断装置中包括的单元所需执行的功能,或者执行本申请实施例的车辆测速装置的故障诊断方法的各个步骤。
可选地,通信接口3003可以使用例如但不限于收发器一类的收发装置,来实现装置与其他设备或通信网络之间的通信。
总线3004可包括在装置各个部件(例如,存储器、处理器、通信接口)之间传送信息的通路。
本申请实施例还提供一种包含指令的计算机程序产品,该指令被计算机执行时使得该计算机实现上述方法实施例中的方法。
上述提供的任一种故障诊断装置中相关内容的解释及有益效果均可参考上文提供的对应的方法实施例,此处不再赘述。
除非另有定义,本申请所使用的所有的技术和科学术语与属于本申请的技术领域的技术人员通常理解的含义相同。本申请中在本申请的说明书中所使用的术语只是为了描述具体的实施例的目的,不是旨在于限制本申请。
可选地,本申请实施例中涉及的网络设备包括硬件层、运行在硬件层之上的操作系统层,以及运行在操作系统层上的应用层。其中,硬件层可以包括CPU、内存管理单元(memory management unit,MMU)和内存(也称为主存)等硬件。操作系统层的操作系统可以是任意一种或多种通过进程(process)实现业务处理的计算机操作系统,例如,Linux操作系统、Unix操作系统、Android操作系统、iOS操作系统或windows操作系统等。应用层可以包含浏览器、通讯录、文字处理软件、即时通信软件等应用。
本申请实施例并未对本申请实施例提供的方法的执行主体的具体结构进行特别限定,只要能够通过运行记录有本申请实施例提供的方法的代码的程序,以根据本申请实施例提供的方法进行通信即可。
本申请的各个方面或特征可以实现成方法、装置或使用标准编程和/或工程技术的制品。本申请中使用的术语“制品”可以涵盖可从任何计算机可读器件、载体或介质访问的计算机程序。例如,计算机可读介质可以包括但不限于:磁存储器件(例如,硬盘、软盘或磁带等),光盘(例如,压缩盘(compact disc,CD)、数字通用盘(digital versatile disc,DVD)等),智能卡和闪存器件(例如,可擦写可编程只读存储器(erasable programmableread-only memory,EPROM)、卡、棒或钥匙驱动器等)。
本申请描述的各种存储介质可代表用于存储信息的一个或多个设备和/或其它机器可读介质。术语“机器可读介质”可以包括但不限于:无线信道和能够存储、包含和/或承载指令和/或数据的各种其它介质。
需要说明的是,当处理器为通用处理器、DSP、ASIC、FPGA或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件时,存储器(存储模块)可以集成在处理器中。
还需要说明的是,本申请描述的存储器旨在包括但不限于这些和任意其它适合类型的存储器。
本领域普通技术人员可以意识到,结合本申请中所公开的实施例描述的各示例的单元及步骤,能够以电子硬件、或者计算机软件和电子硬件的结合来实现。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本申请的保护范围。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。此外,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本实施例方案的目的。
另外,在本申请各个实施例中的各功能单元可以集成在一个单元中,也可以是各个单元单独物理存在,也可以两个或两个以上单元集成在一个单元中。
所述功能如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上,或者说对现有技术做出贡献的部分,或者该技术方案的部分,可以以计算机软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,该计算机软件产品包括若干指令,该指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。前述的存储介质可以包括但不限于:U盘、移动硬盘、ROM、RAM、磁碟或者光盘等各种可以存储程序代码的介质。
以上所述,仅为本申请的具体实施方式,但本申请的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本申请揭露的技术范围内,可轻易想到变化或替换,都应涵盖在本申请的保护范围之内。因此,本申请的保护范围应以所述权利要求的保护范围为准。

Claims (25)

1.一种车辆测速装置的故障诊断方法,其特征在于,包括:
获取测速装置测得的第一车速;
获取静态参照物的N个时刻的参照信息,N为大于1的整数,所述参照信息包括所述静态参照物在所述N个时刻中的每个时刻相对于所述测速装置所在的车辆的位置关系的信息;
根据所述参照信息,计算第二车速;
根据所述第一车速和所述第二车速,判断所述测速装置是否故障。
2.如权利要求1所述的故障诊断方法,其特征在于,在获取所述参照信息之前,所述故障诊断方法还包括:
利用所述车辆的感知设备,识别所述车辆周围的物体;
从识别出的所述物体中选取所述静态参照物。
3.如权利要求1或2所述的故障诊断方法,其特征在于,所述根据所述参照信息,计算第二车速,包括:
利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速;
对至少一个所述估计车速进行处理,得到所述第二车速。
4.如权利要求3所述的故障诊断方法,其特征在于,所述利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速,包括:
当所述车辆与所述静态参照物在同一道路平面且所述车辆为直线行驶时,执行下面的操作:
利用所述静态参照物相对于所述车辆的距离、所述静态参照物与所述车辆行驶方向之间夹角,计算得到所述两个时刻之间所述车辆相对于所述静态参照物的位移;
利用所述位移和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
5.如权利要求3所述的故障诊断方法,其特征在于,所述利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速,包括:
当所述车辆与所述静态参照物在同一道路平面且所述车辆为转弯行驶时,执行下面的操作:
利用所述静态参照物与所述车辆之间的距离、所述车辆的车轮转向角、所述车辆的长度,计算得到所述两个时刻之间所述车辆的转向角度、所述车辆的转向半径;
利用所述转向角度、所述转向半径和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
6.如权利要求3所述的故障诊断方法,其特征在于,所述利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速,包括:
当所述车辆与所述静态参照物不在同一道路平面且所述车辆为直线行驶时,执行下面的操作:
建立任意三维坐标系,并表示出所述静态参照物的坐标、所述车辆在所述两个时刻的位置坐标;
根据所述静态参照物的坐标、所述车辆在所述两个时刻的位置坐标,计算得到所述两个时刻之间所述车辆相对于所述静态参照物的位移;
利用所述位移和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
7.如权利要求3所述的故障诊断方法,其特征在于,所述利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速,包括:
当所述车辆与所述静态参照物不在同一道路平面且所述车辆为转弯行驶时,执行下面的操作:
建立任意三维坐标系,并表示出所述静态参照物的坐标、所述车辆在所述两个时刻的位置的坐标;
利用所述静态参照物与所述车辆之间的距离、所述车辆的车轮转向角、所述车辆的长度,计算得到所述两个时刻之间所述车辆的转向角度、所述车辆的转向半径;
利用所述转向角度、所述转向半径和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
8.如权利要求3至7中任一项所述的故障诊断方法,其特征在于,所述对至少一个所述估计车速进行处理,得到所述第二车速,包括:
对至少一个所述估计车速进行均值滤波或中值滤波,将滤波之后得到的车速作为所述第二车速。
9.如权利要求1至8中任一项所述的故障诊断方法,其特征在于,所述根据所述第一车速和所述第二车速,判断所述测速装置是否故障,包括:
当所述第一车速与所述第二车速之间的差距大于第一预设阈值时,认为所述测速装置故障;
当所述第一车速与所述第二车速之间的差距小于或等于所述第一预设阈值时,认为所述测速装置没有故障。
10.如权利要求1至9中任一项所述的故障诊断方法,其特征在于,所述静态参照物为多个,所述故障诊断方法还包括:
获取多个所述静态参照物的所述参照信息;
根据所述参照信息,计算得到多个所述第二车速;
根据所述第一车速和多个所述第二车速,判断所述测速装置是否故障。
11.如权利要求10所述的故障诊断方法,其特征在于,所述根据所述第一车速和多个所述第二车速,判断所述测速装置是否故障,包括:
当多个所述第二车速之间的差距大于第二预设阈值时,重新获取所述第二车速;
当多个所述第二车速之间的差距小于或等于所述第二预设阈值时,判断所述测速装置是否故障。
12.一种车辆测速装置的故障诊断装置,其特征在于,包括:
获取单元,用于获取测速装置测得的第一车速;
所述获取单元还用于,获取静态参照物的N个时刻的参照信息,N为大于1的整数,所述参照信息包括所述静态参照物在所述N个时刻中的每个时刻相对于所述测速装置所在的车辆的位置关系的信息;
处理单元,用于根据所述参照信息,计算第二车速;
所述处理单元还用于,根据所述第一车速和所述第二车速,判断所述测速装置是否故障。
13.如权利要求12所述的故障诊断装置,其特征在于,在获取所述参照信息之前,所述获取单元还用于,利用所述车辆的感知设备,识别所述车辆周围的物体;
所述处理单元还用于,从识别出的所述物体中选取所述静态参照物。
14.如权利要求12或13所述的故障诊断装置,其特征在于,所述获取单元具体用于,利用所述N个时刻的参照信息,计算得到至少一个估计车速,所述估计车速为所述N个时刻中的任意两个时刻之间的平均车速;
所述处理单元还用于,对至少一个所述估计车速进行处理,得到所述第二车速。
15.如权利要求14所述的故障诊断装置,其特征在于,当所述车辆与所述静态参照物在同一道路平面且所述车辆为直线行驶时,所述获取单元具体用于执行下面的操作:
利用所述静态参照物相对于所述车辆的距离、所述静态参照物与所述车辆行驶方向之间夹角,计算得到所述两个时刻之间所述车辆相对于所述静态参照物的位移;
利用所述位移和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
16.如权利要求14所述的故障诊断装置,其特征在于,当所述车辆与所述静态参照物在同一道路平面且所述车辆为转弯行驶时,所述获取单元具体用于执行下面的操作:
利用所述静态参照物与所述车辆之间的距离、所述车辆的车轮转向角、所述车辆的长度,计算得到所述两个时刻之间所述车辆的转向角度、所述车辆的转向半径;
利用所述转向角度、所述转向半径和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
17.如权利要求14所述的故障诊断装置,其特征在于,当所述车辆与所述静态参照物不在同一道路平面且所述车辆为直线行驶时,所述获取单元具体用于执行下面的操作:
建立任意三维坐标系,并表示出所述静态参照物的坐标、所述车辆在所述两个时刻的位置坐标;
根据所述静态参照物的坐标、所述车辆在所述两个时刻的位置坐标,计算得到所述两个时刻之间所述车辆相对于所述静态参照物的位移;
利用所述位移和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
18.如权利要求14所述的故障诊断装置,其特征在于,当所述车辆与所述静态参照物不在同一道路平面且所述车辆为转弯行驶时,所述获取单元具体用于执行下面的操作:
建立任意三维坐标系,并表示出所述静态参照物的坐标、所述车辆在所述两个时刻的位置的坐标;
利用所述静态参照物与所述车辆之间的距离、所述车辆的车轮转向角、所述车辆的长度,计算得到所述两个时刻之间所述车辆的转向角度、所述车辆的转向半径;
利用所述转向角度、所述转向半径和所述两个时刻之间的时间长度,计算得到所述两个时刻之间的所述平均速度。
19.如权利要求14至18中任一项所述的故障诊断装置,其特征在于,所述获取单元具体用于,对至少一个所述估计车速进行均值滤波或中值滤波,将滤波之后得到的车速作为所述第二车速。
20.如权利要求12至19中任一项所述的故障诊断装置,其特征在于,所述获取单元具体用于执行以下操作:
当所述第一车速与所述第二车速之间的差距大于第一预设阈值时,认为所述测速装置故障;
当所述第一车速与所述第二车速之间的差距小于或等于所述第一预设阈值时,认为所述测速装置没有故障。
21.如权利要求12至20中任一项所述的故障诊断装置,其特征在于,所述静态参照物为多个,所述获取单元还用于,获取多个所述静态参照物的所述参照信息;
所述处理单元还用于,根据所述参照信息,计算得到多个所述第二车速;以及根据所述第一车速和多个所述第二车速,判断所述测速装置是否故障。
22.如权利要求21所述的故障诊断装置,其特征在于,所述获取单元还用于,当多个所述第二车速之间的差距大于第二预设阈值时,重新获取所述第二车速;
所述处理单元还用于,当多个所述第二车速之间的差距小于或等于所述第二预设阈值时,判断所述测速装置是否故障。
23.一种芯片,其特征在于,所述芯片包括处理器与数据接口,所述处理器通过所述数据接口读取存储器上存储的指令,以执行如权利要求1至11中任一项所述的故障诊断方法。
24.一种计算机可读存储介质,其特征在于,所述计算机可读介质存储用于设备执行的程序代码,该程序代码包括用于执行如权利要求1至11中任一项所述的故障诊断方法的指令。
25.一种车辆,其特征在于,所述车辆包括如权利要求12至22中任一项所述的故障诊断装置,以及测速装置,所述故障诊断装置用于对所述测速装置进行故障诊断。
CN202080004603.2A 2020-09-21 2020-09-21 车辆测速装置的故障诊断方法和故障诊断装置 Active CN112638738B (zh)

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
PCT/CN2020/116411 WO2022056899A1 (zh) 2020-09-21 2020-09-21 车辆测速装置的故障诊断方法和故障诊断装置

Publications (2)

Publication Number Publication Date
CN112638738A true CN112638738A (zh) 2021-04-09
CN112638738B CN112638738B (zh) 2022-12-06

Family

ID=75291157

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202080004603.2A Active CN112638738B (zh) 2020-09-21 2020-09-21 车辆测速装置的故障诊断方法和故障诊断装置

Country Status (4)

Country Link
US (1) US20230227052A1 (zh)
EP (1) EP4201777A4 (zh)
CN (1) CN112638738B (zh)
WO (1) WO2022056899A1 (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113313844A (zh) * 2021-07-30 2021-08-27 深圳市赛菲姆科技有限公司 一种基于视频流双向触发车辆智能管理系统及方法
CN114030356A (zh) * 2021-12-14 2022-02-11 航天科技控股集团股份有限公司 一种汽车组合仪表车速速比的配置方法
CN114323143A (zh) * 2021-12-30 2022-04-12 上海商汤临港智能科技有限公司 一种车辆数据检测方法、装置、计算机设备及存储介质

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117485356B (zh) * 2023-12-29 2024-04-05 合众新能源汽车股份有限公司 基于风险等级评估的高精定位故障诊断方法和系统

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19517026A1 (de) * 1995-05-10 1996-11-14 Bosch Gmbh Robert Verfahren zur Bestimmung der Geschwindigkeit eines Fahrzeuges mit Hilfe einer das Fahrzeug aufnehmden Videokamera und Vorrichtung zur Durchführung des Verfahrens
CN102981010A (zh) * 2011-09-05 2013-03-20 业纳遥控设备有限公司 用于借助照相机来验证测量目标车辆的速度的方法
CN105818744A (zh) * 2016-04-27 2016-08-03 乐视控股(北京)有限公司 一种监测车辆超速报警的方法和系统
CN110231496A (zh) * 2019-06-19 2019-09-13 浙江吉利控股集团有限公司 一种车速校准装置及方法
CN110231497A (zh) * 2019-06-19 2019-09-13 浙江吉利控股集团有限公司 一种基于激光雷达测速的车速校准装置及方法
CN110832341A (zh) * 2018-12-27 2020-02-21 深圳市大疆创新科技有限公司 车速计算方法、系统、设备及存储介质
CN111089984A (zh) * 2019-12-02 2020-05-01 北汽福田汽车股份有限公司 确定车速的方法和装置、存储介质、电子设备、车辆

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103914889B (zh) * 2014-04-02 2016-05-04 北京中交慧联信息科技有限公司 一种对车辆速度的采集行为进行异常检测的系统及方法
RU2592711C1 (ru) * 2015-01-27 2016-07-27 Акционерное общество "ЭЛВИС-НеоТек" Способ и система калибровки комплекса измерения скорости транспортных средств
US9903945B2 (en) * 2015-02-04 2018-02-27 GM Global Technology Operations LLC Vehicle motion estimation enhancement with radar data
CN106803350A (zh) * 2017-03-06 2017-06-06 中山大学 一种基于摄像头拍摄时间差的车辆速度检测方法及装置
JP7147275B2 (ja) * 2018-06-04 2022-10-05 愛知製鋼株式会社 ジャイロセンサの較正方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
DE19517026A1 (de) * 1995-05-10 1996-11-14 Bosch Gmbh Robert Verfahren zur Bestimmung der Geschwindigkeit eines Fahrzeuges mit Hilfe einer das Fahrzeug aufnehmden Videokamera und Vorrichtung zur Durchführung des Verfahrens
CN102981010A (zh) * 2011-09-05 2013-03-20 业纳遥控设备有限公司 用于借助照相机来验证测量目标车辆的速度的方法
CN105818744A (zh) * 2016-04-27 2016-08-03 乐视控股(北京)有限公司 一种监测车辆超速报警的方法和系统
CN110832341A (zh) * 2018-12-27 2020-02-21 深圳市大疆创新科技有限公司 车速计算方法、系统、设备及存储介质
CN110231496A (zh) * 2019-06-19 2019-09-13 浙江吉利控股集团有限公司 一种车速校准装置及方法
CN110231497A (zh) * 2019-06-19 2019-09-13 浙江吉利控股集团有限公司 一种基于激光雷达测速的车速校准装置及方法
CN111089984A (zh) * 2019-12-02 2020-05-01 北汽福田汽车股份有限公司 确定车速的方法和装置、存储介质、电子设备、车辆

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113313844A (zh) * 2021-07-30 2021-08-27 深圳市赛菲姆科技有限公司 一种基于视频流双向触发车辆智能管理系统及方法
CN114030356A (zh) * 2021-12-14 2022-02-11 航天科技控股集团股份有限公司 一种汽车组合仪表车速速比的配置方法
CN114030356B (zh) * 2021-12-14 2023-11-28 航天科技控股集团股份有限公司 一种汽车组合仪表车速速比的配置方法
CN114323143A (zh) * 2021-12-30 2022-04-12 上海商汤临港智能科技有限公司 一种车辆数据检测方法、装置、计算机设备及存储介质
WO2023123854A1 (zh) * 2021-12-30 2023-07-06 上海商汤智能科技有限公司 车辆数据检测方法、装置、设备、介质及程序

Also Published As

Publication number Publication date
CN112638738B (zh) 2022-12-06
EP4201777A4 (en) 2023-08-02
EP4201777A1 (en) 2023-06-28
WO2022056899A1 (zh) 2022-03-24
US20230227052A1 (en) 2023-07-20

Similar Documents

Publication Publication Date Title
CN110550029B (zh) 障碍物避让方法及装置
CN112638738B (zh) 车辆测速装置的故障诊断方法和故障诊断装置
CN113879295B (zh) 轨迹预测方法及装置
CN112230642B (zh) 道路可行驶区域推理方法及装置
CN113168708B (zh) 车道线跟踪方法和装置
CN112512887B (zh) 一种行驶决策选择方法以及装置
CN113498529B (zh) 一种目标跟踪方法及其装置
CN113156927A (zh) 自动驾驶车辆的安全控制方法及安全控制装置
US20230048680A1 (en) Method and apparatus for passing through barrier gate crossbar by vehicle
CN112585045A (zh) 电子机械制动方法和电子机械制动装置
CN114056347A (zh) 车辆运动状态识别方法及装置
CN112810603B (zh) 定位方法和相关产品
CN113859265B (zh) 一种驾驶过程中的提醒方法及设备
WO2022089577A1 (zh) 一种位姿确定方法及其相关设备
CN113968242B (zh) 自动驾驶场景生成方法、装置及系统
CN112703140A (zh) 控制方法和控制装置
CN114782638B (zh) 生成车道线的方法、装置、车辆、存储介质及芯片
CN113741384B (zh) 检测自动驾驶系统的方法和装置
CN113022573B (zh) 道路结构检测方法及装置
CN115139946B (zh) 车辆落水检测方法、车辆、计算机可读存储介质及芯片
CN112639910B (zh) 交通元素的观测方法和装置
CN115115707B (zh) 车辆落水检测方法、车辆、计算机可读存储介质及芯片
WO2022127502A1 (zh) 控制方法和装置
CN114556251B (zh) 用于确定车辆可通行空间的方法和装置
WO2022041820A1 (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