CN111123933B - 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车 - Google Patents

车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车 Download PDF

Info

Publication number
CN111123933B
CN111123933B CN201911348578.5A CN201911348578A CN111123933B CN 111123933 B CN111123933 B CN 111123933B CN 201911348578 A CN201911348578 A CN 201911348578A CN 111123933 B CN111123933 B CN 111123933B
Authority
CN
China
Prior art keywords
vehicle
driving
track
intelligent
trajectory
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
Application number
CN201911348578.5A
Other languages
English (en)
Other versions
CN111123933A (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
Priority to CN201911348578.5A priority Critical patent/CN111123933B/zh
Publication of CN111123933A publication Critical patent/CN111123933A/zh
Priority to PCT/CN2020/132412 priority patent/WO2021129309A1/zh
Priority to EP20906290.0A priority patent/EP4075227B1/en
Application granted granted Critical
Publication of CN111123933B publication Critical patent/CN111123933B/zh
Priority to US17/848,216 priority patent/US20220324481A1/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G08SIGNALLING
    • G08GTRAFFIC CONTROL SYSTEMS
    • G08G1/00Traffic control systems for road vehicles
    • G08G1/16Anti-collision systems
    • G08G1/161Decentralised systems, e.g. inter-vehicle communication
    • G08G1/163Decentralised systems, e.g. inter-vehicle communication involving continuous checking
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0234Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons
    • G05D1/0236Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using optical markers or beacons in combination with a laser
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/005Handover processes
    • 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/08Estimation 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 drivers or passengers
    • B60W40/09Driving style or behaviour
    • 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
    • B60W60/00Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001Planning or execution of driving tasks
    • B60W60/0027Planning or execution of driving tasks using trajectory prediction for other traffic participants
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0238Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
    • G05D1/024Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0242Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using non-visible light signals, e.g. IR or UV signals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0257Control of position or course in two dimensions specially adapted to land vehicles using a radar
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • G05D1/0263Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means using magnetic strips
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0287Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling
    • G05D1/0289Control of position or course in two dimensions specially adapted to land vehicles involving a plurality of land vehicles, e.g. fleet or convoy travelling with means for avoiding collisions between vehicles
    • 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
    • B60W2520/00Input parameters relating to overall vehicle dynamics
    • B60W2520/10Longitudinal speed
    • B60W2520/105Longitudinal acceleration
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/10Accelerator pedal position
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/12Brake pedal position
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/16Ratio selector position
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/18Steering angle
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/20Direction indicator values
    • 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
    • B60W2540/00Input parameters relating to occupants
    • B60W2540/30Driving style
    • 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
    • B60W2552/00Input parameters relating to infrastructure
    • B60W2552/30Road curve radius
    • 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
    • B60W2554/802Longitudinal distance
    • 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
    • B60W2554/804Relative longitudinal 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
    • B60W2555/00Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/60Traffic rules, e.g. speed limits or right of way
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/10Historical data
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • 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
    • B60W2556/00Input parameters relating to data
    • B60W2556/45External transmission of data to or from the vehicle
    • B60W2556/65Data transmitted between vehicles
    • HELECTRICITY
    • H04ELECTRIC COMMUNICATION TECHNIQUE
    • H04WWIRELESS COMMUNICATION NETWORKS
    • H04W4/00Services specially adapted for wireless communication networks; Facilities therefor
    • H04W4/30Services specially adapted for particular environments, situations or purposes
    • H04W4/40Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
    • H04W4/46Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for vehicle-to-vehicle communication [V2V]

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Electromagnetism (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Human Computer Interaction (AREA)
  • Optics & Photonics (AREA)
  • Mathematical Physics (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Traffic Control Systems (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)

Abstract

本申请提供一种车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车,用以实现智能车准确进行轨迹规划。该方法包括:第一车辆的智能驾驶域控制器获取第一车辆的第一轨迹,并基于第一通信技术获取至少一辆第二车辆的第二轨迹;然后,根据第一轨迹和至少一辆第二车辆的第二轨迹确定第一车辆的轨迹规划。以此实现车辆利用不同规则预测车辆轨迹,进而更准确的规划自车的行驶轨迹的目的,提高智能车行驶的安全性。

Description

车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
技术领域
本申请涉及智能车领域,尤其涉及一种车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车。
背景技术
智能车(smart/intelligent car)在自动驾驶(automated driving,ADS)过程中会根据周围环境,规划出一条无碰撞的安全路径。其中,障碍物信息是路径规划的重要输入之一。传统技术中,缺少对障碍物的轨迹预测,仅就当前时刻障碍物的行驶情况进行分析和预测,是一种静态分析过程。但是,随着时间的变化,障碍物的行驶轨迹是动态变化的过程,障碍物的行驶轨迹可能会发生跳变甚至是与其他人或物的碰撞。而随着汽车产业的发展,未来相当长一段时间内,道路上会存在自动驾驶车辆和人工驾驶车辆共存的现象,智能车需要对周围车辆的行驶轨迹进行预测,进而规划自车的行驶轨迹。当前轨迹预测主要是智能车依靠自身配备的传感器,根据周围车辆的历史数据及道路拓扑等信息,并假设障碍物将会保持当前的运动状态,速度和方向都不会有较大改变,采用统一的规则(如默认前车遇到障碍物优先从左侧避让)对周围车辆的轨迹进行预测。但是,实际道路上车辆运动有很大不确定性,例如,人工驾驶车辆的行为由驾驶员主观决定,而自动驾驶车辆的行为在同一场景下存在多种行为决策的可能。采用上述方法难以做出确定性预测,从而会导致自动驾驶车辆无法准确进行轨迹规划。因此,如何提供一种准确预测车辆轨迹的方法成为智能车领域亟待解决的技术问题。
发明内容
本申请提供一种车辆轨迹规划的方法及装置,用以智能车准确进行轨迹规划。
第一方面,本申请提供了一种车辆轨迹规划的方法,所述方法可以应用于第一车辆的智能驾驶域控制器,所述智能驾驶域控制器获取所述第一车辆的第一轨迹,并基于第一通信技术获取至少一辆第二车辆的第二轨迹;然后根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划。以此避免传统技术中仅以车辆当前时刻的运行轨迹进行轨迹预测造成的判断错误,本方法可以识别其他车辆轨迹的变化,确保第一车辆不与其他任一车辆在同一时刻出现在同一位置,避免发生碰撞,从而可以提高智能车行驶安全性。
在一个可能的设计中,所述智能驾驶域控制器在获取所述第一车辆的第一轨迹时具体方法可以为:所述智能驾驶域控制器先确定所述第一车辆当前的驾驶模式,然后根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹,其中,所述驾驶模式包括自动驾驶模式和人工驾驶模式。通过上述方法,智能驾驶域控制器可以根据第一车辆的实际驾驶模式准确地获取所述第一车辆的第一轨迹,进而后续准确地进行轨迹规划。
在另一个可能的设计中,所述智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹时,具体方法可以为:当所述智能驾驶域控制器确定所述第一车辆当前的驾驶模式为自动驾驶模式时,所述智能驾驶域控制器获取所述第一车辆的自动驾驶轨迹,然后将所述自动驾驶轨迹作为所述第一轨迹。这样,所述第一车辆可以获得与所述第一车辆的自动驾驶模式匹配的轨迹,进而完成后续准确地进行轨迹规划。
在另一个可能的设计中,所述智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹时,具体方法可以为:当所述智能驾驶域控制器确定所述第一车辆当前的驾驶模式为人工驾驶模式时,所述智能驾驶域控制器可以预测所述第一车辆的人工驾驶轨迹,然后将预测得到的所述人工驾驶轨迹作为所述第一轨迹。当第一车辆为人工驾驶模式时,智能驾驶域控制器能够根据预测获得的与当前驾驶员的驾驶习惯匹配的第一轨迹,进而完成后续准确地进行轨迹规划。
在另一个可能的设计中,所述智能驾驶域控制器预测所述第一车辆的人工驾驶轨迹时具体方法可以为:所述智能驾驶域控制器获取第一参数集合以及所述第一车辆对应的轨迹预测模型,并根据所述第一参数集合和所述轨迹预测模型预测所述第一车辆的轨迹点,最后根据所述第一车辆的轨迹点确定所述第一车辆的人工驾驶轨迹;其中,所述第一参数集合包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态,所述第一车辆的行驶状态用于指示当前驾驶所述第一车辆的用户的驾驶习惯;所述轨迹预测模型为根据当前驾驶所述第一车辆的用户的驾驶习惯的历史数据训练获得。通过上述方法,所述智能驾驶域控制器在预测自车行驶轨迹时,可以结合当前驾驶员驾驶所述第一车辆的驾驶习惯,使得到的轨迹更符合实际的轨迹,准确性更高。
在另一个可能的设计中,所述第一车辆的位置可以包括标识所述第一车辆所在位置的经度和纬度;所述第一车辆周围障碍物可以包括一个或多个障碍物,任一个障碍物的行驶数据可以包括所述任一个障碍物相对所述第一车辆的相对速度和相对距离;所述第一车辆的行驶状态包括所述第一车辆所在的道路的当前车道属性、道路半径、所述第一车辆的速度、加速度、加速踏板开度、制动踏板开度、右前制动轮缸、左前制动轮缸、右后制动轮缸、左后制动轮缸、方向盘转角、方向盘转向角速度、方向盘转矩、档位、转向灯信号。
在另一个可能的设计中,所述第一车辆的轨迹点包括所述第一车辆预测行驶轨迹中包括的预测经度和预测纬度。这样每个轨迹点包含的预测精度和预测维度就可以得到一个第一车辆的预测位置,预测位置就可以组成一条预测行驶轨迹。
在另一个可能的设计中,所述第一车辆的轨迹点还包括所述预测经度的置信度和所述预测纬度的置信度。其中,预测精度的置信度标识了预测精度的准确率,预测纬度的置信度标识了预测纬度的准确率,这样在根据轨迹点得到预测轨迹时,可以了解轨迹点的准确率,明确预测轨迹的准确率。
在另一个可能的设计中,所述智能驾驶域控制器可以向云服务器发送所述第一参数集合和所述第一车辆的轨迹点,以使所述云服务器根据所述第一参数集合和所述第一车辆的轨迹点校正所述轨迹预测模型;并接收所述云服务器发送的校正后的轨迹预测模型,然后,所述智能驾驶域控制器利用所述校正后的轨迹预测模型和第二参数集合预测所述第一车辆的轨迹点,所述第二参数集为当前时刻收集的包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态的数据。以此获得根据每个驾驶员的驾驶习惯确定的轨迹预测模型,上述方法能够获得人工驾驶模式的智能车或非智能车中每个驾驶员定制化的轨迹预测模型,并按照各自的驾驶习惯预测其行驶轨迹,相比于传统技术中采用统一规则进行轨迹预测的方法,预测结果更接近车辆的行驶轨迹。进一步地,智能驾驶域控制器可以根据上述获取预测模型获得的预测轨迹确定自车的行驶轨迹,合理规划自车行驶轨迹,降低与其他车辆碰撞的风险。
在另一个可能的设计中,所述智能驾驶域控制器向所述至少一辆第二车辆发送所述第一轨迹。这样,可以使至少一辆第二车辆结合所述第一轨迹进行轨迹规划。
在另一个可能的设计中,所述智能驾驶域控制器在与所述至少一辆第二车辆通信之前,确定所述至少一辆第二车辆在设定范围内,或者,所述智能驾驶域控制器确定与所述至少一辆第二车辆已通过安全认证;其中,所述设定范围为以所述第一车辆为圆心的圆形区域,所述圆形区域的半径为设定值。以此保证车辆间数据传输的安全性。
在另一个可能的设计中,所述第一通信技术为车用无线通信技术V2X。
在另一个可能的设计中,智能驾驶域控制器按照如下规则中至少一种规则确定所述第一车辆的行驶轨迹:规则一:不违反交通规则;规则二:与障碍物(如其他车辆)之间的距离需要大于预设值;规则三:不与障碍物(如其他车辆)在同一时刻位于同一个位置。
第二方面,本申请提供了一种智能驾驶域控制器,所述智能驾驶域控制器包括用于执行第一方面或第一方面任一种可能设计中的车辆轨迹规划方法的各个模块或单元,例如处理单元和获取单元。
第三方面,本申请提供了一种智能驾驶域控制器,所述智能驾驶域控制器包括处理器和存储器,智能驾驶域控制器运行时,所述处理器执行所述存储器中所存储的计算机执行计算机程序或指令,以使所述智能驾驶域控制器执行如上述第一方面或第一方面任一种可能设计中所示的相应的方法。
第四方面,本申请提供了一种智能车,所述智能车可以包括上述第二方面或第三方面中任一所述的智能驾驶域控制器。所述智能车可以为上述第一方面涉及的第一车辆。
第五方面,本申请提供了一种***,所述***可以包括上述涉及的第一车辆和至少一辆第二车辆。
第六方面,本申请提供一种计算机可读存储介质,所述计算机可读存储介质中存储有程序或指令,当其在计算机上运行时,使得计算机执行第一方面或第一方面任一种可能的设计中所述的方法。
第七方面,本申请提供了一种包含指令的计算机程序产品,当其在计算机上运行时,使得计算机执行第一方面或第一方面任一种可的设计中所述的方法。
附图说明
图1为本申请提供的一种车辆轨迹规划的方法适用的***的架构示意图;
图2为本申请提供的一种车辆行驶的场景示意图;
图3为本申请提供的一种车辆轨迹规划的方法的流程图;
图4为本申请提供的一种车辆轨迹规划的装置的结构示意图;
图5为本申请提供的一种装置的结构示意图;
图6为本申请提供的一种智能驾驶域控制器的结构图。
具体实施方式
下面将结合附图对本申请实施例作进一步地描述说明。
图1示出了本申请实施例提供的一种车辆轨迹规划的方法适用的***的架构示意图,所述***的架构中包括至少两辆车辆以及云端100。其中,在图1中以n辆车辆示出,分别为车辆(vehicle)1、车辆2……车辆n,n为大于或者等于2的整数。具体的:n辆车辆中包括智能车和非智能车;所述至少两辆车辆为具备人工驾驶模式的自动驾驶车辆,在实际行驶中,每辆车辆可以工作在自动驾驶模式下,也可以工作在人工驾驶模式下。
其中,任一辆车辆的均可以包括传感器、智能驾驶域控制器104、车载通信设备105、高精度定位设备106、车辆其他控制器107和人机交互***108。其中,传感器包括以下设备中一种或多种:至少一个毫米波雷达101、至少一个激光雷达102、至少一个相机103具体地,在图1中仅以车辆1示出。下面对车辆包含的上述模块的功能进行详细解释:
毫米波雷达101:是工作在毫米波段(millimeter wave)探测的雷达,用于采集到达障碍物的光束传输时间和光束的速度,并将采集的数据发送给所述智能驾驶域控制器104;或者用于在采集光束传输时间和光束的速度后,计算周围障碍物的距离、速度等数据,并将计算得到的数据发送给所述智能驾驶域控制器104。
激光雷达102:是以发射激光束探测目标的位置、速度等特征量的雷达***。其工作原理是向目标发射探测信号(激光束),然后将接收到的从目标反射回来的信号(目标回波)与发射信号进行比较,作适当处理后,就可获得目标的有关数据,如目标距离、方位、高度、速度、姿态、甚至形状等参数。在本申请中,激光雷达102用于采集从障碍物反射回来的信号,并将反射回来的信号和发射信号发送给所述智能驾驶域控制器104;或者采集从障碍物反射回来的信号后,与发射信号对比,处理得到周围障碍物的距离、速度等数据,并将处理得到的数据发送给所述智能驾驶域控制器104。
相机103:用于采集周围图像或视频,并将采集的图像或视频发送给所述智能驾驶域控制器104;其中,当相机103是智能摄像头时,相机103可以采集图像或视频后,分析图像或视频得周围障碍物的速度和距离等,并将分析得到的数据发送给所述智能驾驶域控制器104。
高精度定位设备106:采集当前车辆的精确位置信息(误差小于20cm),及所述精确位置信息对应的全球定位***(global positioning system,GPS)时间信息,并将采集的信息发送给所述智能驾驶域控制器104。其中,所述高精度定位设备106可以是组合定位***或组合定位模块。所述高精度定位设备106可以包括全球导航卫星***(globalnavigation satellite system,GNSS)、惯性测量单元(inertial measurement unit,IMU)等设备和传感器。全球导航卫星***能够输出一定精度(例如,5-10Hz)的全局定位信息,惯性测量单元频率一般较高(例如,1000Hz),所述高精度定位设备106可以通过融合惯性测量单元和全球导航卫星***的信息,输出高频的精准定位信息(一般要求200Hz以上)。
车辆其他控制器107:执行所述智能驾驶域控制器104的控制命令,将车辆转向、档位、加速、减速等相关信息发送给所述智能驾驶域控制器104。
人机交互***108:提供智能车与驾驶员消息交互的音视频方式,可以利用显示屏显示本车辆与其他车辆的轨迹。
智能驾驶域控制器104:可以设置于车辆内的,智能驾驶域控制器104具体由处理器实现,处理器包括中央处理器(central processing unit,CPU)或者具备处理功能的设备或模块。例如,智能驾驶域控制器104可以是车载移动数据中心(mobile data center,MDC)。执行自动驾驶功能时,即在自动驾驶模式下,智能驾驶域控制器104将轨迹规划信息发送到车载通信设备105,将自身位置信息及周围其他车辆预测轨迹发送至所述人机交互***108;人驾驶车辆时,即在人工驾驶模式下,将传感器信息和车辆实际轨迹及自身预测轨迹(根据传感器信息、车辆其他控制器传来的信息由神经网络或其他人工智能(artificial intelligence,AI)算法预测)发送到车载通信设备105,将自身位置信息及周围其他车辆的预测轨迹发送至人机交互***108。
车载通信设备105:与其他车辆通信的设备,接收其他车辆轨迹预测信息(也可描述成预测轨迹、轨迹信息等)并发送给智能驾驶域控制器104,并将自身轨迹发送给周围其他车辆;与云端100通信,将车辆上传感器信息、定位信息及其他控制器信息发送到云端100,接收云端100训练好的模型参数。例如车载通信设备105可以是远程信息处理器(telematics BOX,TBOX)。
需要说明的是,上述涉及的周围障碍物在这里指的是其他车辆。障碍物的距离和速度分别为障碍物相对于自车的相对距离和相对速度。
需要说明的是,在车辆进行通信的过程中,为了提高智能车行驶的安全性,车辆间的信息传输可以建立互信。例如,任一辆车辆可以与预设范围内的车辆进行信息传输,所述预设范围可以是以自车为圆心,设定值为半径的圆形区域。其中所述半径的设定值可以基于车辆可支持的V2X通信的范围设定。又例如,车辆间可以通过鉴权建立互信,具体可以通过交互认证信息,认证通过后则可以进行通信,共享信息。又例如,车辆见可以在设定时间周期内进行信息传输。又例如,车辆间可以遵循汽车信息安全标准21434等,接收的其他车辆的信息仅用于自车驾驶使用,不做记录。当然,还有其他方式,本申请此处不再一一列举。
云端100:根据传感器信息、定位信息及其他控制器信息训练模型,将训练好的模型参数发送给所述车载通信设备105。其中,云端100可以是能实现模型训练的云数据中心,还可以是能够进行模型训练的物理设备或虚拟机等,本申请对此不作限定。
基于上述***,在车辆行驶过程中,任何一辆车辆均可以获取周围车辆预设时段内的行驶轨迹,来约束本车辆的轨迹规划,从而提高安全性。例如,图2所示的场景示意图中,该场景中有车辆1,车辆2和车辆3共三辆自动驾驶车辆,其中三辆车辆中至少有一辆车辆处于人工驾驶模式。其中,三辆车辆均会根据自身的驾驶模式来预测自车的行驶轨迹。例如,以车辆1进行轨迹规划为例说明,在车辆1进行轨迹规划的过程中,车辆1可以通过V2X技术获取车辆2和车辆3预测的行驶轨迹,然后结合自身预测的行驶轨迹来进行轨迹规划。这样可以提高自身轨迹规划的准确性,从而提高行驶的安全性。
应理解,车辆2和车辆3进行轨迹规划的方法与车辆1进行轨迹规划的方法类似,可以相互参见。
需要说明的是,上述涉及的预设时段可以基于V2X传输技术所需的时延确定,还可以是预设的经验值,例如5-10秒(s);当然还可以是其他方式确定,本申请对此不作限定。
基于上述描述,本申请实施例提供了一种车辆轨迹规划的方法,适用于图1所示的***,以及图2所示的场景。所述方法可以用于第一车辆的轨迹规划,所述第一车辆为智能车。所述方法可以由所述第一车辆的智能驾驶域控制器实现。参阅图3所示,所述方法的具体流程可以包括:
步骤301:所述第一车辆的智能驾驶域控制器获取所述第一车辆的第一轨迹。
具体的,所述第一车辆的智能驾驶域控制器获取所述第一轨迹时,具体方法可以为:所述第一车辆的智能驾驶域控制器确定所述第一车辆当前的驾驶模式,所述驾驶模式包括自动驾驶模式和人工驾驶模式;然后,所述智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹。
在一种可能的实现方式中,所述第一车辆的智能驾驶域控制器确定所述第一车辆的驾驶模式时,所述驾驶域控制器可以通过车载通信装置与其他车辆进行通信,例如,发送驾驶模式查询消息,再由其他车辆以应答消息的形式通知第一车辆其驾驶模式。可选地,第一车辆还可以通过相机采集其他车辆的图像,进而分析其他车辆中驾驶员的状态(例如,驾驶员是否手握方向盘,是否处于休息状态等形式)判断该车辆是否处于自动驾驶模式。
示例性的,所述第一车辆的智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹,具体可以包含以下两种情况:
情况1:当所述智能驾驶域控制器确定为自动驾驶模式时,所述智能驾驶域控制器获取所述第一车辆的自动驾驶轨迹,将所述自动驾驶轨迹作为所述第一轨迹。
情况2:当所述智能驾驶域控制器确定为人工驾驶模式时,所述智能驾驶域控制器预测所述第一车辆的人工驾驶轨迹,将预测得到的所述人工驾驶轨迹作为所述第一轨迹。
在一种示例中,当所述第一车辆处于人工驾驶模式时,所述智能驾驶域控制器预测所述第一车辆的人工驾驶轨迹,具体方法可以为:所述智能驾驶域控制器获取第一参数集合,所述第一参数集合包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态,所述第一车辆的行驶状态用于指示当前驾驶所述第一车辆的用户的驾驶习惯;所述智能驾驶域控制器获取所述第一车辆对应的轨迹预测模型,所述轨迹预测模型根据当前驾驶所述第一车辆的用户的驾驶习惯的历史数据训练获得;所述智能驾驶域控制器根据所述第一参数集合和所述轨迹预测模型预测所述第一车辆的轨迹点;所述智能驾驶域控制器根据所述第一车辆的轨迹点确定所述第一车辆的人工驾驶轨迹。
示例性地,所述第一车辆的位置可以包括标识所述第一车辆当前时刻所在位置在地球坐标系中的经度(P_long)和纬度(P_lati)。可选地,在轨迹预测模型训练的过程中,可以将预测的结果和所述第一车辆的位置进行对比,来确认预测结果是否准确,来不断调整模型,来使训练的到的轨迹预测模型的准确性较高。
所述第一车辆周围障碍物包括一个或多个障碍物,任一个障碍物的行驶数据可以包括所述任一个障碍物相对所述第一车辆的相对速度(Obj_v)和相对距离(Obj_d)。需要说明的是,任一个障碍物在这里可以是一辆车辆,例如第二车辆。
所述第一车辆的行驶状态可以包括所述第一车辆所在的道路的当前车道属性、道路半径(road_radius)、所述第一车辆的速度、加速度、加速踏板开度(Acc_ped)、制动踏板开度(Bra_ped)、右前制动轮缸(P_(Cy,FR))、左前制动轮缸(P_(Cy,FL))、右后制动轮缸(P_(Cy,RR))、左后制动轮缸(P_(Cy,RL))、方向盘转角(Ste_ang)、方向盘转向角速度(Ste_angv)、方向盘转矩(Ste_torq)、档位(gear)、转向灯信号(Turn_sig)。
其中,所述道路的当前车道属性可以是当前道路的车道数量、车道是弯道还是直道等等。在当前车道是弯道时,所述道路半径可以是弯道半径;在当前车道为直道时,所述道路半径可以是零,或者无穷大。所述加速踏板开度是指加速踏板开合的百分比,其中,可以将加速踏板被踩到底时认为是百分之百,将加速踏板没有被踩下时认为是零。所述右前制动轮缸、所述左前制动轮缸、所述右后制动轮缸和所述左后制动轮缸分别为第一车辆每个车轮上的控制参数。所述档位为自动驾驶车辆在行驶过程中前进档中划分的不同级别,不同的级别对应不同速度。
基于上述参数所述第一车辆的智能驾驶域控制器预测的所述第一车辆的轨迹点可以包括所述第一车辆预测行驶轨迹(也即预测的人工驾驶轨迹)中包括的预测经度和预测纬度。可选的,所述第一车辆的轨迹点还包括所述预测经度的置信度和所述预测纬度的置信度。其中,所述第一车辆的轨迹点可以是轨迹点集合,可以包含一段时间内(例如5s)内的轨迹点。其中,预测精度的置信度标识了预测精度的准确率,预测纬度的置信度标识了预测纬度的准确率,这样在根据轨迹点得到预测轨迹时,可以了解轨迹点的准确率,明确预测轨迹的准确率。以使智能驾驶域控制器选择准确率较高的预测轨迹进行后续的轨迹规划。
在具体实施时,不同用户有不同的驾驶习惯,不同用户驾驶第一车辆时的相关参数也不相同。其中,障碍物的相对距离、相对速度、道路的车道属性、道路半径描述了驾驶员(即用户)所处的环境,车辆的速度、加速度描述了车辆状态,加速踏板开度描述了当前环境和车辆状态下驾驶员踩油门的习惯,制动踏板开度、右前制动轮缸、左前制动轮缸、右后制动轮缸、左后制动轮缸描述了当前环境和车辆状态下驾驶员踩刹车的习惯,方向盘转角、方向盘转向角速度、方向盘转矩、转向灯信号描述了当前环境和车辆状态下驾驶员转向的习惯。不同的驾驶员在驾驶车辆时,上述参数是不相同的。本申请中,针对不同用户,根据每个用户的驾驶习惯分别进行训练,训练符合该用户的预设神经网络模型的参数,从而可以预测出符合自身特性的轨迹。
具体地,上述涉及所述第一车辆的行驶状态仅指示了当前驾驶所述第一车辆的用户的驾驶习惯,所述预测神经网络模型也是针对驾驶所述第一车辆的用户的驾驶习惯训练得到的。例如,在具体训练时,可以通过云服务器进行模型训练,云服务器将训练好的模型参数发送给所述智能驾驶域控制器。在云服务器进行模型训练时,所用的训练集包括输入集和输出集,其中,输入集可以是所述第一车辆的智能驾驶域控制器记录的当前驾驶所述第一车辆的用户在过去一段时间内或实时驾驶所述第一车辆时获取的多个参数集合,每个参数集合均与所述第一参数集合包括的参数相同;每个参数集合对应的第一车辆的轨迹点作为输出集,也即模型训练时的期望输出。具体的,所述智能驾驶域控制器将上述训练集通过V2X发送到所述云服务器。示例性的,所述云服务器的训练过程可以如下:
(1)网络确定:即确定所述预测神经网络模型的尺寸。其中,采用试凑法确定隐含层的神经元数目,具体地,先设置较少的神经元数目来训练网络,然后逐个增加,用同一样本集进行训练,对比结果,当结果不再有改善时,停止增加神经元数目,确定最佳的神经元数目。在本申请中,所述预测神经网络模型可以包含一个输入层,一个隐含层和一个输出层。
其中,隐含层神经元数目可以先根据经验公式确定,然后逐个增加。可选地,经验公式可参考下述公式一或其他公式:
Figure BDA0002334075180000071
其中,m为输入集维数(也即输入集的参数个数),l为输出集维数。
(2)训练模型:即确定预测神经网络模型的模型参数。
例如,隐含层的输出集为{S0,S1,……,St,St+1,……};其中,隐含层的输出集是将训练集的输入集输入模型后,根据设定的隐含层的函数得到的训练过程中的中间值集合,其中,输入集可以是所述第一车辆的智能驾驶域控制器记录的当前驾驶所述第一车辆的用户在过去一段时间内或实时驾驶所述第一车辆时获取的多个参数集合,每个参数集合均与所述第一参数集合包括的参数相同;具体的隐含层的输出函数符合如下述公式二:
St=f(U×Xt+W×St-1) 公式二;
其中,Xt为训练集中的输入集,U和W为权重系数;
则得到训练集中的输出集Ot符合以下公式三:
Ot=softmax(VSt) 公式三;
其中,softmax(VSt)是规划指数函数,其中,规划指数函数用于将隐含层的书输出集处理得到轨迹预测模型的最终输出结果;V为权重矩阵。
进一步地,通过损失函数,计算损失值,调整模型参数,直至损失函数几乎不再改善。其中,损失函数用于使训练好的模型达到模型精度要求。使用训练集训练模型,使用未训练的数据集测试训练好的模型,当模型精度达到要求时,确定模型参数U、W、V,即得到针对当前驾驶所述第一车辆的用户的驾驶习惯的预测轨迹模型。示例性的,所述损失函数J可以符合以下公式四:
Figure BDA0002334075180000081
其中,N为训练集包含的输入集和输出集对的数目。
基于上述过程,云服务器就完成了预测神经网络模型的训练,然后云服务器将最后确定的模型参数U、W、V传输给所述第一车辆的智能驾驶域控制器,以使所述智能驾驶域控制器预测所述第一车辆的轨迹点。
在一种可选的实施方式中,所述第一车辆的智能驾驶域控制器可以向云服务器发送所述第一参数集合和所述第一车辆的轨迹点,以使所述云服务器根据所述第一参数集合和所述第一车辆的轨迹点校正所述轨迹预测模型;之后所述智能驾驶域控制器接收所述云服务器发送的校正后的轨迹预测模型,并利用所述校正后的轨迹预测模型和第二参数集合预测所述第一车辆的轨迹点,所述第二参数集为当前时刻收集的包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态的数据。也就是说所述云服务器可以根据智能车的智能驾驶域控制器或非智能车的控制器发送的驾驶数据不断更新之前训练好的轨迹预测模型,以使模型训练越来越准确,进而使车辆的轨迹预测越来越准确,从而可以进行更加准确的轨迹规划,提高安全性。
对于每个车辆而言,可以由其车载控制器收集当前驾驶员的驾驶数据,并将该数据发送至云服务器,再由云服务器根据驾驶数据训练获得与当前驾驶员驾驶习惯匹配的定制化驾驶模型,并将该定制化驾驶模型发送给车载控制器。当第一车辆的智能驾驶域控制器进行自车轨迹预测时,可以根据各个车辆发送的预测的行驶轨迹确定自车的行驶轨迹。可选地,第一车辆的智能驾驶域控制器也可以获取周围车辆的驾驶模型和当前时刻驾驶员的驾驶数据,并根据上述驾驶模型和驾驶数据分别预测各个车辆的行驶轨迹。作为一种可能的实施例,上述各个车辆的行驶轨迹的预测过程也可以由云服务器完成,各个车辆将自车当前时刻驾驶员的驾驶数据发送至云服务器,由云服务器分别根据每辆车对应的定制化驾驶模型预测行驶轨迹,并将该预测的行驶轨迹发送给第一车辆的智能驾驶域控制器,以使得该智能域驾驶域控制器确定第一车辆的行驶轨迹。
在一种具体的实施方式中,所述第一车辆的智能驾驶域控制器在获取了所述第一轨迹之后,向所述至少一辆第二车辆发送所述第一轨迹,以使所述至少一辆第二车辆中的任一辆第二车辆结合自身的轨迹进行轨迹规划。
步骤302:至少一辆第二车辆中每辆第二车辆的智能驾驶域控制器分别获取所述每辆第二车辆的第二轨迹。其中,图3中以两辆第二车辆示意,但是应理解,图3中车辆的数量并不作为对至少一辆的数量的限定,可以为一辆,或者比两辆多的第二车辆。
具体的,任一辆第二车辆的智能驾驶域控制器获取第二轨迹的方法,与步骤301中所述第一车辆的智能驾驶域控制器获取所述第一轨迹的方法相同,可以相互参见,此处不再详细描述。
步骤303:所述第一车辆的智能驾驶域控制器基于第一通信技术获取所述至少一辆第二车辆的第二轨迹。
在一种示例性的实现方式中,所述第一车辆的智能驾驶域控制器在获取其他车辆的数据或者向其他车辆发送数据时,均可以采用步骤303涉及的第一通信技术,例如,所述第一通信技术可以是V2X技术。
在一种可选的实施方式中,所述第一车辆的智能驾驶域控制器在获取其他车辆(例如至少一辆第二车辆)的数据或者向其他车辆发送数据之前,所述智能驾驶域控制器确定当前时刻处于预设的与其他车辆通信的时间周期内;或者,所述智能驾驶域控制器确定与其他车辆已通过安全认证,也即通过鉴权结果建立互信,也即所述智能驾驶域控制器需要建立所述第一车辆与所述至少一辆第二车辆之间的互信。也就是说,第一车辆如果需要获取其他车辆的行驶轨迹,需要先取得对方的安全认证,在双方通过彼此的安全认证取得互信后,第一车辆才能获知对方的行驶轨迹,以此提升车辆在道路上行驶中安全性。可选地,第一车辆可以通过如下方式与其他车辆建立互信:所述智能驾驶域控制器确定所述至少一辆第二车辆在预设范围内,所述预设定范围为以所述第一车辆为圆心的圆形区域,所述圆形区域的半径为设定值;然后,智能驾驶控制器向预设范围内的车辆发送安全认证消息,其中,该安全认证消息中包括安全认证的类型(如,基于口令的认证、数字签名(digitalsignature)认证)、第一车辆的标识(如车辆设备号);其他车辆根据安全认证消息进行处理和应答,再由智能驾驶域控制器根据应答消息建立与周围车辆的信任关系,进而获取周围车辆预测的行驶轨迹。另一方面,不同车辆之间互信认证的过程需要在预设时间内进行确认。例如,车辆间可以周期性确认互信状态,或者,在第一次建立互信后即维持互信链路,通过该互信链路实时监控安全认证的状态。
需要说明的是,上述步骤301-步骤303的排序并不对方案执行的先后顺序进行限定。应理解,可以先执行步骤302、步骤303然后再执行步骤301;或者执行顺序可以是步骤302、步骤301、步骤303等。
步骤304:所述第一车辆的智能域驾驶控制器根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划。
在一种可选的实施方式中,所述第一车辆的智能驾驶域控制器在确定所述第一车辆的轨迹规划时,可以符合以下原则:确保不能违反交通规则,例如不能闯红灯、不能超速、不能在应急车道行驶,不能压实线等等;确保与障碍物(如其他车辆)之间的距离需要大于预设值,以预留有效的刹车范围;确保不与障碍物(如其他车辆)在同一时刻位于同一个位置。当然,还有其他原则或者规则,本申请此处不再一一列举。
在轨迹规划过程中,当任一第二车辆为特殊车辆,例如救护车、消防车等的轨迹时,所述第一车辆的智能驾驶域控制器可以对相应的轨迹进行特殊标记,从而可以实现为特殊车辆让路。
采用上述方法,在智能车行驶过程中,第一车辆的智能驾驶域控制器可以获取自车的行驶轨迹,以及获取其他车辆根据定制化的轨迹预测模型确定的行驶轨迹,然后基于获取的定制化的行驶轨迹对第一车辆进行轨迹规划。上述方法能够获得人工驾驶模式的智能车或非智能车中每个驾驶员定制化的轨迹预测模型,并按照各自的驾驶习惯预测其行驶轨迹,相比于传统技术中采用统一规则进行轨迹预测的方法,预测结果更接近车辆的行驶轨迹。进一步地,智能驾驶域控制器可以根据上述获取预测模型获得的预测轨迹确定自车的行驶轨迹,合理规划自车行驶轨迹,降低与其他车辆碰撞的风险,提升智能车行驶安全。
基于以上实施例,以一个具体的示例,对本申请实施例提供的一种轨迹规划方法进行说明。以图2为例,假设车辆1为处于人工驾驶模式的自动驾驶车辆,车辆2为处于自动驾驶模式的自动驾驶车辆,车辆3为人工驾驶车辆,其中,这里提到的人工驾驶车辆是指包含自动驾驶车辆的设备,但是由驾驶员控制车辆的行驶。在三辆车辆的行驶过程中,车辆1、车辆2和车辆3之间先分别通过彼此的安全认证取得互信,然后,获取彼此的行车轨迹进而实现轨迹规划。具体的,下面以车辆1的轨迹规划过程为例进行说明。车辆1的智能驾驶域控制器确定车辆2和车辆3在以车辆1为圆心的,半径为设定值的圆形区域内,然后向车辆2和车辆3发送安全认证消息,所述安全认证消息中包括安全认证类型、车辆1的标识,之后在车辆2和车辆3根据车辆1发送的安全认证消息确认可以和车辆1进行通信后分别向车辆1发送安全认证应答消息,以告知车辆1互信建立成功。互信建立后,车辆1的智能驾驶域控制器获取车辆1当前位置所在的经度和维度,再分别获取车辆2和车辆3相对车辆1的相对速度和相对距离,以及道路的当前车道属性、道路半径、车辆1的速度、加速度、加速踏板开度、制动踏板开度、右前制动轮缸、左前制动轮缸、右后制动轮缸、左后制动轮缸、方向盘转角、方向盘转向角速度、方向盘转矩、档位、转向灯信号;然后,车辆1的智能驾驶域控制器从云服务器获取符合当前即使车辆1的驾驶员的驾驶习惯的轨迹预测模型,并将上述数据输入获取的该轨迹预测模型得到预测的车辆1的轨迹点,进而得到车辆1的人工驾驶轨迹,并将预测的人工驾驶轨迹发送给车辆2和车辆3。车辆1的智能驾驶域控制器获取车辆2的自动驾驶轨迹,以及获取基于驾驶车辆3的驾驶员的驾驶习惯的轨迹预测模型得到车辆3人工驾驶轨迹。这样车辆1就可以根据自身预测的轨迹以及车辆2和车辆3预设时段内的轨迹进行自身的轨迹规划。具体地,车辆1获取的自身的轨迹在预设时段内是保持当前车道直行,车辆1获取的车辆3的预设时段的行驶轨迹是保持在车辆1的相邻右侧车道保持直行,车辆1获取的车辆2的预设时段的行驶轨迹是在与车辆3相同车道并在车辆3后边先直行后在车辆1所在的车道超越车辆3行驶。基于上述预测的行驶轨迹,车辆1可以在给车辆2预留变道距离的前提下,继续保持直行,例如们可以在直行过程中减速,直至车辆2成功变道后再恢复适当提高速度继续直行,以避免与车辆2发生碰撞;或者,车辆1在确定与车辆3的距离足够大后,更新预测的轨迹,例如,可以在车辆2变道的同时或者在车辆2变道后从直行变为变道行驶,变到车辆3所在的车道后,在车辆3后边保持直线行驶,且与车辆3保持设定距离,以避免与车辆2和车辆3发生碰撞。
通过上述方法,车辆可以结合预设时段内其他车辆的轨迹以及自身的轨迹进行轨迹规划,其中每辆车辆的轨迹都与车辆的当前驾驶状态匹配,有驾驶员驾驶的车辆更是基于各自的驾驶习惯得到的行驶轨迹,相对于传统技术采用统一规则进行轨迹预测的方法,预测结果更接近车辆的行驶轨迹,是车辆用来进行轨迹规划的预测轨迹更接近车辆行驶轨迹,从而可以使轨迹规划比较准确,可以确保自车不与其他任一车辆在同一时刻出现在同一位置,避免发生碰撞,从而可以提高行驶安全性。
上文中结合图1至图3,详细描述了根据本申请所提供的车辆轨迹规划的方法,下面将结合图4至图6,描述根据本申请所提供的轨迹规划的装置、智能驾驶域控制器和智能车。
图4为本申请提供的一种车辆轨迹规划的装置的结构示意图,如图所示,所述车辆轨迹规划的装置400可以包括获取单元401和处理单元402,具体的:
所述获取单元401用于获取所述第一车辆的第一轨迹;以及基于第一通信技术获取至少一辆第二车辆的第二轨迹;
所述处理单元402用于根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划。
可选地,所述获取单元401在获取所述第一车辆的第一轨迹时,具体用于:确定所述第一车辆当前的驾驶模式,所述驾驶模式包括自动驾驶模式和人工驾驶模式;根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹。
可选地,所述获取单元401在根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹时,具体用于:当确定为自动驾驶模式时,获取所述第一车辆的自动驾驶轨迹,将所述自动驾驶轨迹作为所述第一轨迹。
可选地,所述获取单元401在根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹时,具体用于:当确定为人工驾驶模式时,预测所述第一车辆的人工驾驶轨迹,将预测得到的所述人工驾驶轨迹作为所述第一轨迹。
具体的,所述获取单元401在预测所述第一车辆的人工驾驶轨迹时,具体用于:获取第一参数集合,所述第一参数集合包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态,所述第一车辆的行驶状态用于指示当前驾驶所述第一车辆的用户的驾驶习惯;获取所述第一车辆对应的轨迹预测模型,所述轨迹预测模型为根据当前驾驶所述第一车辆的用户的驾驶习惯的历史数据训练获得;根据所述第一参数集合和所述轨迹预测模型预测所述第一车辆的轨迹点;根据所述第一车辆的轨迹点确定所述第一车辆的人工驾驶轨迹。
示例性的,所述第一车辆的位置包括标识所述第一车辆所在位置的经度和纬度;所述第一车辆周围障碍物包括一个或多个障碍物,任一个障碍物的行驶数据包括所述任一个障碍物相对所述第一车辆的相对速度和相对距离;所述第一车辆的行驶状态包括所述第一车辆所在的道路的当前车道属性、道路半径、所述第一车辆的速度、加速度、加速踏板开度、制动踏板开度、右前制动轮缸、左前制动轮缸、右后制动轮缸、左后制动轮缸、方向盘转角、方向盘转向角速度、方向盘转矩、档位、转向灯信号。
可选的,所述任一个障碍物的行驶数据还包括所述任一个障碍物的相对速度的置信度。
可选地,所述第一车辆的轨迹点包括所述第一车辆预测行驶轨迹中包括的预测经度和预测纬度。
可选的,所述第一车辆的轨迹点还包括所述预测经度的置信度和所述预测纬度的置信度。
可选地,所述车辆轨迹规划的装置400还包括发送单元403,用于向云服务器发送所述第一参数集合和所述第一车辆的轨迹点,以使所述云服务器根据所述第一参数集合和所述第一车辆的轨迹点校正所述轨迹预测模型;所述获取单元401还用于接收所述云服务器发送的校正后的轨迹预测模型,并利用所述校正后的轨迹预测模型和第二参数集合预测所述第一车辆的轨迹点,所述第二参数集为当前时刻收集的包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态的数据。
可选地,所述车辆轨迹规划的装置400还包括发送单元403,用于向所述至少一辆第二车辆发送所述第一轨迹。
可选地,所述处理单元402还用于:确定所述至少一辆第二车辆在设定范围内,所述设定范围为以所述第一车辆为圆心的圆形区域,所述圆形区域的半径为设定值;或者,确定与所述至少一辆第二车辆已通过安全认证。
可选地,所述第一通信技术为车用无线通信技术V2X。
应理解的是,本申请实施例的车辆轨迹规划的装置400可以通过专用集成电路(application-specific integrated circuit,ASIC)实现,或可编程逻辑器件(programmable logic device,PLD)实现,上述PLD可以是复杂程序逻辑器件(complexprogrammable logical device,CPLD),现场可编程门阵列(field-programmable gatearray,FPGA),通用阵列逻辑(generic array logic,GAL)或其任意组合。也可以通过软件实现图3所示的轨迹规划的方法时,车辆轨迹规划的装置400及其各个模块也可以为软件模块。
根据本申请实施例的车辆轨迹规划的装置400可对应于执行本申请实施例中描述的方法,并且车辆轨迹规划的装置400中的各个单元的上述和其它操作和/或功能分别为了实现图3中的各个方法的相应流程,为了简洁,在此不再赘述。
通过上述车辆轨迹规划的装置400,在智能车行驶过程中,可以获取自车的行驶轨迹,以及获取其他车辆根据定制化的轨迹预测模型确定的行驶轨迹,然后基于获取的定制化的行驶轨迹对自车进行轨迹规划。通过上述装置,能够获得人工驾驶模式的智能车或非智能车中每个驾驶员定制化的轨迹预测模型,并按照各自的驾驶习惯预测其行驶轨迹,相比于传统技术中采用统一规则进行轨迹预测,预测结果更接近车辆的行驶轨迹。进一步地,上述装置可以根据上述获取预测模型获得的预测轨迹确定自车的行驶轨迹,合理规划自车行驶轨迹,降低与其他车辆碰撞的风险,提升智能车行驶安全。
在一种可选的实施方式中,图4中的所述获取单元401和处理单元402可以通过更细化的一个或多个功能模块或单元共同来实现其功能,可选地,可以通过图5示出的各个单元来实现。例如,所述获取单元401可以通过如图5示出的装置中的毫米波雷达数据处理单元501、激光雷达数据处理单元502、相机图像数据处理单元503、车身数据处理单元504、定位数据处理单元505、数据记录单元506和轨迹预测单元507实现;所述发送单元403可以通过图5示出的数据收发单元508和人机接口(human machine interface,HMI)信号发送单元509。
其中,毫米波雷达数据处理单元501:用于接收毫米波雷达(例如图1所示的毫米波雷达101)发送的数据。当接收到的数据是周围障碍物的距离、速度等数据时,将坐标系转换为统一的车体坐标系,并打时间戳后发送给数据记录单元506和轨迹预测单元507;当接收到的数据是到达障碍物的光束传输时间和光束的速度时,先计算得到周围障碍物的距离、速度等数据,并发送给数据记录单元506和轨迹预测单元507。
激光雷达数据处理单元502:用于接收激光雷达(例如图1所示的激光雷达102)发送的数据。当接收到的数据是周围障碍物的距离、速度等数据时,将坐标系转换为统一的车体坐标系,并打时间戳后发送给数据记录单元506和轨迹预测单元507;当接收到的数据是从障碍物反射回来的信号和发射信号时,先计算得到周围障碍物的距离、速度等数据,并发送给数据记录单元506和轨迹预测单元507。
相机图像处理单元503:接收相机(例如图1所示的相机103)传输的数据。当接收到的是智能摄像头发送的周围障碍物的速度和距离等数据时,将坐标系转换为统一的车体坐标系,并打时间戳后发送给数据记录单元506和轨迹预测单元507;当接收到的是图像或视频时,先分析图像或视频得周围障碍物的速度和距离等数据,并发送给数据记录单元506和轨迹预测单元507。
车身数据处理单元504:获取车辆(自车)的数据,例如获取图1所示的车辆其他控制器107发送的数据,并将获取的数据发送至数据记录单元506和轨迹预测单元507。
定位数据处理单元505:接收定位数据(例如从图1所示的高精度定位设备获取),发送至数据记录单元506和轨迹预测单元507。
数据记录单元506:将收到的数据存储到存储器(例如只读存储器(read-onlymemory,ROM))中,定期发送给数据收发单元508。
数据收发单元508:定期将收到的数据记录单元506发送的数据发送至云端(例如图1所示的云端100),定期接收云端模型参数,并发送给轨迹预测单元507,实时的将获取到的预测轨迹发送到周围车辆。
轨迹预测单元507:根据云端回传的参数,通过模型预测本车轨迹,并将轨迹发送给HMI信号发送单元509和数据收发单元508。
HMI信号发送单元509:将收到的轨迹发送给显示单元,以便驾驶员获知智能车的行驶轨迹。可选地,驾驶员也可以通过显示单元更改行驶轨迹。
通过上述装置,能够获得人工驾驶模式的智能车或非智能车中每个驾驶员定制化的轨迹预测模型,并按照各自的驾驶习惯预测其行驶轨迹,相比于传统技术中采用统一规则进行轨迹预测,预测结果更接近车辆的行驶轨迹。进一步地,上述装置可以根据上述获取预测模型获得的预测轨迹确定自车的行驶轨迹,合理规划自车行驶轨迹,降低与其他车辆碰撞的风险,提升智能车行驶安全。
图6为本申请实施例提供的一种智能驾驶域控制器的结构示意图,所述智能驾驶域控制器应用于如图1所示的***,用于实现如图3所示的车辆轨迹规划的方法。参阅图6所示,所述智能驾驶域控制器600可以包括:处理器601、存储器602和总线603。其中,处理器601和存储器602通过总线603进行通信,也可以通过无线传输等其他手段实现通信。该存储器602用于存储指令,该处理器601用于执行该存储器602存储的指令。该存储器602存储程序代码,且处理器601可以调用存储器602中存储的程序代码执行以下操作:
获取所述第一车辆的第一轨迹,以及第一通信技术获取至少一辆第二车辆的第二轨迹;并根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划。
可选地,图6所示的智能驾驶域控制器600还包括内存和通信接口(图6中未示出),其中,内存可以与处理器物理集成在一起,或在处理器内或以独立单元形式存在。计算机程序可以存储至内存或存储器。可选地,存储至存储器的计算机程序代码(例如,内核,要调试的程序等)被复制到内存,进而由处理器执行。
应理解,在本申请实施例中,该处理器601可以是中央处理器(centralprocessing unit,CPU),该处理器601还可以是其他通用处理器、数字信号处理器(digitalsignal processing,DSPDSP)、专用集成电路(application-specific integratedcircuit,ASIC)、可编程逻辑器件(programmable logic device,PLD);上述PLD可以是复杂可编程逻辑器件(complex programmable logic device,CPLD),现场可编程门阵列(field-programmable gate array,FPGA)、通用阵列逻辑(generic array logic,GAL)或其任意组合;或者该处理器601可以是其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。通用处理器可以是微处理器或者是任何常规的处理器等。
该存储器602可以包括只读存储器和随机存取存储器,并向处理器601提供指令、程序和数据等。例如,程序可以包括程序代码,该程序代码包括计算机操作指令。存储器602还可以包括非易失性随机存取存储器。例如,存储器602还可以存储设备类型的信息。
该存储器602可以是易失性存储器或非易失性存储器,或可包括易失性和非易失性存储器两者。其中,非易失性存储器可以是只读存储器(read-only memory,ROM)、可编程只读存储器(programmable ROM,PROM)、可擦除可编程只读存储器(erasable PROM,EPROM)、电可擦除可编程只读存储器(electrically EPROM,EEPROM)或闪存。易失性存储器可以是随机存取存储器(random access memory,RAM),其用作外部高速缓存。通过示例性但不是限制性说明,许多形式的RAM可用,例如静态随机存取存储器(static RAM,SRAM)、动态随机存取存储器(DRAM)、同步动态随机存取存储器(synchronous DRAM,SDRAM)、双倍数据速率同步动态随机存取存储器(double data date SDRAM,DDR SDRAM)、增强型同步动态随机存取存储器(enhanced SDRAM,ESDRAM)、同步连接动态随机存取存储器(synchlinkDRAM,SLDRAM)和直接内存总线随机存取存储器(direct rambus RAM,DR RAM)。
该总线603除包括数据总线之外,还可以包括地址总线、电源总线、控制总线和状态信号总线等。该总线603可以是外设部件互连标准(peripheral componentinterconnect,PCI)总线或扩展工业标准结构(extended Industry standardarchitecture,EISA)总线等,也可以是控制区域网络(controller area network,CAN),还可以是车载以太(Ethernet),或者其他内部总线实现图6所示的各个器件/设备的连接。但是为了清楚说明起见,在图6中将各种总线都标为总线603。为便于表示,图6中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
应理解,根据本申请实施例的智能驾驶域控制器600可对应于本申请实施例中的车辆轨迹规划的装置400,并可以对应于执行图3所示方法中的智能驾驶域控制器作为主体的操作步骤,并且智能驾驶域控制器600中的各个模块的上述和其它操作和/或功能分别为了实现图3中的各个方法的相应流程,为了简洁,在此不再赘述。
通过上述智能驾驶域控制器600,在智能车行驶过程中,可以获取自车的行驶轨迹,以及获取其他车辆根据定制化的轨迹预测模型确定的行驶轨迹,然后基于获取的定制化的行驶轨迹对自车进行轨迹规划。通过上述智能驾驶域控制器600,能够获得人工驾驶模式的智能车或非智能车中每个驾驶员定制化的轨迹预测模型,并按照各自的驾驶习惯预测其行驶轨迹,相比于传统技术中采用统一规则进行轨迹预测,预测结果更接近车辆的行驶轨迹。进一步地,上述智能驾驶域控制器600可以根据上述获取预测模型获得的预测轨迹确定自车的行驶轨迹,合理规划自车行驶轨迹,降低与其他车辆碰撞的风险,提升智能车行驶安全。
本申请还提供了一种智能车,所述智能车可以包含上述涉及的智能驾驶域控制器或者车辆轨迹规划的装置。在一种示例中,所述智能车可以为本申请涉及的第一车辆。
本申请还提供一种如图1所示的轨迹预测***,该轨迹预测***包括第一车辆、至少一个第二车辆和云端,上述各个部件或设备分别用于执行上述图3所示方法中相应执行主体的操作步骤,为了简洁,在此不再赘述。
上述实施例,可以全部或部分地通过软件、硬件、固件或其他任意组合来实现。当使用软件实现时,上述实施例可以全部或部分地以计算机程序产品的形式实现。所述计算机程序产品包括一个或多个计算机指令。在计算机上加载或执行所述计算机程序指令时,全部或部分地产生按照本申请实施例所述的流程或功能。所述计算机可以为通用计算机、专用计算机、计算机网络、或者其他可编程装置。所述计算机指令可以存储在计算机可读存储介质中,或者从一个计算机可读存储介质向另一个计算机可读存储介质传输,例如,所述计算机指令可以从一个网站站点、计算机、服务器或数据中心通过有线(例如同轴电缆、光纤、数字用户线(DSL))或无线(例如红外、无线、微波等)方式向另一个网站站点、计算机、服务器或数据中心进行传输。所述计算机可读存储介质可以是计算机能够存取的任何可用介质或者是包含一个或多个可用介质集合的服务器、数据中心等数据存储设备。所述可用介质可以是磁性介质(例如,软盘、硬盘、磁带)、光介质(例如,DVD)、或者半导体介质。半导体介质可以是固态硬盘(solid state drive,SSD)。
所属领域的技术人员可以清楚地了解到,为描述的方便和简洁,上述描述的***、装置和单元的具体工作过程,可以参考前述方法实施例中的对应过程,在此不再赘述。
在本申请所提供的几个实施例中,应该理解到,所揭露的***、装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的,例如,所述单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个单元或组件可以结合或者可以集成到另一个***,或一些特征可以忽略,或不执行。另一点,所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口,装置或单元的间接耦合或通信连接,可以是电性,机械或其它的形式。
所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部单元来实现本申请的技术方案的目的。
以上所述,仅为本申请的具体实施方式。熟悉本技术领域的技术人员根据本申请提供的具体实施方式,可想到变化或替换,都应涵盖在本申请的保护范围之内。

Claims (13)

1.一种车辆轨迹规划的方法,其特征在于,所述方法应用于第一车辆的智能驾驶域控制器,所述第一车辆为智能车,所述方法包括:
所述智能驾驶域控制器获取所述第一车辆的第一轨迹;
所述智能驾驶域控制器基于第一通信技术获取至少一辆第二车辆的第二轨迹;
所述智能驾驶域控制器根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划;
其中,在所述智能驾驶域控制器基于所述第一通信技术获取所述至少一辆第二车辆的第二轨迹之前,所述方法还包括:所述智能驾驶域控制器确定当前时刻处于预设的与所述至少一辆第二车辆通信的时间周期内;或者,所述智能驾驶域控制器建立所述第一车辆与所述至少一辆第二车辆之间的互信,其中所述第一车辆与所述至少一辆第二车辆之间的互信表示所述第一车辆与所述至少一辆第二车辆之间已通过安全认证。
2.如权利要求1所述的方法,其特征在于,所述智能驾驶域控制器获取所述第一车辆的第一轨迹,包括:
所述智能驾驶域控制器确定所述第一车辆当前的驾驶模式,所述驾驶模式包括自动驾驶模式和人工驾驶模式;
所述智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹。
3.如权利要求2所述的方法,其特征在于,所述智能驾驶域控制器根据所述第一车辆的驾驶模式获取所述第一车辆的第一轨迹,包括:
当所述智能驾驶域控制器确定为人工驾驶模式时,所述智能驾驶域控制器预测所述第一车辆的人工驾驶轨迹,将预测得到的所述人工驾驶轨迹作为所述第一轨迹。
4.如权利要求3所述的方法,其特征在于,所述智能驾驶域控制器预测所述第一车辆的人工驾驶轨迹,包括:
所述智能驾驶域控制器获取第一参数集合,所述第一参数集合包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态,所述第一车辆的行驶状态用于指示当前驾驶所述第一车辆的用户的驾驶习惯;
所述智能驾驶域控制器获取所述第一车辆对应的轨迹预测模型,所述轨迹预测模型为根据当前驾驶所述第一车辆的用户的驾驶习惯的历史数据训练获得;
所述智能驾驶域控制器根据所述第一参数集合和所述轨迹预测模型预测所述第一车辆的轨迹点;
所述智能驾驶域控制器根据所述第一车辆的轨迹点确定所述第一车辆的人工驾驶轨迹。
5.如权利要求4所述的方法,其特征在于,
所述第一车辆的位置包括标识所述第一车辆所在位置的经度和纬度;
所述第一车辆周围障碍物包括一个或多个障碍物,任一个障碍物的行驶数据包括所述任一个障碍物相对所述第一车辆的相对速度和相对距离;
所述第一车辆的行驶状态包括所述第一车辆所在的道路的当前车道属性、道路半径、所述第一车辆的速度、加速度、加速踏板开度、制动踏板开度、右前制动轮缸、左前制动轮缸、右后制动轮缸、左后制动轮缸、方向盘转角、方向盘转向角速度、方向盘转矩、档位、转向灯信号。
6.如权利要求4至5中任一项所述的方法,其特征在于,所述第一车辆的轨迹点包括所述第一车辆预测行驶轨迹中包括的预测经度和预测纬度。
7.如权利要求4至5中任一项所述的方法,其特征在于,所述方法还包括:
所述智能驾驶域控制器向云服务器发送所述第一参数集合和所述第一车辆的轨迹点,以使所述云服务器根据所述第一参数集合和所述第一车辆的轨迹点校正所述轨迹预测模型;
所述智能域控制器接收所述云服务器发送的校正后的轨迹预测模型;
所述智能驾驶域控制器利用所述校正后的轨迹预测模型和第二参数集合预测所述第一车辆的轨迹点,所述第二参数集为当前时刻收集的包括所述第一车辆的位置、所述第一车辆周围障碍物相对于所述第一车辆的行驶数据和所述第一车辆的行驶状态的数据。
8.如权利要求1至5中任一项所述的方法,其特征在于,所述方法还包括:
所述智能驾驶域控制器向所述至少一辆第二车辆发送所述第一轨迹。
9.如权利要求1至5中任一项所述的方法,其特征在于,所述方法还包括:
所述智能驾驶域控制器确定所述至少一辆第二车辆在设定范围内,所述设定范围为以所述第一车辆为圆心的圆形区域,所述圆形区域的半径为设定值;或者
所述智能驾驶域控制器确定与所述至少一辆第二车辆已通过安全认证。
10.如权利要求1至5中任一项所述的方法,其特征在于,所述方法还包括:
所述智能驾驶域控制器按照如下规则中至少一种规则确定所述第一车辆的行驶轨迹:
规则一:不违反交通规则;
规则二:与障碍物之间的距离需要大于预设值;
规则三:不与障碍物在同一时刻位于同一个位置。
11.一种车辆轨迹规划的装置,其特征在于,包括获取单元和处理单元,其中:
所述获取单元,用于获取第一车辆的第一轨迹;以及基于第一通信技术获取至少一辆第二车辆的第二轨迹;
所述处理单元,用于根据所述第一轨迹和所述至少一辆第二车辆的第二轨迹确定所述第一车辆的轨迹规划;
所述处理单元,还用于:在所述获取单元基于所述第一通信技术获取所述至少一辆第二车辆的第二轨迹之前,确定当前时刻处于预设的与所述至少一辆第二车辆通信的时间周期内;或者,建立所述第一车辆与所述至少一辆第二车辆之间的互信。
12.一种智能驾驶域控制器,其特征在于,包括处理器和存储器,所述存储中存储计算机程序指令,所述智能驾驶域控制器运行时,所述处理器执行所述存储其中存储的所述计算机程序指令以实现上述权利要求1至10中任一所述的方法的操作步骤。
13.一种智能车,其特征在于,所述智能车包括智能驾驶域控制器,所述智能驾驶域控制器用于执行权利要求12所述的智能驾驶域控制器的功能。
CN201911348578.5A 2019-12-24 2019-12-24 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车 Active CN111123933B (zh)

Priority Applications (4)

Application Number Priority Date Filing Date Title
CN201911348578.5A CN111123933B (zh) 2019-12-24 2019-12-24 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
PCT/CN2020/132412 WO2021129309A1 (zh) 2019-12-24 2020-11-27 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
EP20906290.0A EP4075227B1 (en) 2019-12-24 2020-11-27 Method and device for vehicle path planning, associated controller and vehicle
US17/848,216 US20220324481A1 (en) 2019-12-24 2022-06-23 Method and apparatus for planning vehicle trajectory, intelligent driving domain controller, and intelligent vehicle

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911348578.5A CN111123933B (zh) 2019-12-24 2019-12-24 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车

Publications (2)

Publication Number Publication Date
CN111123933A CN111123933A (zh) 2020-05-08
CN111123933B true CN111123933B (zh) 2021-10-01

Family

ID=70501923

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911348578.5A Active CN111123933B (zh) 2019-12-24 2019-12-24 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车

Country Status (4)

Country Link
US (1) US20220324481A1 (zh)
EP (1) EP4075227B1 (zh)
CN (1) CN111123933B (zh)
WO (1) WO2021129309A1 (zh)

Families Citing this family (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111123933B (zh) * 2019-12-24 2021-10-01 华为技术有限公司 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
CN113741384B (zh) * 2020-05-29 2023-12-29 华为技术有限公司 检测自动驾驶***的方法和装置
CN111766822A (zh) * 2020-07-22 2020-10-13 天津优控智行科技有限公司 一种无人驾驶配送车辆远程调试方法
CN112306059B (zh) * 2020-10-15 2024-02-27 北京三快在线科技有限公司 一种控制模型的训练方法、控制方法以及装置
CN112269385B (zh) * 2020-10-23 2021-09-07 北京理工大学 云端无人车动力学控制***和方法
CN114440908B (zh) * 2020-10-31 2023-07-28 华为技术有限公司 一种规划车辆驾驶路径的方法、装置、智能车以及存储介质
JP2022082359A (ja) * 2020-11-20 2022-06-01 国立大学法人東海国立大学機構 走行制御管理システム、走行制御管理方法、および走行制御管理プログラム
CN112550315A (zh) * 2020-12-21 2021-03-26 北京百度网讯科技有限公司 车辆轨迹规划方法、装置、电子设备及存储介质
CN113071520B (zh) * 2021-04-16 2024-01-16 阿波罗智联(北京)科技有限公司 车辆行驶控制方法及装置
CN113479219B (zh) * 2021-09-06 2021-11-26 智己汽车科技有限公司 一种行车轨迹规划方法、装置、计算机设备和介质
CN114291116B (zh) * 2022-01-24 2023-05-16 广州小鹏自动驾驶科技有限公司 周围车辆轨迹预测方法、装置、车辆及存储介质
CN115218902B (zh) * 2022-04-02 2024-02-02 广州汽车集团股份有限公司 一种轨迹规划方法、装置、设备及存储介质
WO2024020833A1 (zh) * 2022-07-27 2024-02-01 华为技术有限公司 一种定位***、方法
CN115042823B (zh) * 2022-07-29 2024-07-02 浙江吉利控股集团有限公司 一种代客泊车方法、装置、电子设备及存储介质
US20240075950A1 (en) * 2022-09-01 2024-03-07 Imagry Israel Ltd. Alternative Driving Models for Autonomous Vehicles
CN116339284A (zh) * 2023-03-29 2023-06-27 安徽海博智能科技有限责任公司 一种无人驾驶矿卡远程点火和熄火控制***及方法
CN116500896B (zh) * 2023-04-28 2024-03-15 重庆大学 智能网联汽车域控制器多虚拟cpu任务智能实时调度模型和方法
CN116743937B (zh) * 2023-08-14 2023-10-27 禾昆科技(北京)有限公司 域控制器和车辆行驶控制方法
CN116985766B (zh) * 2023-09-27 2024-01-30 深圳市昊岳科技有限公司 一种基于域控制器的碰撞缓解控制***及方法

Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104590274A (zh) * 2014-11-26 2015-05-06 浙江吉利汽车研究院有限公司 一种驾驶行为自适应***及驾驶行为自适应方法
CN108022450A (zh) * 2017-10-31 2018-05-11 华为技术有限公司 一种基于蜂窝网络的辅助驾驶方法及交通控制单元
CN108027242A (zh) * 2015-11-30 2018-05-11 华为技术有限公司 自动驾驶导航方法、装置、***、车载终端及服务器
CN108407717A (zh) * 2018-03-14 2018-08-17 杭州分数科技有限公司 车辆预警方法、***以及电子设备
CN108657176A (zh) * 2017-04-01 2018-10-16 华为技术有限公司 车辆控制方法、装置及相关计算机程序产品
CN108932462A (zh) * 2017-05-27 2018-12-04 华为技术有限公司 驾驶意图确定方法及装置
CN109389847A (zh) * 2017-08-14 2019-02-26 上海汽车集团股份有限公司 一种道路拥堵信息的处理方法和装置
CN109885058A (zh) * 2019-03-12 2019-06-14 杭州飞步科技有限公司 行车轨迹规划方法、装置、电子设备及存储介质
CN109910880A (zh) * 2019-03-07 2019-06-21 百度在线网络技术(北京)有限公司 车辆行为规划的方法、装置、存储介质和终端设备
CN109945880A (zh) * 2017-12-20 2019-06-28 华为技术有限公司 路径规划方法、相关设备及可读存储介质
CN110146100A (zh) * 2018-02-13 2019-08-20 华为技术有限公司 轨迹预测方法、装置及存储介质
US10421453B1 (en) * 2014-10-02 2019-09-24 Waymo Llc Predicting trajectories of objects based on contextual information
CN110287529A (zh) * 2019-05-23 2019-09-27 杭州飞步科技有限公司 测试方法、装置、设备以及存储介质
CN110366710A (zh) * 2017-02-27 2019-10-22 华为技术有限公司 用于控制自动驾驶车辆操作以确定规划路径的规划***和方法
CN110379193A (zh) * 2019-07-08 2019-10-25 华为技术有限公司 自动驾驶车辆的行为规划方法及行为规划装置

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP6288859B2 (ja) * 2015-07-07 2018-03-07 本田技研工業株式会社 車両制御装置、車両制御方法、および車両制御プログラム
US9934688B2 (en) * 2015-07-31 2018-04-03 Ford Global Technologies, Llc Vehicle trajectory determination
US10220705B2 (en) * 2015-08-12 2019-03-05 Madhusoodhan Ramanujam Sharing autonomous vehicles
CN107139917B (zh) * 2017-04-27 2019-05-31 江苏大学 一种基于混杂理论的无人驾驶汽车横向控制***和方法
KR101989102B1 (ko) * 2017-09-13 2019-06-13 엘지전자 주식회사 차량용 운전 보조 장치 및 그 제어 방법
RU2751382C1 (ru) * 2018-05-31 2021-07-13 Ниссан Норт Америка, Инк. Планирование траектории
CN111123933B (zh) * 2019-12-24 2021-10-01 华为技术有限公司 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车

Patent Citations (15)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US10421453B1 (en) * 2014-10-02 2019-09-24 Waymo Llc Predicting trajectories of objects based on contextual information
CN104590274A (zh) * 2014-11-26 2015-05-06 浙江吉利汽车研究院有限公司 一种驾驶行为自适应***及驾驶行为自适应方法
CN108027242A (zh) * 2015-11-30 2018-05-11 华为技术有限公司 自动驾驶导航方法、装置、***、车载终端及服务器
CN110366710A (zh) * 2017-02-27 2019-10-22 华为技术有限公司 用于控制自动驾驶车辆操作以确定规划路径的规划***和方法
CN108657176A (zh) * 2017-04-01 2018-10-16 华为技术有限公司 车辆控制方法、装置及相关计算机程序产品
CN108932462A (zh) * 2017-05-27 2018-12-04 华为技术有限公司 驾驶意图确定方法及装置
CN109389847A (zh) * 2017-08-14 2019-02-26 上海汽车集团股份有限公司 一种道路拥堵信息的处理方法和装置
CN108022450A (zh) * 2017-10-31 2018-05-11 华为技术有限公司 一种基于蜂窝网络的辅助驾驶方法及交通控制单元
CN109945880A (zh) * 2017-12-20 2019-06-28 华为技术有限公司 路径规划方法、相关设备及可读存储介质
CN110146100A (zh) * 2018-02-13 2019-08-20 华为技术有限公司 轨迹预测方法、装置及存储介质
CN108407717A (zh) * 2018-03-14 2018-08-17 杭州分数科技有限公司 车辆预警方法、***以及电子设备
CN109910880A (zh) * 2019-03-07 2019-06-21 百度在线网络技术(北京)有限公司 车辆行为规划的方法、装置、存储介质和终端设备
CN109885058A (zh) * 2019-03-12 2019-06-14 杭州飞步科技有限公司 行车轨迹规划方法、装置、电子设备及存储介质
CN110287529A (zh) * 2019-05-23 2019-09-27 杭州飞步科技有限公司 测试方法、装置、设备以及存储介质
CN110379193A (zh) * 2019-07-08 2019-10-25 华为技术有限公司 自动驾驶车辆的行为规划方法及行为规划装置

Also Published As

Publication number Publication date
US20220324481A1 (en) 2022-10-13
EP4075227A1 (en) 2022-10-19
WO2021129309A1 (zh) 2021-07-01
EP4075227A4 (en) 2023-01-04
CN111123933A (zh) 2020-05-08
EP4075227B1 (en) 2024-07-10

Similar Documents

Publication Publication Date Title
CN111123933B (zh) 车辆轨迹规划的方法、装置、智能驾驶域控制器和智能车
CN113460042B (zh) 车辆驾驶行为的识别方法以及识别装置
EP3885228A1 (en) Controller for an autonomous vehicle, and network component
US20180056998A1 (en) System and Method for Multi-Vehicle Path Planning Technical Field
US20210191394A1 (en) Systems and methods for presenting curated autonomy-system information of a vehicle
CN113613980A (zh) 控制自我和社会对象的安全性的方法和***
EP3971526B1 (en) Path planning in autonomous driving environments
CN112512887B (zh) 一种行驶决策选择方法以及装置
CN111559383A (zh) 用于基于车辆和边缘传感器数据确定自主车辆(av)动作的方法和***
US20220068052A1 (en) Simulation of autonomous vehicle to improve safety and reliability of autonomous vehicle
CN111833597A (zh) 具有规划控制的交通情形中的自主决策
US20220289198A1 (en) Automated emergency braking system
CN112446466A (zh) 在深度神经网络中测量置信度
CN116901875A (zh) 感知融合***、车辆及控制方法
WO2021229671A1 (ja) 走行支援装置および走行支援方法
CN114763156A (zh) 使用基于关注度的事件结构的认知情境意识的方法
EP4145358A1 (en) Systems and methods for onboard enforcement of allowable behavior based on probabilistic model of automated functional components
Vasic Cooperative perception algorithms for networked intelligent vehicles
WO2022168672A1 (ja) 処理装置、処理方法、処理プログラム、処理システム
US20240038069A1 (en) Processing device, processing method, processing system, and storage medium
US20230399008A1 (en) Multistatic radar point cloud formation using a sensor waveform encoding schema
US20240140486A1 (en) Methods and apparatuses for closed-loop evaluation for autonomous vehicles
WO2022202001A1 (ja) 処理方法、処理システム、処理プログラム
WO2023228781A1 (ja) 処理システム及び情報提示装置
EP4145420A1 (en) Hierarchical processing of traffic signal face states

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