CN111959505B - 车辆巡航控制方法、装置、电子设备和存储介质 - Google Patents

车辆巡航控制方法、装置、电子设备和存储介质 Download PDF

Info

Publication number
CN111959505B
CN111959505B CN202010605456.6A CN202010605456A CN111959505B CN 111959505 B CN111959505 B CN 111959505B CN 202010605456 A CN202010605456 A CN 202010605456A CN 111959505 B CN111959505 B CN 111959505B
Authority
CN
China
Prior art keywords
vehicle
current
positioning information
acquiring
dimensional
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
CN202010605456.6A
Other languages
English (en)
Other versions
CN111959505A (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.)
Apollo Intelligent Technology Beijing Co Ltd
Original Assignee
Apollo Intelligent Technology Beijing Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Apollo Intelligent Technology Beijing Co Ltd filed Critical Apollo Intelligent Technology Beijing Co Ltd
Priority to CN202010605456.6A priority Critical patent/CN111959505B/zh
Publication of CN111959505A publication Critical patent/CN111959505A/zh
Priority to US17/337,857 priority patent/US11305771B2/en
Priority to KR1020210082941A priority patent/KR102557026B1/ko
Priority to EP21181955.2A priority patent/EP3885216A3/en
Priority to JP2021107300A priority patent/JP7214794B2/ja
Application granted granted Critical
Publication of CN111959505B publication Critical patent/CN111959505B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/18—Propelling the vehicle
    • B60W30/18009—Propelling the vehicle related to particular drive situations
    • B60W30/18072—Coasting
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/14—Adaptive cruise control
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control 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
    • G05D1/0253—Control 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 extracting relative motion information from a plurality of images taken successively, e.g. visual odometry, optical flow
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W30/00—Purposes of road vehicle drive control systems not related to the control of a particular sub-unit, e.g. of systems using conjoint control of vehicle sub-units
    • B60W30/06—Automatic manoeuvring for parking
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Estimation 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/02—Estimation 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 ambient conditions
    • B60W40/06—Road conditions
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Drive control systems specially adapted for autonomous road vehicles
    • B60W60/001—Planning or execution of driving tasks
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D15/00—Steering not otherwise provided for
    • B62D15/02—Steering position indicators ; Steering position determination; Steering aids
    • B62D15/027—Parking aids, e.g. instruction means
    • B62D15/0285—Parking performed automatically
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/28—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network with correlation of data from several navigational instruments
    • G01C21/30—Map- or contour-matching
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/26—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for navigation in a road network
    • G01C21/34—Route searching; Route guidance
    • G01C21/36—Input/output arrangements for on-board computers
    • G01C21/3602—Input other than that of destination using image analysis, e.g. detection of road signs, lanes, buildings, real preceding vehicles using a camera
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3807—Creation or updating of map data characterised by the type of data
    • G01C21/3815—Road data
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3837—Data obtained from a single source
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/38—Electronic maps specially adapted for navigation; Updating thereof
    • G01C21/3804—Creation or updating of map data
    • G01C21/3833—Creation or updating of map data characterised by the source of data
    • G01C21/3848—Data obtained from both position sensors and additional sensors
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223—Control 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246—Control 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
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02—Control of position or course in two dimensions
    • G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
    • G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T17/00—Three dimensional [3D] modelling, e.g. data description of 3D objects
    • G06T17/05—Geographic models
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/20—Analysis of motion
    • G06T7/246—Analysis of motion using feature-based methods, e.g. the tracking of corners or segments
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T7/00—Image analysis
    • G06T7/70—Determining position or orientation of objects or cameras
    • G06T7/73—Determining position or orientation of objects or cameras using feature-based methods
    • G06T7/74—Determining position or orientation of objects or cameras using feature-based methods involving reference images or patches
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
    • G06V20/00—Scenes; Scene-specific elements
    • G06V20/50—Context or environment of the image
    • G06V20/56—Context or environment of the image exterior to a vehicle by using sensors mounted on the vehicle
    • G06V20/58—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads
    • G06V20/586—Recognition of moving objects or obstacles, e.g. vehicles or pedestrians; Recognition of traffic objects, e.g. traffic signs, traffic lights or roads of parking space
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Details 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
    • B60W2050/0001—Details of the control system
    • B60W2050/0002—Automatic control, details of type of controller or control system architecture
    • B60W2050/0004—In digital systems, e.g. discrete-time systems involving sampling
    • B60W2050/0005—Processor details or data handling, e.g. memory registers or chip architecture
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W2420/00—Indexing codes relating to the type of sensors based on the principle of their operation
    • B60W2420/40—Photo, light or radio wave sensitive means, e.g. infrared sensors
    • B60W2420/403—Image sensing, e.g. optical camera
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to overall vehicle dynamics
    • B60W2520/10—Longitudinal speed
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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
    • B60W2530/00—Input parameters relating to vehicle conditions or values, not covered by groups B60W2510/00 or B60W2520/00
    • B60W2530/201—Dimensions of vehicle
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to infrastructure
    • B60W2552/30—Road curve radius
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to exterior conditions, not covered by groups B60W2552/00, B60W2554/00
    • B60W2555/20—Ambient conditions, e.g. wind or rain
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to data
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60W—CONJOINT 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/00—Input parameters relating to data
    • B60W2556/10—Historical data
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B60—VEHICLES IN GENERAL
    • B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
    • B60Y2300/00—Purposes or special features of road vehicle drive control systems
    • B60Y2300/14—Cruise control
    • G—PHYSICS
    • G06—COMPUTING; CALCULATING OR COUNTING
    • G06T—IMAGE DATA PROCESSING OR GENERATION, IN GENERAL
    • G06T2207/00—Indexing scheme for image analysis or image enhancement
    • G06T2207/30—Subject of image; Context of image processing
    • G06T2207/30248—Vehicle exterior or interior
    • G06T2207/30252—Vehicle exterior; Vicinity of vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Automation & Control Theory (AREA)
  • Radar, Positioning & Navigation (AREA)
  • General Physics & Mathematics (AREA)
  • Transportation (AREA)
  • Mechanical Engineering (AREA)
  • Theoretical Computer Science (AREA)
  • Geometry (AREA)
  • Software Systems (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Multimedia (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Computer Graphics (AREA)
  • Human Computer Interaction (AREA)
  • Mathematical Physics (AREA)
  • Electromagnetism (AREA)
  • Chemical & Material Sciences (AREA)
  • Combustion & Propulsion (AREA)
  • Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
  • Traffic Control Systems (AREA)
  • Navigation (AREA)

Abstract

本申请公开了一种车辆巡航控制方法、装置、电子设备和存储介质，涉及自动驾驶领域、人工智能技术领域。具体实现方案为：获取预先建立的车辆从始发地到目的地的三维轨迹地图；获取车辆的当前定位信息；根据当前定位信息，从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹；根据当前定位信息从目标轨迹中获取目标点；获取车辆的轴距和当前速度，并根据目标点、当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度；根据需要转动的角度控制车辆运动。本申请可以实现车辆的前向巡航控制，使得车辆能够自动的从始发地行驶到目的地。

Description

车辆巡航控制方法、装置、电子设备和存储介质
技术领域
本申请涉及车辆控制领域，具体涉及自动驾驶领域、人工智能技术领域，尤其涉及一种车辆巡航控制方法、装置、电子设备和存储介质。
背景技术
自动泊车系统(Homezone Auto Valet Parking，H-AVP)能够辅助用户自动进行泊车。而在利用H-AVP系统辅助用户完成自动泊车的过程中，需要利用前向巡航技术来控制车辆自动驾驶到泊车地点。因此，如何实现H-AVP场景之中的前向巡航，已经成为亟待解决的问题。
发明内容
本申请提供了一种车辆巡航控制方法、装置、设备以及存储介质。
根据本申请的第一方面，提供了一种车辆巡航控制方法，包括：
获取预先建立的所述车辆从始发地到目的地的三维轨迹地图；
获取所述车辆的当前定位信息；
根据所述当前定位信息，从所述三维轨迹地图中截取所述车辆当前前方预设距离的目标轨迹；
根据所述当前定位信息从所述目标轨迹中获取目标点；
获取所述车辆的轴距和当前速度，并根据所述目标点、所述当前定位信息、所述轴距和所述当前速度计算所述车辆前轮需要转动的角度；
根据所述需要转动的角度控制所述车辆运动。
根据本申请的第二方面，提供了一种车辆巡航控制装置，包括：
第一获取模块，用于获取预先建立的所述车辆从始发地到目的地的三维轨迹地图；
第二获取模块，用于获取所述车辆的当前定位信息；
轨迹截图模块，用于根据所述当前定位信息，从所述三维轨迹地图中截取所述车辆当前前方预设距离的目标轨迹；
第三获取模块，用于根据所述当前定位信息从所述目标轨迹中获取目标点；
第四获取模块，用于获取所述车辆的轴距和当前速度；
控制模块，用于根据所述目标点、所述当前定位信息、所述轴距和所述当前速度计算所述车辆前轮需要转动的角度，并根据所述需要转动的角度控制所述车辆运动。
根据本申请的第三方面，提供了一种电子设备，包括：至少一个处理器；以及与所述至少一个处理器通信连接的存储器；其中，所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行前述的车辆巡航控制方法。
根据本申请的第四方面，提供了一种存储有计算机指令的非瞬时计算机可读存储介质，所述计算机指令用于使所述计算机执行前述的车辆巡航控制方法。
根据本申请的第五方面，提供了一种计算机程序产品，包括计算机程序，所述计算机程序在被处理器执行时实现第一方面所述的车辆巡航控制方法。
根据本申请实施例的技术方案，在车辆前向巡航控制时，由于所使用的轨迹地图为预先建立的三维轨迹地图，使得本申请巡航控制方法可以应用于任何道路场景(比如道路复杂的场景或直行简单的场景)，只要预先建立了车辆在该道路行驶时的三维轨迹地图，那么在自动驾驶时，基于该预先建立的三维轨迹地图和车辆的定位信息，即可实现车辆的前向巡航控制，使得车辆能够自动的从始发地行驶到目的地。
应当理解，本部分所描述的内容并非旨在标识本申请的实施例的关键或重要特征，也不用于限制本申请的范围。本申请的其它特征将通过以下的说明书而变得容易理解。
附图说明
附图用于更好地理解本方案，不构成对本申请的限定。其中：
图1是根据本申请一个实施例的车辆巡航控制方法的流程图；
图2是根据本申请实施例的计算车辆前轮需要转动的角度的示例图；
图3是根据本申请另一个实施例的车辆巡航控制方法的流程图；
图4是根据本申请又一个实施例的车辆巡航控制方法的流程图；
图5是根据本申请一个实施例的车辆巡航控制装置的结构框图；
图6是根据本申请另一个实施例的车辆巡航控制装置的结构框图；
图7是用来实现本申请实施例的车辆巡航控制方法的电子设备的框图。
具体实施方式
以下结合附图对本申请的示范性实施例做出说明，其中包括本申请实施例的各种细节以助于理解，应当将它们认为仅仅是示范性的。因此，本领域普通技术人员应当认识到，可以对这里描述的实施例做出各种改变和修改，而不会背离本申请的范围和精神。同样，为了清楚和简明，以下的描述中省略了对公知功能和结构的描述。
图1是根据本申请一个实施例的车辆巡航控制方法的流程图。其中，需要说明的是，本申请实施例的车辆巡航控制方法的执行主体为本申请实施例的车辆巡航控制装置，该装置可以由软件和/或硬件的方式实现，该装置可以配置在电子设备中，电子设备可以包括但不限于终端、服务器端等。
本申请实施例涉及车辆控制指令，尤其涉及自动驾驶领域、人工智能技术领域，其中，自动驾驶技术领域主要在于研究自动驾驶的方法、自动泊车的方法，辅助进行自动驾驶的算法模型，以及支持自动驾驶的硬件系统架构设计等，自动驾驶技术领域内的自动泊车方法是指汽车自动驾驶入车位不需要人工控制。人工智能(ArtificialIntelligence)，英文缩写为AI。它是研究、开发用于模拟、延伸和扩展人的智能的理论、方法、技术及应用系统的一门新的技术科学。
需要说明的是，自动泊车系统能够辅助用户自动进行泊车。而在利用自动泊车系统辅助用户完成自动泊车的过程中，需要利用前向巡航技术来控制车辆从始发地自动驾驶到目的地。本申请实施例给出的是一种如何实现车辆的前向巡航以使车辆从始发地到目的地的方法。如图1所示，该车辆巡航控制方法可以包括：
步骤101，获取预先建立的所述车辆从始发地到目的地的三维轨迹地图。
需要说明的是，本申请实施例的车辆巡航控制方法可应用于自动泊车系统。该自动泊车系统主要包括两个部分，即招车和还车，其中，招车是指从车辆从停车位行驶到用户选择的目的地；还车是指车辆从用户选择的始发地行驶到停车位附近。可以理解，不管是在招车过程还是在还车过程，都需要利用前向巡航以控制车辆向前行驶，其中，若招车过程中利用前向巡航控制车辆向前行驶时，上述始发地可理解为停车位附近的某个位置，上述目的地可理解为用户选择的目的地。若还车过程利用前向巡航控制车辆向前行驶时，上述始发地可理解为用户当前所处的位置，上述目的地可理解为停车位附近的某个位置。
在本申请的实施例中，为了能够实现车辆从始发地自动巡航以行驶到目的地，需先建立该车辆从始发地到目的地的三维轨迹地图，以便车辆基于该预先建立的三维轨迹地图和定位技术，实现从始发地自动巡航以行驶到目的地。作为一种可能的实现方式，三维轨迹地图可根据这样的图像构建：所述图像是在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，基于所述车辆上摄像头的多个拍摄角度分别采集的所述演示阶段中车辆前方道路的图像。其中，车辆从始发地到目的地的三维轨迹地图的建立方式可参见后续实施例的描述。
步骤102，获取车辆的当前定位信息。
在本申请一些实施例中，可通过车辆上的定位装置，比如GPS(GlobalPositioning System，全球定位系统)等，获取车辆的当前定位信息。在本申请另一些实施例中，可通过车辆上的前置广角摄像头采集车辆前方道路的图像，并基于采集到的图像重建当前前方道路的三维图像，并基于该三维图像和预先建立的三维轨迹地图进行定位，以获取车辆的当前定位信息。可以理解，还可以采用其他技术手段以获取车辆的当前定位信息，本申请不做具体限定。
步骤103，根据当前定位信息，从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹。
可以理解，由于三维轨迹地图是车辆从始发地行驶到目的地的一条完成的驾驶轨迹，但是对车辆巡航控制时，只需要当前的三维轨迹即可实现对车辆的当前巡航控制。因此，在本申请实施例中，在获得车辆的当前定位信息时，可根据该当前定位信息从三维轨迹地图中截取车前一定距离的目标轨迹。由此，通过采用车前一定距离的三维轨迹实现车辆的实时前向巡航控制，可以降低计算量。
步骤104，根据当前定位信息从目标轨迹中获取目标点。
在本申请的实施例中，可先根据当前定位信息在目标轨迹上找出离车最近的点，之后，基于该离车最近的点找到该目标点。具体而言，在前视距离范围内，目标轨迹上可能会有多个点，应当选取一个距离起点最接近前视距离的那个点，为了找到最满足要求的这个点，首先可以选取一个在目标轨迹上离此刻最近的点，从而可以在目标轨迹上找出离车最近的点，利用该找到的离车最近的点，可以获取目标轨迹中距离此点距离最接近前视距离的点，将这个点确定为目标点。
步骤105，获取车辆的轴距和当前速度，并根据目标点、当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度。
在本申请实施例中，在获得目标点之后，可基于PurePersuit(纯跟踪)算法，根据目标点、当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度。
需要说明的是，纯跟踪算法以车后轴为切点，车辆纵向车身为切线，通过控制前轮转角，使车辆可以沿着一条经过目标点的圆弧A行驶。例如，如图2所示，图中(gx，gy)是下一个要追踪的目标点，它位于目标轨迹B上，现在需要控制车辆的后轴经过该目标点，ld表示车辆当前位置(即后轴位置)到目标点的距离，α表示目前车身姿态与目标点的夹角，那么根据正弦定理可以推导出如下转换式：
Figure GDA0002914547960000051
Figure GDA0002914547960000052
Figure GDA0002914547960000061
其中，R为在给定的前轮转向角下后轴遵循着的圆的半径。
因目标轨迹的曲率
Figure GDA0002914547960000062
上式也可以表示为：
Figure GDA0002914547960000063
则由式子
Figure GDA0002914547960000064
可得：
Figure GDA0002914547960000065
再将时间这个变量加进来，得到：
Figure GDA0002914547960000066
需要说明的是，将时间考虑进来，在知道t时刻车身和目标点的夹角α(t)和距离目标点的前视距离ld的情况下，由于车辆轴距L固定，可以利用上式估计出应该做出的前轮转角δ，为了更好的理解纯跟踪算法的原理，可定义一个新的量：el，表示车辆当前姿态和目标点在横向上的误差，由此可得夹角正弦：
Figure GDA0002914547960000067
则曲率可以表示为：
Figure GDA0002914547960000068
考虑到本质是横向上的误差，由上式可知纯跟踪控制器其实是一个横向转角的P控制器，其P系数为
Figure GDA0002914547960000069
这个P控制器受到参数ld(即前视距离)的影响很大，如何调整前视距离变成纯跟踪算法的关键，通常来说，ld被认为是车速的函数，在不同的车速下需要选择不同的前视距离。
一种常见的调整前视距离的方法就是将前视距离表示成车辆纵向速度的线性函数，即ld＝Kvt,那么前轮的转角公式就变成如下式(1).
Figure GDA00029145479600000610
那么纯跟踪控制器的调整变成了调整系数K，通常来说，会使用最大，最小前视距离来约束前视距离，越大的前视距离意味着轨迹的追踪越平滑，小的前视距离会使得追踪更加精确(当然也会带来控制的震荡)。因此，在获得车辆的轴距和当前速度之后，可计算目前车身姿态与目标点的夹角，并根据该夹角、轴距和当前速度，利用上述用以计算前轮的转角公式(1)，计算出车辆前轮需要转动的角度，其中，该需要转动的角度可理解为车辆到达目标点所需的转向角。
步骤106，根据需要转动的角度控制车辆运动。
可选地，在估计出车辆前轮当前需要转动的角度时，可根据当前需要转动的角度控制车辆运动，以使车辆能够到达目标点，根据单位时间内车辆的运动更新车辆的状态，以使车辆沿着目标轨迹向前行驶，从而实现车辆能够从始发地自动行驶到目的地。
根据本申请实施例的车辆巡航控制方法，可获取预先建立的车辆从始发地到目的地的三维轨迹地图，并获取车辆的当前定位信息，根据当前定位信息从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹，之后，可根据当前定位信息从目标轨迹中获取目标点，并根据目标点、车辆的当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度，进而根据需要转动的角度控制车辆运动，以使车辆能够从始发地自动行驶到目的地。由此，在车辆前向巡航控制时，由于所使用的轨迹地图为预先建立的三维轨迹地图，使得本申请巡航控制方法可以应用于任何道路场景(比如道路复杂的场景或直行简单的场景)，只要预先建立了车辆在该道路行驶时的三维轨迹地图，那么在自动驾驶时，基于该预先建立的三维轨迹地图和车辆的定位信息，即可实现车辆的前向巡航控制，使得车辆能够自动的从始发地行驶到目的地，可应用于代客泊车应用场景。
需要说明的是，为了能够实现车辆从始发地自动巡航以行驶到目的地，需先建立该车辆从始发地到目的地的三维轨迹地图，以便车辆基于该预先建立的三维轨迹地图和定位技术，实现从始发地自动巡航以行驶到目的地。在本申请一些实施例中，如图3所示，在如图1所示的基础上，在获取预先建立的车辆从始发地到目的地的三维轨迹地图之前，该车辆巡航控制方法还可包括：
步骤301，在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，基于车辆上摄像头的多个拍摄角度分别采集演示阶段中车辆前方道路的图像。
举例而言，可通过用户驾驶车辆演示从始发地行驶到目的地的过程，在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，可基于车辆上的摄像头的多个拍摄角度分别采集演示阶段中车辆前方道路的图像。例如，车辆的前挡风玻璃上安装有广角摄像头，在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，可利用该摄像头采用多个拍摄角度，同时对车辆前方道路进行图像采集。作为一种示例，该拍摄角度的个数可为3，也就是说，可利用三个不同拍摄角度对车辆前方道路进行图像采集，以便后续基于不同拍摄角度所采集的图像进行三维重建，以构建车辆从始发地到目的地的三维轨迹地图。
步骤302，根据采集到的图像构建针对车辆从始发地到目的地的三维轨迹地图。
可选地，从采集到的图像中获取基于多个拍摄角度所采集的同一场景的图像，并将同一场景的图像进行叠加，以得到针对同一场景的三维图像，之后，将始发地到目的地之间的不同场景的三维图像进行拼接处理，以生成针对车辆从始发地到目的地的三维轨迹地图。即通过不同拍摄角度采集的图像进行叠加以实现三维重建，计算简单，降低计算量。
由此，在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，通过采集的前方道路的图像进行三维重建，以构建车辆从始发地到目的地的三维轨迹地图，重现用户驾车行驶的三维轨迹。
在本申请一些实施例中，可采用图像定位的方式获取车辆的当前定位信息。具体而言，如图4所示，获取车辆的当前定位信息的具体实现过程可包括：
步骤401，基于摄像头的多个拍摄角度分别采集车辆当前前方道路的图像。
也就是说，在自动驾驶阶段，通过前向巡航技术控制车辆向前行驶时，可通过车辆上的前视摄像头的多个拍摄角度分别采集车辆当前前方道路的图像。
步骤402，将采集到的车辆当前前方道路的图像进行叠加，以获得针对当前前方道路的三维图像。
步骤403，提取当前前方道路的三维图像的环境特征。
步骤404，将当前前方道路的三维图像的环境特征与三维轨迹地图中的环境特征进行匹配。
也就是说，预先建立的三维轨迹地图中存在有每个场景的环境特征。在得到当前前方道路的三维图像的环境特征之后，可将该环境特征与三维轨迹地图中的环境特征进行匹配，并根据匹配结果来确定车辆的当前定位信息。
步骤405，基于匹配到的环境特征从三维轨迹地图中确定出车辆的当前定位信息。
由此，结合预先建立的三维轨迹地图，采用图像定位的方式获取车辆的当前定位信息，无需其他雷达、GPS等高端设备也可实现车辆当前位置的定位，降低了成本。
为了能够提高定位的准确性，保证车辆行驶的安全性，在本申请的一些实施例中，在定位过程中，可基于里程计实现实时的运动补偿，从而提高定位的频率。具体而言，在定位过程中，若摄像头处于非采集周期，则获取车辆在摄像头的当前非采集周期内已行驶的里程；根据车辆在摄像头的当前非采集周期内已行驶的里程，以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获取车辆的实时定位信息。
需要说明的是，由于基于三维重建的三维轨迹地图和图像定位的方式实现车辆的定位，在算力低的车载平台上，定位频率较低，为了能够提高定位的准确性，可基于里程计实现实时的运动补偿，以提高定位频率。也就是说，在定位过程中，摄像头处于采集周期时，可采用图像定位的方式定位车辆的当前位置。若摄像头处于非采集周期，由于在该段时间车辆仍会继续往前行驶，此时可获取车辆在该当前非采集周期内已行驶的里程，并根据该车辆在摄像头的当前非采集周期内已行驶的里程、以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获得车辆的实时定位信息。例如，假设基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息为车辆已行驶200米，而辆在该当前非采集周期内已行驶的里程为10米，则将该里程补偿到该上一次获得的定位信息上，以获得车辆的实时定位信息为：车辆已行驶210米。
图5是根据本申请一个实施例的车辆巡航控制装置的结构框图。如图5所示，该车辆巡航控制装置500可以包括：第一获取模块510、第二获取模块520、轨迹截图模块530、第三获取模块540、第四获取模块550和控制模块560。
具体地，第一获取模块510用于获取预先建立的车辆从始发地到目的地的三维轨迹地图。作为一种可能的实现方式，三维轨迹地图可根据这样的图像构建：所述图像是在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，基于所述车辆上摄像头的多个拍摄角度分别采集的所述演示阶段中车辆前方道路的图像。
在本申请一些实施例中，根据这样的图像构建所述三维轨迹地图，包括：从所述图像中获取基于所述多个拍摄角度所采集的同一场景的图像；将所述同一场景的图像进行叠加，获取针对同一场景的三维图像；将所述始发地到所述目的地之间的不同场景的三维图像进行拼接处理，以生成针对所述车辆从所述始发地到所述目的地的三维轨迹地图。
第二获取模块520用于获取车辆的当前定位信息。在本申请一些实施例中，第二获取模块520具体用于：基于摄像头的多个拍摄角度分别采集车辆当前前方道路的图像；将采集到的车辆当前前方道路的图像进行叠加，获取针对当前前方道路的三维图像；提取当前前方道路的三维图像的环境特征；将当前前方道路的三维图像的环境特征与三维轨迹地图中的环境特征进行匹配；基于匹配到的环境特征从三维轨迹地图中确定出车辆的当前定位信息。
轨迹截图模块530用于根据当前定位信息，从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹。
第三获取模块540用于根据当前定位信息从目标轨迹中获取目标点。
第四获取模块550用于获取车辆的轴距和当前速度。
控制模块560用于根据目标点、当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度，并根据需要转动的角度控制车辆运动。
根据本申请实施例的车辆巡航控制装置，可获取预先建立的车辆从始发地到目的地的三维轨迹地图，并获取车辆的当前定位信息，根据当前定位信息从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹，之后，可根据当前定位信息从目标轨迹中获取目标点，并根据目标点、车辆的当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度，进而根据需要转动的角度控制车辆运动，以使车辆能够从始发地自动行驶到目的地。由此，在车辆前向巡航控制时，由于所使用的轨迹地图为预先建立的三维轨迹地图，使得本申请巡航控制方法可以应用于任何道路场景(比如道路复杂的场景或直行简单的场景)，只要预先建立了车辆在该道路行驶时的三维轨迹地图，那么在自动驾驶时，基于该预先建立的三维轨迹地图和车辆的定位信息，即可实现车辆的前向巡航控制，使得车辆能够自动的从始发地行驶到目的地，可应用于代客泊车应用场景。
图6是根据本申请另一个实施例的车辆巡航控制装置的结构框图。如图6所示，该车辆巡航控制装置600包括：第一获取模块610、第二获取模块620、轨迹截图模块630、第三获取模块640、第四获取模块650、控制模块660、第五获取模块670和第六获取模块680。
具体地，第一获取模块610用于获取预先建立的车辆从始发地到目的地的三维轨迹地图。
第二获取模块620用于获取车辆的当前定位信息。
轨迹截图模块630用于根据当前定位信息，从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹。
第三获取模块640用于根据当前定位信息从目标轨迹中获取目标点。
第四获取模块650用于获取车辆的轴距和当前速度。
控制模块660用于根据目标点、当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度，并根据需要转动的角度控制车辆运动。
第五获取模块670可用于在定位过程中，在摄像头处于非采集周期时，获取车辆在摄像头的当前非采集周期内已行驶的里程。
第六获取模块680可用于根据车辆在摄像头的当前非采集周期内已行驶的里程，以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获取车辆的实时定位信息。
根据本申请实施例的车辆巡航控制装置，在定位过程中，若摄像头处于非采集周期，则获取车辆在摄像头的当前非采集周期内已行驶的里程；根据车辆在摄像头的当前非采集周期内已行驶的里程，以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获取车辆的实时定位信息，即在定位过程中，可基于里程计实现实时的运动补偿，可以提高定位的频率，从而能够提高定位的准确性，保证车辆行驶的安全性。
根据本申请的实施例，本申请还提供了一种电子设备、一种可读存储介质以及一种计算机程序产品。
如图7所示，是根据本申请实施例的用以实现车辆巡航控制方法的电子设备的框图。电子设备旨在表示各种形式的数字计算机，诸如，膝上型计算机、台式计算机、工作台、个人数字助理、服务器、刀片式服务器、大型计算机、和其它适合的计算机。电子设备还可以表示各种形式的移动装置，诸如，个人数字处理、蜂窝电话、智能电话、可穿戴设备和其它类似的计算装置。本文所示的部件、它们的连接和关系、以及它们的功能仅仅作为示例，并且不意在限制本文中描述的和/或者要求的本申请的实现。
如图7所示，该电子设备包括：一个或多个处理器701、存储器702，以及用于连接各部件的接口，包括高速接口和低速接口。各个部件利用不同的总线互相连接，并且可以被安装在公共主板上或者根据需要以其它方式安装。处理器可以对在电子设备内执行的指令进行处理，包括存储在存储器中或者存储器上以在外部输入/输出装置(诸如，耦合至接口的显示设备)上显示GUI的图形信息的指令。在其它实施方式中，若需要，可以将多个处理器和/或多条总线与多个存储器和多个存储器一起使用。同样，可以连接多个电子设备，各个设备提供部分必要的操作(例如，作为服务器阵列、一组刀片式服务器、或者多处理器系统)。图7中以一个处理器701为例。
存储器702即为本申请所提供的非瞬时计算机可读存储介质。其中，所述存储器存储有可由至少一个处理器执行的指令，以使所述至少一个处理器执行本申请所提供的车辆巡航控制方法。本申请的非瞬时计算机可读存储介质存储计算机指令，该计算机指令用于使计算机执行本申请所提供的车辆巡航控制方法。本申请的计算机程序产品，包括计算机程序，该计算机程序在被处理器701执行时实现本申请所提供的车辆巡航控制方法。
存储器702作为一种非瞬时计算机可读存储介质，可用于存储非瞬时软件程序、非瞬时计算机可执行程序以及模块，如本申请实施例中的车辆巡航控制方法对应的程序指令/模块(例如，附图5所示的第一获取模块510、第二获取模块520、轨迹截图模块530、第三获取模块540、第四获取模块550和控制模块560)。处理器701通过运行存储在存储器702中的非瞬时软件程序、指令以及模块，从而执行服务器的各种功能应用以及数据处理，即实现上述方法实施例中的车辆巡航控制方法。
存储器702可以包括存储程序区和存储数据区，其中，存储程序区可存储操作系统、至少一个功能所需要的应用程序；存储数据区可存储根据用以实现车辆巡航控制方法的电子设备的使用所创建的数据等。此外，存储器702可以包括高速随机存取存储器，还可以包括非瞬时存储器，例如至少一个磁盘存储器件、闪存器件、或其他非瞬时固态存储器件。在一些实施例中，存储器702可选包括相对于处理器701远程设置的存储器，这些远程存储器可以通过网络连接至用以实现车辆巡航控制方法的电子设备。上述网络的实例包括但不限于互联网、企业内部网、局域网、移动通信网及其组合。
用以实现车辆巡航控制方法的电子设备还可以包括：输入装置703和输出装置704。处理器701、存储器702、输入装置703和输出装置704可以通过总线或者其他方式连接，图7中以通过总线连接为例。
输入装置703可接收输入的数字或字符信息，以及产生与用以实现车辆巡航控制方法的电子设备的用户设置以及功能控制有关的键信号输入，例如触摸屏、小键盘、鼠标、轨迹板、触摸板、指示杆、一个或者多个鼠标按钮、轨迹球、操纵杆等输入装置。输出装置704可以包括显示设备、辅助照明装置(例如，LED)和触觉反馈装置(例如，振动电机)等。该显示设备可以包括但不限于，液晶显示器(LCD)、发光二极管(LED)显示器和等离子体显示器。在一些实施方式中，显示设备可以是触摸屏。
此处描述的系统和技术的各种实施方式可以在数字电子电路系统、集成电路系统、专用ASIC(专用集成电路)、计算机硬件、固件、软件、和/或它们的组合中实现。这些各种实施方式可以包括：实施在一个或者多个计算机程序中，该一个或者多个计算机程序可在包括至少一个可编程处理器的可编程系统上执行和/或解释，该可编程处理器可以是专用或者通用可编程处理器，可以从存储系统、至少一个输入装置、和至少一个输出装置接收数据和指令，并且将数据和指令传输至该存储系统、该至少一个输入装置、和该至少一个输出装置。
这些计算程序(也称作程序、软件、软件应用、或者代码)包括可编程处理器的机器指令，并且可以利用高级过程和/或面向对象的编程语言、和/或汇编/机器语言来实施这些计算程序。如本文使用的，术语“机器可读介质”和“计算机可读介质”指的是用于将机器指令和/或数据提供给可编程处理器的任何计算机程序产品、设备、和/或装置(例如，磁盘、光盘、存储器、可编程逻辑装置(PLD))，包括，接收作为机器可读信号的机器指令的机器可读介质。术语“机器可读信号”指的是用于将机器指令和/或数据提供给可编程处理器的任何信号。
为了提供与用户的交互，可以在计算机上实施此处描述的系统和技术，该计算机具有：用于向用户显示信息的显示装置(例如，CRT(阴极射线管)或者LCD(液晶显示器)监视器)；以及键盘和指向装置(例如，鼠标或者轨迹球)，用户可以通过该键盘和该指向装置来将输入提供给计算机。其它种类的装置还可以用于提供与用户的交互；例如，提供给用户的反馈可以是任何形式的传感反馈(例如，视觉反馈、听觉反馈、或者触觉反馈)；并且可以用任何形式(包括声输入、语音输入或者、触觉输入)来接收来自用户的输入。
可以将此处描述的系统和技术实施在包括后台部件的计算系统(例如，作为数据服务器)、或者包括中间件部件的计算系统(例如，应用服务器)、或者包括前端部件的计算系统(例如，具有图形用户界面或者网络浏览器的用户计算机，用户可以通过该图形用户界面或者该网络浏览器来与此处描述的系统和技术的实施方式交互)、或者包括这种后台部件、中间件部件、或者前端部件的任何组合的计算系统中。可以通过任何形式或者介质的数字数据通信(例如，通信网络)来将系统的部件相互连接。通信网络的示例包括：局域网(LAN)、广域网(WAN)和互联网。
计算机系统可以包括客户端和服务器。客户端和服务器一般远离彼此并且通常通过通信网络进行交互。通过在相应的计算机上运行并且彼此具有客户端-服务器关系的计算机程序来产生客户端和服务器的关系。
根据本申请实施例的技术方案，可获取预先建立的车辆从始发地到目的地的三维轨迹地图，并获取车辆的当前定位信息，根据当前定位信息从三维轨迹地图中截取车辆当前前方预设距离的目标轨迹，之后，可根据当前定位信息从目标轨迹中获取目标点，并根据目标点、车辆的当前定位信息、轴距和当前速度计算车辆前轮需要转动的角度，进而根据需要转动的角度控制车辆运动，以使车辆能够从始发地自动行驶到目的地。由此，在车辆前向巡航控制时，由于所使用的轨迹地图为预先建立的三维轨迹地图，使得本申请巡航控制方法可以应用于任何道路场景(比如道路复杂的场景或直行简单的场景)，只要预先建立了车辆在该道路行驶时的三维轨迹地图，那么在自动驾驶时，基于该预先建立的三维轨迹地图和车辆的定位信息，即可实现车辆的前向巡航控制，使得车辆能够自动的从始发地行驶到目的地，可应用于代客泊车应用场景。
应该理解，可以使用上面所示的各种形式的流程，重新排序、增加或删除步骤。例如，本发申请中记载的各步骤可以并行地执行也可以顺序地执行也可以不同的次序执行，只要能够实现本申请公开的技术方案所期望的结果，本文在此不进行限制。
上述具体实施方式，并不构成对本申请保护范围的限制。本领域技术人员应该明白的是，根据设计要求和其他因素，可以进行各种修改、组合、子组合和替代。任何在本申请的精神和原则之内所作的修改、等同替换和改进等，均应包含在本申请保护范围之内。

Claims (9)

1.一种车辆巡航控制方法，包括：
获取预先建立的所述车辆从始发地到目的地的三维轨迹地图；
获取所述车辆的当前定位信息；
根据所述当前定位信息，从所述三维轨迹地图中截取所述车辆当前前方预设距离的目标轨迹；
根据所述当前定位信息从所述目标轨迹中获取目标点，其中，在前视距离范围内，所述目标轨迹包含多个点，所述目标点为距离起点最接近的前视距离的点；
获取所述车辆的轴距和当前速度，并根据所述目标点、所述当前定位信息、所述轴距和所述当前速度计算所述车辆前轮需要转动的角度；
根据所述需要转动的角度控制所述车辆运动；
其中，所述根据所述当前定位信息从所述目标轨迹中获取目标点，包括：
根据所述当前定位信息在目标轨迹上找出离所述车辆最近的点，基于所述最近的点找到所述目标点；
所述三维轨迹地图的构建方式，包括：
在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，基于所述车辆上摄像头的多个拍摄角度分别采集的所述演示阶段中车辆前方道路的图像；
从所述图像中获取基于所述多个拍摄角度所采集的同一场景的图像；
将所述同一场景的图像进行叠加，获取针对同一场景的三维图像；
将所述始发地到所述目的地之间的不同场景的三维图像进行拼接处理，以生成针对所述车辆从所述始发地到所述目的地的三维轨迹地图。
2.根据权利要求1所述的车辆巡航控制方法，其中，所述获取所述车辆的当前定位信息，包括：
基于所述摄像头的多个拍摄角度分别采集所述车辆当前前方道路的图像；
将采集到的所述车辆当前前方道路的图像进行叠加，获取针对所述当前前方道路的三维图像；
提取所述当前前方道路的三维图像的环境特征；
将所述当前前方道路的三维图像的环境特征与所述三维轨迹地图中的环境特征进行匹配；
基于匹配到的环境特征从所述三维轨迹地图中确定出所述车辆的当前定位信息。
3.根据权利要求2所述的车辆巡航控制方法，还包括：
在定位过程中，若所述摄像头处于非采集周期，则获取所述车辆在所述摄像头的当前非采集周期内已行驶的里程；
根据所述车辆在所述摄像头的当前非采集周期内已行驶的里程，以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获取所述车辆的实时定位信息。
4.一种车辆巡航控制装置，包括：
第一获取模块，用于获取预先建立的所述车辆从始发地到目的地的三维轨迹地图；
第二获取模块，用于获取所述车辆的当前定位信息；
轨迹截图模块，用于根据所述当前定位信息，从所述三维轨迹地图中截取所述车辆当前前方预设距离的目标轨迹；
第三获取模块，用于根据所述当前定位信息从所述目标轨迹中获取目标点，其中，在前视距离范围内，所述目标轨迹包含多个点，所述目标点为距离起点最接近的前视距离的点；
第四获取模块，用于获取所述车辆的轴距和当前速度；
控制模块，用于根据所述目标点、所述当前定位信息、所述轴距和所述当前速度计算所述车辆前轮需要转动的角度，并根据所述需要转动的角度控制所述车辆运动；
其中，所述根据所述当前定位信息从所述目标轨迹中获取目标点，包括：
根据所述当前定位信息在目标轨迹上找出离所述车辆最近的点，基于所述最近的点找到所述目标点；
其中，所述三维轨迹地图的构建方式，包括：
在用户驾驶车辆从始发地行驶到目的地的演示阶段过程中，基于所述车辆上摄像头的多个拍摄角度分别采集的所述演示阶段中车辆前方道路的图像；
从所述图像中获取基于所述多个拍摄角度所采集的同一场景的图像；
将所述同一场景的图像进行叠加，获取针对同一场景的三维图像；
将所述始发地到所述目的地之间的不同场景的三维图像进行拼接处理，以生成针对所述车辆从所述始发地到所述目的地的三维轨迹地图。
5.根据权利要求4所述的车辆巡航控制装置，其中，所述第二获取模块具体用于：
基于所述摄像头的多个拍摄角度分别采集所述车辆当前前方道路的图像；
将采集到的所述车辆当前前方道路的图像进行叠加，获取针对所述当前前方道路的三维图像；
提取所述当前前方道路的三维图像的环境特征；
将所述当前前方道路的三维图像的环境特征与所述三维轨迹地图中的环境特征进行匹配；
基于匹配到的环境特征从所述三维轨迹地图中确定出所述车辆的当前定位信息。
6.根据权利要求5所述的车辆巡航控制装置，还包括：
第五获取模块，用于在定位过程中，在所述摄像头处于非采集周期时，获取所述车辆在所述摄像头的当前非采集周期内已行驶的里程；
第六获取模块，用于根据所述车辆在所述摄像头的当前非采集周期内已行驶的里程，以及基于上一个采集周期所采集的车辆前方道路图像而获得的定位信息，获取所述车辆的实时定位信息。
7.一种电子设备，包括：
至少一个处理器；以及
与所述至少一个处理器通信连接的存储器；其中，
所述存储器存储有可被所述至少一个处理器执行的指令，所述指令被所述至少一个处理器执行，以使所述至少一个处理器能够执行权利要求1至3中任一项所述的车辆巡航控制方法。
8.一种存储有计算机指令的非瞬时计算机可读存储介质，所述计算机指令用于使所述计算机执行权利要求1至3中任一项所述的车辆巡航控制方法。
9.一种计算机程序产品，包括计算机程序，所述计算机程序在被处理器执行时实现根据权利要求1至3中任一项所述的车辆巡航控制方法。
CN202010605456.6A 2020-06-29 2020-06-29 车辆巡航控制方法、装置、电子设备和存储介质 Active CN111959505B (zh)

Priority Applications (5)

Application Number Priority Date Filing Date Title
CN202010605456.6A CN111959505B (zh) 2020-06-29 2020-06-29 车辆巡航控制方法、装置、电子设备和存储介质
US17/337,857 US11305771B2 (en) 2020-06-29 2021-06-03 Method and apparatus for controlling cruise of vehicle, electronic device, and storage medium
KR1020210082941A KR102557026B1 (ko) 2020-06-29 2021-06-25 차량 순항 제어 방법, 장치, 전자 기기 및 저장 매체
EP21181955.2A EP3885216A3 (en) 2020-06-29 2021-06-28 Method and apparatus for controlling cruise of vehicle, electronic device, and storage medium
JP2021107300A JP7214794B2 (ja) 2020-06-29 2021-06-29 車両クルーズ制御方法、装置、電子機器及び記憶媒体

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010605456.6A CN111959505B (zh) 2020-06-29 2020-06-29 车辆巡航控制方法、装置、电子设备和存储介质

Publications (2)

Publication Number Publication Date
CN111959505A CN111959505A (zh) 2020-11-20
CN111959505B true CN111959505B (zh) 2022-10-11

Family

ID=73360952

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010605456.6A Active CN111959505B (zh) 2020-06-29 2020-06-29 车辆巡航控制方法、装置、电子设备和存储介质

Country Status (5)

Country Link
US (1) US11305771B2 (zh)
EP (1) EP3885216A3 (zh)
JP (1) JP7214794B2 (zh)
KR (1) KR102557026B1 (zh)
CN (1) CN111959505B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112985401A (zh) * 2021-02-02 2021-06-18 上海华测导航技术股份有限公司 一种headline全路径规划和跟踪方法
CN112874511B (zh) * 2021-02-07 2023-03-28 奇瑞汽车股份有限公司 汽车的自动驾驶控制方法、装置及计算机存储介质
CN113071518B (zh) * 2021-04-14 2023-02-03 上海锵玫人工智能科技有限公司 一种自动无人驾驶方法、小巴、电子设备以及存储介质
CN113532441B (zh) * 2021-08-20 2024-06-14 河南牧原智能科技有限公司 用于对猪舍内载具进行组合导航的方法、装置及存储介质
CN114162139B (zh) * 2021-12-06 2024-03-26 上海华测导航技术股份有限公司 一种车辆控制方法、控制器、系统、装置及存储介质
CN114323060B (zh) * 2021-12-24 2024-05-17 阿波罗智联(北京)科技有限公司 距离确定方法及装置
CN114595789B (zh) * 2022-02-10 2024-01-26 湖南三一中型起重机械有限公司 超起棘轮射频标签的自动标定方法、控制器及工程车辆
CN114802217B (zh) * 2022-06-01 2023-04-07 小米汽车科技有限公司 确定泊车模式的方法、装置、存储介质及车辆
CN115979279B (zh) * 2023-01-05 2024-06-14 中国第一汽车股份有限公司 数据推送方法和系统
CN116165958A (zh) * 2023-04-25 2023-05-26 舜泰汽车有限公司 一种两栖特种无人平台的自动驾驶系统

Family Cites Families (22)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20090025822A (ko) * 2007-09-07 2009-03-11 (주)로봇에버 표식과 근거리무선통신을 이용한 로봇의 자기위치인식방법, 그를 이용한 로봇의 위치데이터 발생장치 및그를 이용한 로봇
WO2014115262A1 (ja) * 2013-01-23 2014-07-31 トヨタ自動車株式会社 車両制御装置
US9146299B2 (en) * 2013-08-06 2015-09-29 Qualcomm Incorporated Method and apparatus for position estimation using trajectory
KR101512784B1 (ko) * 2013-09-10 2015-04-17 한양대학교 산학협력단 자동주차 지원방법 및 자동주차 지원시스템
FR3013296B1 (fr) * 2013-11-18 2015-12-11 Renault Sas Procede et dispositif de pilotage automatique d'un vehicule
US20150155009A1 (en) * 2013-12-03 2015-06-04 Nokia Corporation Method and apparatus for media capture device position estimate- assisted splicing of media
CN104833368A (zh) * 2015-05-12 2015-08-12 寅家电子科技（上海）有限公司 实景导航系统及方法
US10434877B2 (en) * 2016-05-05 2019-10-08 Via Technologies, Inc. Driver-assistance method and a driver-assistance apparatus
RU2727291C1 (ru) * 2017-04-14 2020-07-21 Ниссан Мотор Ко., Лтд. Способ управления транспортным средством и устройство управления транспортного средства
KR102260975B1 (ko) * 2017-05-30 2021-06-04 현대모비스 주식회사 3차원 격자지도를 이용한 자율 주행 제어 장치 및 방법
BR112019027273A2 (pt) * 2017-06-20 2020-07-14 Nissan Motor Co., Ltd. método de controle de destino e dispositivo de controle de destino
KR20170089801A (ko) * 2017-07-21 2017-08-04 현대자동차주식회사 차량 및 차량의 제어 방법
KR102104900B1 (ko) * 2017-12-19 2020-04-27 엘지전자 주식회사 차량에 구비된 차량 제어 장치 및 차량의 제어방법
US10732635B2 (en) * 2017-12-30 2020-08-04 Lyft Inc. Localization based on sensor data
KR20200130279A (ko) * 2018-03-05 2020-11-18 모빌아이 비젼 테크놀로지스 엘티디. 항법 정보를 익명화 하는 시스템 및 방법
KR102420568B1 (ko) * 2018-04-27 2022-07-13 삼성전자주식회사 차량의 위치를 결정하는 방법 및 이를 위한 차량
JP6954469B2 (ja) * 2018-06-28 2021-10-27 日産自動車株式会社 運転支援方法及び運転支援装置
KR20200039853A (ko) * 2018-09-28 2020-04-17 전자부품연구원 벡터맵과 카메라를 이용한 자율주행 차량이 위치한 차선 추정 방법
CN110361013B (zh) * 2019-07-22 2023-05-26 上海应用技术大学 一种用于车辆模型的路径规划系统及方法
CN110774319B (zh) * 2019-10-31 2021-07-23 深圳市优必选科技股份有限公司 一种机器人及其定位方法和装置
US20210179092A1 (en) * 2019-12-16 2021-06-17 Automotive Research & Testing Center Active safety assistance system for pre-adjusting speed and control method using the same
CN111307165B (zh) * 2020-03-06 2021-11-23 新石器慧通（北京）科技有限公司 一种车辆的定位方法、定位系统及无人车辆

Also Published As

Publication number Publication date
JP2021169307A (ja) 2021-10-28
KR102557026B1 (ko) 2023-07-20
KR20210089603A (ko) 2021-07-16
US20210291833A1 (en) 2021-09-23
EP3885216A3 (en) 2022-05-04
CN111959505A (zh) 2020-11-20
JP7214794B2 (ja) 2023-01-30
EP3885216A2 (en) 2021-09-29
US11305771B2 (en) 2022-04-19

Similar Documents

Publication Publication Date Title
CN111959505B (zh) 车辆巡航控制方法、装置、电子设备和存储介质
CN111231950B (zh) 规划车辆变道路径的方法、装置、设备及可读存储介质
US11435186B2 (en) Dead reckoning method and apparatus for vehicle, device and storage medium
JP7334213B2 (ja) 自動駐車方法、自動駐車装置、電子機器、記憶媒体及びコンピュータプログラム
KR102559269B1 (ko) 실경 내비게이션 아이콘 표시 방법, 장치, 기기 및 매체
JP7204823B2 (ja) 車両制御方法、車両制御装置及び車両
KR102139426B1 (ko) 자율 주행 차량을 위한 차량 위치점 전달 방법
CN110794844B (zh) 自动驾驶方法、装置、电子设备及可读存储介质
CN111216738B (zh) 自动驾驶中车辆的控制方法、装置、电子设备及车辆
CN111693059B (zh) 环岛的导航方法、装置、设备及存储介质
CN114572240B (zh) 车辆行驶控制方法、装置、车辆、电子设备及存储介质
EP3842758B1 (en) Method and apparatus for generating offline map, vehicle and storage medium
US20210403083A1 (en) Reverse trajectory tracking method and apparatus, electronic device and storage medium
CN109345015B (zh) 用于选取路线的方法和装置
CN112051864A (zh) 用于移动目标轨迹跟踪的方法及装置、设备和可读介质
JP2020057358A (ja) ポーズ情報を取得する方法及び装置
CN111260722B (zh) 车辆定位方法、设备及存储介质
CN111767844A (zh) 用于三维建模的方法和装置
CN111959496B (zh) 用于车辆横向控制的模型生成方法、装置及电子设备
CN112577504B (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
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20211014

Address after: 105 / F, building 1, No. 10, Shangdi 10th Street, Haidian District, Beijing 100085

Applicant after: Apollo Intelligent Technology (Beijing) Co.,Ltd.

Address before: 2 / F, baidu building, 10 Shangdi 10th Street, Haidian District, Beijing 100085

Applicant before: BEIJING BAIDU NETCOM SCIENCE AND TECHNOLOGY Co.,Ltd.

GR01 Patent grant
GR01 Patent grant