CN114527738A - 跟随车辆的半自主倒车 - Google Patents
跟随车辆的半自主倒车 Download PDFInfo
- Publication number
- CN114527738A CN114527738A CN202110525131.1A CN202110525131A CN114527738A CN 114527738 A CN114527738 A CN 114527738A CN 202110525131 A CN202110525131 A CN 202110525131A CN 114527738 A CN114527738 A CN 114527738A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- lead
- following
- following vehicle
- path
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 claims abstract description 24
- 238000004891 communication Methods 0.000 claims description 23
- 230000006870 function Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000001154 acute effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000007423 decrease Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000005259 measurement Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000000737 periodic effect Effects 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 238000012360 testing method Methods 0.000 description 1
Images
Classifications
-
- 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/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control 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
-
- 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/0287—Control 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/0291—Fleet control
- G05D1/0293—Convoy travelling
-
- 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
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding 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
- 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
- B60W30/16—Control of distance between vehicles, e.g. keeping a distance to preceding vehicle
- B60W30/165—Automatically following the path of a preceding lead vehicle, e.g. "electronic tow-bar"
-
- 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/18036—Reversing
-
- 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/10—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 vehicle motion
- B60W40/105—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
- 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/10—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 vehicle motion
- B60W40/114—Yaw movement
-
- 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/12—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 parameters of the vehicle itself, e.g. tyre models
-
- 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
- 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/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- 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/0287—Control 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/0291—Fleet control
- G05D1/0295—Fleet control by at least one leading vehicle of the fleet
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04L—TRANSMISSION OF DIGITAL INFORMATION, e.g. TELEGRAPHIC COMMUNICATION
- H04L67/00—Network arrangements or protocols for supporting network services or applications
- H04L67/01—Protocols
- H04L67/12—Protocols specially adapted for proprietary or special-purpose networking environments, e.g. medical networks, sensor networks, networks in vehicles or remote metering networks
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/30—Services specially adapted for particular environments, situations or purposes
- H04W4/40—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P]
- H04W4/46—Services specially adapted for particular environments, situations or purposes for vehicles, e.g. vehicle-to-pedestrians [V2P] for vehicle-to-vehicle communication [V2V]
-
- 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
- B60W2540/00—Input parameters relating to occupants
- B60W2540/18—Steering angle
-
- 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
- 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/45—External transmission of data to or from the vehicle
- B60W2556/65—Data transmitted between vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- General Physics & Mathematics (AREA)
- Aviation & Aerospace Engineering (AREA)
- Mathematical Physics (AREA)
- Signal Processing (AREA)
- Computer Networks & Wireless Communication (AREA)
- Electromagnetism (AREA)
- Optics & Photonics (AREA)
- Human Computer Interaction (AREA)
- Chemical & Material Sciences (AREA)
- Medical Informatics (AREA)
- Computing Systems (AREA)
- Health & Medical Sciences (AREA)
- Combustion & Propulsion (AREA)
- General Health & Medical Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Multimedia (AREA)
- Acoustics & Sound (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
- Traffic Control Systems (AREA)
Abstract
一种用于使半自主跟随车辆倒车的系统和方法包括获得在正在倒车的跟随车辆前方且未连接到该跟随车辆的领路车辆的速度。一种方法包括估计领路车辆的路径并基于领路车辆的路径确定跟随车辆的路径。基于领路车辆的速度来控制跟随车辆的纵向运动,而基于跟随车辆的路径来控制跟随车辆的横向运动。
Description
技术领域
本主题公开涉及跟随车辆(follower vehicle)的半自主倒车。
背景技术
在自主车辆空间中,队列(platooning)是指一组车辆相互通信以形成一个排或群,其中领路车辆控制速度,每个跟随车辆保持该速度。例如,这种配置可以改善行驶时间并增加车道容量。开发一排自动车辆的一个重要步骤是主从配置。根据这一安排,包括驾驶员在内的领路人驾驶一辆半自主的无人驾驶跟随车。因此,希望提供跟随车辆的半自主倒车。
发明内容
在一个示例性实施例中,一种使半自主跟随车辆倒车的方法包括获得在正在倒车的跟随车辆前方且未连接到跟随车辆的领路车辆的速度,并估计领路车辆的路径。该方法还包括基于领路车辆的路径确定跟随车辆的路径,并基于领路车辆的速度控制跟随车辆的纵向移动,以及基于跟随车辆的路径控制跟随车辆的横向移动。
除了本文描述的一个或多个特征之外,该方法还包括由跟随车辆的处理器获得领路车辆的轴距LL和领路车辆的方向盘角SWAL,其中获得领路车辆的速度、领路车辆的轴距LL和领路车辆的方向盘角SWAL是经由来自领路车辆的车辆对车辆(V2V)通信实现的。
除了本文描述的一个或多个特征之外,估计领路车辆的路径包括确定转弯半径R为:
SGR是转向传动比,其是方向盘角SWAL和车轮角之间的转换因子。
除了本文描述的一个或多个特征之外,估计领路车辆的路径包括在x,y坐标系中生成如下轨迹:
R2=x2+(y-R)2。
除了本文描述的一个或多个特征之外,该方法还包括使用跟随车辆的处理器确定跟随车辆在x,y坐标系中的如下位置:
yf=d*cos(α+ΔYaw),其中
d是领路车辆和跟随车辆之间的距离,α是领路车辆和跟随车辆之间的方位角,Lf是跟随车辆的轴距,ΔYaw是领路车辆的偏航和跟随车辆的偏航之间的差。
除了本文描述的一个或多个特征之外,该方法还包括使用跟随车辆的传感器来确定领路车辆和跟随车辆之间的距离d以及领路车辆和跟随车辆之间的方位角α。
除了本文所述的一个或多个特征之外,该方法还包括通过V2V通信获得领路车辆的偏航,通过传感器获得跟随车辆的偏航,以及将差ΔYaw确定为从跟随车辆的偏航减去领路车辆的偏航。
除了本文描述的一个或多个特征之外,确定跟随车辆的路径包括计算跟随车辆的方向盘角SWAF,所述计算包括确定领路车辆在领路车辆的路径中的一点处的偏航,并确定从跟随车辆到领路车辆的路径中的该点的距离。
除了本文描述的一个或多个特征之外,确定领路车辆在领路车辆的路径中的该点处的偏航包括确定领路车辆的路径中的该点和在该点处与领路车辆的路径相切的线之间的角度。
除了本文描述的一个或多个特征之外,计算跟随车辆的方向盘角SWAF包括使用作为速度的函数的调谐参数。
在另一个示例性实施例中,执行半自主倒车的系统包括领路车辆,以通过车辆对车辆(V2V)通信来提供领路车辆的速度。该系统还包括不与领路车辆物理联接的跟随车辆的处理器。处理器估计领路车辆的路径,基于领路车辆的路径确定跟随车辆的路径,并且基于领路车辆的速度控制跟随车辆的纵向移动,以及基于跟随车辆的路径控制跟随车辆的横向移动。
除了本文描述的一个或多个特征之外,跟随车辆的处理器通过来自领路车辆的车辆对车辆(V2V)通信获得领路车辆的轴距LL和所述领路车辆的方向盘角SWAL,所述跟随车辆的处理器被配置为通过确定转弯半径R来估计领路车辆的路径:
SGR是转向传动比,其是方向盘角SWAL和车轮角之间的转换因子。
除了本文描述的一个或多个特征之外,跟随车辆的处理器被配置为通过在x,y坐标系中生成如下轨迹来估计领路车辆的路径,所述轨迹为:
R2=x2+(y-R)2
除了本文描述的一个或多个特征之外,跟随车辆的处理器被配置成确定跟随车辆在x,y坐标系中的如下位置:
yf=d*cos(α+ΔYaw),其中
d是领路车辆和跟随车辆之间的距离,α是领路车辆和跟随车辆之间的方位角,Lf是跟随车辆的轴距,ΔYaw是领路车辆的偏航和跟随车辆的偏航之间的差。
除了本文描述的一个或多个特征之外,跟随车辆的处理器使用跟随车辆的传感器来确定领路车辆和跟随车辆之间的距离d以及领路车辆和跟随车辆之间的方位角α。
除了本文描述的一个或多个特征之外,跟随车辆的处理器经由V2V通信来获得领路车辆的偏航,经由传感器来获得跟随车辆的偏航,并且将差ΔYaw确定为从跟随车辆的偏航减去领路车辆的偏航。
除了本文描述的一个或多个特征之外,跟随车辆的处理器通过计算跟随车辆的方向盘角SWAF来确定跟随车辆的路径,所述计算包括确定领路车辆在领路车辆的路径中的一点处的偏航,并确定从跟随车辆到领路车辆的路径中的该点的距离。
除了本文描述的一个或多个特征之外,跟随车辆的处理器通过确定领路车辆的路径中的该点和在该点处与领路车辆的路径相切的线之间的角度来确定领路车辆在领路车辆的路径中的该点处的偏航。
除了本文描述的一个或多个特征之外,跟随车辆的处理器通过使用作为速度的函数的调谐参数来计算跟随车辆的方向盘角SWAF。
当结合附图时,根据以下详细描述,本公开的上述特征和优点以及其他特征和优点将变得显而易见。
附图说明
其他特征、优点和细节仅作为示例出现在以下详细描述中,详细描述参考附图,其中:
图1示出了根据一个或多个实施例的跟随车辆的半自主倒车;
图2示出了根据一个或多个实施例的用于执行跟随车辆的半自主倒车的路径规划的参数;和
图3是根据一个或多个实施例的倒车跟随车辆的方法的流程图。
具体实施方式
以下描述本质上仅仅是示例性的,并不旨在限制本公开、其应用或使用。应当理解,在所有附图中,相应的附图标记表示相似或相应的部件和特征。
如前所述,领路-跟随配置包括一辆带有驾驶员的领路车辆和一辆半自主、无人驾驶的跟随车辆。本文详述的系统和方法的实施例涉及跟随车辆的半自主倒车。跟随车辆可以是容纳另一交通工具(例如,船、其它船只、全地形车辆)的拖车、旅行拖车或先前可能已经被领路车辆物理牵引的其它无人驾驶平台。当跟随车辆跟随领路车辆时,跟随车辆保持在领路车辆后面的规定距离以及由领路车辆产生的路径上的规定方位角或横向偏差。跟随车辆基于领路车辆和跟随车辆的传感器之间的视线保持必要的距离和路径,并且两者之间没有任何物理连接。
基于这种配置,在倒车机动过程中,跟随车辆实际上移动到领路车辆的前面。因此,根据本文详述的实施例,跟随车辆必须预测并匹配领路车辆的运动。跟随车辆必须与领路车辆的纵向运动(即速度)相匹配,以保持两者之间的最小距离。根据示例性实施例,这可以通过领路车辆和跟随车辆之间的车辆对车辆(V2V)通信或者通过跟随车辆对领路车辆的速度的估计来实现。跟随车辆还必须与领路车辆的横向运动相匹配,以避免折刀(jackknifing)情况(即,领路车辆和跟随车辆形成锐角)或导致两辆车辆的传感器之间的视线丢失的其他事件。这可以通过领路车辆转向角的V2V通信来实现。根据一个或多个实施例,跟随车辆使用转向角来估计领路车辆的路径,并计算跟随车辆的相应路径。
根据示例性实施例,图1示出了根据一个或多个实施例的跟随车辆140的半自主倒车。示出了领路车辆100和跟随车辆140。根据替代实施例,图1所示的示例性领路车辆100是汽车101,但是领路车辆100可以是卡车、农业设备、建筑设备或任何带有驾驶员的运输工具。图1中示出的示例性跟随车辆140是行进拖车141,但是如前所述,跟随车辆140可以替代地是任何类型的无人驾驶车辆,其可以在引导-跟随配置之前被物理牵引。
领路车辆100和跟随车辆140包括传感器130,传感器130获得关于车辆100、140周围环境的信息,并提供关于车辆100、140本身的信息。示例性传感器130包括摄像头、激光雷达系统、无线电雷达系统、超声波传感器、诸如全球定位系统的全球导航卫星系统、惯性测量单元、陀螺仪和车轮速度传感器。根据一个或多个实施例,与跟随车辆140的横向控制相关的传感器130,如详细描述的,包括车辆100、140中的每一个中的偏航传感器和至少在车辆100中的方向盘角传感器。根据示例性实施例,传感器130被指示在领路车辆100的背面和跟随车辆140的两端。然而,领路车辆100或跟随车辆140上的传感器130的数量和位置不受示例性图示的限制。领路车辆100包括与驾驶员交互的界面125。例如,界面125可以是信息娱乐系统的一部分,该信息娱乐系统包括显示屏并向驾驶员提供触摸屏或其他输入设备。
领路车辆100包括加速踏板105、制动踏板115和方向盘120,所有这些都由领路车辆100的驾驶员操作。尽管出于解释的目的示出和讨论了踏板105、115,但是根据替代实施例,可以采用旋钮、杠杆或其他控制机构来实现相同的功能。领路车辆100包括控制器110,控制器110单独地或与其他处理电路组合地控制领路车辆100的操作和通信的各个方面。例如,领路车辆100和跟随车辆140可以执行车辆对车辆(V2V)通信,交换V2V消息135。如参考图2所详述的,来自领路车辆100的V2V通信可以指示领路车辆100的速度和方向盘120的运动。从跟随车辆140到领路车辆100的V2V通信可以提供利用其一个或多个传感器130(例如,摄像头)获得的数据(例如,图像)。例如,由领路车辆100从跟随车辆140获得的图像可以由界面125(例如,信息娱乐屏幕)显示给领路车辆100的驾驶员。
跟随车辆140被显示为包括控制器145。跟随车辆140的控制器145便于与领路车辆100的V2V通信。该通信可以指示领路车辆100自身不能容易获得的信息。例如,因为在倒车配置中跟随车辆140在领路车辆100的前方,所以跟随车辆140的传感器130可以检测到领路车辆100的传感器130-尚不可见的物体(例如,行人、其他车辆、墙壁)。跟随车辆140可以通过V2V通信警告领路车辆100,如果继续倒车,跟随车辆140将接触物体。此外,跟随车辆140可以警告领路车辆100潜在的折刀情况(即,领路车辆100和跟随车辆140一起形成锐角)。也就是说,跟随车辆140的控制器145监测由领路车辆100和跟随车辆140的组合形成的角度。该监测可以基于以下讨论的领路车辆100的估计路径150和跟随车辆140的计算路径160。如果角度减小并达到预定阈值,则跟随车辆140可以通过V2V通信向领路车辆100发出警告。
除了促进与领路车辆100的V2V通信之外,跟随车辆140的控制器145还可以执行和控制参考图2讨论的纵向控制和横向控制的实现(例如,路径规划)。具体地,除了获得或估计领路车辆100的速度之外,跟随车辆140的控制器145可以估计领路车辆100的路径150,以便计算跟随车辆140的路径160。领路车辆100的控制器110和跟随车辆140的控制器145都可以包括处理电路,该处理电路可以包括专用集成电路(ASIC)、电子电路、处理器(共享的、专用的或成组的)和执行一个或多个软件或固件程序的存储器、组合逻辑电路和/或提供所述功能的其他合适的组件。
图2示出了根据一个或多个实施例的用于执行跟随车辆140的半自主倒车的路径规划的参数。选择坐标系x,y,如图2所示。该具体坐标系可以替代地是车辆100、140之一的坐标系,在车辆100、140之一的重心(CoG)处或其他地方,或者可以根据另一个基础来选择,但是重点是在考虑所有位置时具有共同的坐标系,如下所述。
根据示例性实施例,针对作为领路自行车模型210的领路车辆100和针对作为跟随自行车模型220的跟随车辆140生成车辆自行车模型。根据替代实施例,其他模型可以用于路径150、160的确定。车辆自行车模型是一种已知的代表四个车轮的运动学模型,其具有两个车轮,包括代表两个前轮的可转向前轮和代表车辆的两个后轮的不可转向后轮。自行车模型中使用轴距L,即前后轮胎之间的距离,但轨迹宽度,即两个前轮之间或两个后轮之间的距离(即前轮轴或后轮轴的长度),通常不是模型的一部分。自行车模型中前轮的转向角是实际车辆左右轮之间角度的平均值。在下面的等式中,LL是领路车辆100的轴距,而LF是跟随车辆140的轴距。轴距值LL和LF都被提供给跟随车辆140的控制器145。
偏航是指车辆方向从参考取向(向左或向右)的方式取向偏移。领路车辆100和跟随车辆140的偏航角分别为YawL和YawF。如前所述,领路车辆100和跟随车辆140处的传感器130提供偏航角。此外,V2V通信被用于向跟随车辆140的控制器145报告领路车辆100的偏航角YawL。偏航角YawL和YawF转换为x,y坐标系,如图所示。在示例性情况下,跟随车辆140在x,y坐标系中的偏航角为0。差值ΔYaw为:
ΔYaw=YawF-YawL [等式.1]
如前所述,除了领路车辆100的偏航角YawL之外,领路车辆100的方向盘角SWAL也通过跟随车辆140的控制器145经由V2V通信获得。基于该角和领路车辆100的轴距LL,控制器145使用领路自行车模型210确定领路车辆100的转弯半径R,如下:
在等式2中,转向传动比(SGR)是领路车辆100的方向盘角SWAL和车轮角(即领路自行车模型210的前轮角度)之间的转换因子。然后,根据圆的公式,在x和y坐标系中估计领路车辆100的轨迹(即,估计路径150):
R2=x2+(y-R)2 [等式3]
也就是说,一旦基于领路车辆100的方向盘角SWAL确定了领路车辆100的转弯半径R,就可以根据等式3来估计路径150的轨迹。每当领路车辆100的方向盘角SWAL改变时,其就被更新。同样,差值ΔYaw根据等式1更新。
如前所述,无论是倒车还是跟随,跟随车辆140都保持与领路车辆100的规定距离d和与领路车辆100的规定方位角或横向偏差(角度α)。跟随车辆140可以使用传感器130(例如,激光雷达系统)来确定其与领路车辆100的距离d和方位角α。如图2所示,方位角α在跟随自行车模型220的前中点和领路自行车模型210的后中点之间的直线和y轴(图2中跟随车辆的取向)之间。基于该距离d和方位角α,跟随车辆140在x,y坐标系中的位置可以确定为:
yf=d*cos(α+ΔYaw) [等式.5]
在图2中,示出了从领路自行车模型210的后轮到跟随自行车模型220的前轮的距离d,并且跟随自行车模型220的位置xf,yf在跟随自行车模型220的COG处。然而,该示例性实施例并非旨在进行限制。跟随自行车模型220的位置xf,yf可以改为跟随自行车模型220的前轮或后轮,距离d可以改为从领路自行车模型210的不同部分到跟随自行车模型220的不同部分的距离。根据一个或多个实施例的等式将有助于基于任一替代实施例的跟随车辆140的横向控制。通常,彼此面对的领路车辆100和跟随车辆140上的传感器130(例如,激光雷达系统、摄像头)确定它们之间的距离d。
在倒车过程中,对跟随车辆140的横向运动进行控制的跟随车辆140的方向盘角SWAF可以确定为:
在替代实施例中,跟随车辆140SWAF的方向盘角可以使用另一种已知方法来计算,例如纯追踪。等式6涉及领路车辆100的速度,其基于领路车辆100的速度计经由V2V通信被提供给跟随车辆140的控制器145,或者由根据替代实施例的跟随车辆140的一个或多个传感器130确定。
路径150的偏航Yawpath涉及当领路车辆100在路径150上行进时领路车辆100在路径150上的点x’,y’处的偏航。路径150的偏航Yawpath被获得以作为切线T与一圆之间的角度α。该圆在点x’,y’处根据等式3定义了路径150,该点通常是路径150到跟随车辆140的最近点。例如,可以从等式3通过设置y’=yf(即,将领路车辆100更远地放回到跟随车辆140的位置处的路径150上)来求解x’而获得沿着路径150的这个点x’,y’。到路径150的距离dpath是从跟随车辆140的位置xf,yf到由等式3中的圆定义的路径150的距离。也就是说,到路径150dpath的距离是从位置xf,yf到路径150上的点x’,y’的距离(即,在由等式3定义的圆上)。在等式6中,k1和k2是调谐参数。具体地,k1和k2都是速度的函数,并且还取决于跟随车辆140的运动学和动力学特点。这些值可以通过测试来确定,例如,以获得跟随车辆140的控制器145的特定响应(即,在预定时间内校正横向偏移误差)。
根据等式6获得的跟随车辆140的方向盘角SWAF提供了基于等式2和3的跟随车辆140的路径160。也就是说,跟随车辆140的转弯半径是使用跟随车辆140的轴距LF和跟随车辆140的方向盘角SWAF在等式2中获得的。然后可以使用等式3获得用于路径160的等式。
图3是根据一个或多个实施例让跟随车辆140倒车的方法300的流程图。在框310,跟随车辆140的控制器145获得关于领路车辆100的信息。例如,该信息可以通过V2V通信获得。该信息包括领路车辆100的速度、偏航YawL、领路车辆100的轴距LL和领路车辆100的方向盘角SWAL。在框320,跟随车辆140确定距领路车辆100的距离d和距领路车辆100的角度α。例如,该确定可以周期性地重复。如前所述,该信息可以通过跟随车辆140的传感器130(例如,激光雷达系统)获得。
在框330,根据等式2和3计算转弯半径R并获得用于领路车辆100的路径150的公式。在框340,确定跟随车辆140的位置xf,yf是在用于确定领路车辆100的路径150的同一坐标系x,y中进行的。这个确定用的是等式4和5。在框350,根据等式6确定跟随车辆140的方向盘角SWAF。在框360,在倒车过程中控制跟随车辆140是根据领路车辆100的速度和跟随车辆140的方向盘角SWAF进行的。跟随车辆140的速度将被设定为与领路车辆100的速度紧密匹配。具体地,例如,跟随车辆140的速度可以被设定为低于领路车辆100的速度的预定量,或者可以被保持在领路车辆100的速度的阈值范围内。
图3中详述的方法300表示半自主倒车过程,因为跟随车辆100的控制器145使用来自领路车辆100的信息来最终让跟随车辆140倒车。在让领路车辆100和跟随车辆140倒车的过程中,重复过程310至360。根据替代实施例,这种重复可以是基于事件的或周期性的。例如,值之一的改变(例如,来自领路车辆100的V2V消息报告领路车辆100的不同方向盘角SWAL,确定不同距离d)可以触发图3所示过程的重新执行。或者,可以获得框310和320处的所有值,并且可以周期性地重复这些确定。
虽然已经参考示例性实施例描述了上述公开,但是本领域技术人员将理解,在不脱离本发明的范围的情况下,可以进行各种改变,并且等同物可以替代其元件。此外,在不脱离本公开的基本范围的情况下,可以进行许多修改以使特定情况或材料适应本公开的教导。因此,意图是本公开不限于所公开的特定实施例,而是将包括落入其范围内的所有实施例。
Claims (10)
1.一种使半自主跟随车辆倒车的方法,该方法包括:
由跟随车辆的处理器获得在正在倒车的跟随车辆前方且未连接到跟随车辆的领路车辆的速度;
由跟随车辆的处理器估计领路车辆的路径;
由跟随车辆的处理器基于领路车辆的路径确定跟随车辆的路径;和
经由跟随车辆的处理器,基于领路车辆的速度控制跟随车辆的纵向运动,并且基于跟随车辆的路径控制跟随车辆的横向运动。
2.根据权利要求1所述的方法,还包括由跟随车辆的处理器获得领路车辆的轴距LL和领路车辆的方向盘角SWAL,其中获得领路车辆的速度、领路车辆的轴距LL和领路车辆的方向盘角SWAL是经由来自领路车辆的车辆对车辆(V2V)通信实现的,其中估计领路车辆的路径包括确定转弯半径R:
SGR是转向传动比,其是方向盘角SWAL和车轮角之间的转换因子,估计领路车辆的路径包括在x,y坐标系中根据如下等式生成轨迹:
R2=x2+(y-R)2,且
该方法包括使用跟随车辆的处理器根据如下等式确定跟随车辆在x,y坐标系中的位置:
yf=d*cos(α+ΔYaw),其中
d是领路车辆和跟随车辆之间的距离,α是领路车辆和跟随车辆之间的方位角,Lf是跟随车辆的轴距,ΔYaw是领路车辆的偏航和跟随车辆的偏航之间的差。
3.根据权利要求2所述的方法,还包括使用跟随车辆的传感器来确定领路车辆和跟随车辆之间的距离d以及领路车辆和跟随车辆之间的方位角α。
4.根据权利要求2所述的方法,还包括通过V2V通信获得领路车辆的偏航,通过传感器获得跟随车辆的偏航,以及将差ΔYaw确定为从跟随车辆的偏航减去领路车辆的偏航。
5.根据权利要求2所述的方法,其中确定跟随车辆的路径包括计算跟随车辆的方向盘角SWAF,所述计算包括确定领路车辆在领路车辆的路径中的一点处的偏航,并确定从跟随车辆到领路车辆的路径中的该点的距离,确定领路车辆在领路车辆的路径中的该点处的偏航包括确定:领路车辆的路径和在路径中的该点处与领路车辆的路径相切的线之间的角度,并且计算跟随车辆的方向盘角SWAF包括使用作为速度的函数的调谐参数。
6.一种执行半自主倒车的系统,该系统包括:
领路车辆,被配置为经由车辆对车辆(V2V)通信来提供领路车辆的速度;和
跟随车辆的处理器,其不物理地联接到领路车辆,并且被配置为估计领路车辆的路径,基于领路车辆的路径确定跟随车辆的路径,并且基于领路车辆的速度控制跟随车辆的纵向移动,以及基于跟随车辆的路径控制跟随车辆的横向移动。
7.根据权利要求6所述的系统,其中,所述跟随车辆的处理器被配置为经由来自所述领路车辆的车辆对车辆(V2V)通信来获得所述领路车辆的轴距LL和所述领路车辆的方向盘角SWAL,所述跟随车辆的处理器被配置为通过根据如下公式确定转弯半径R来估计领路车辆的路径:
SGR是转向传动比,其是方向盘角SWAL和车轮角之间的转换因子,跟随车辆的处理器被配置为通过在x,y坐标系中根据如下公式生成轨迹来估计领路车辆的路径,所述轨迹为:
R2=x2+(y-R)2,且
跟随车辆的处理器被配置成根据如下公式确定跟随车辆在x,y坐标系中的位置:
yf=d*cos(α+ΔYaw),其中
d是领路车辆和跟随车辆之间的距离,α是领路车辆和跟随车辆之间的方位角,Lf是跟随车辆的轴距,ΔYaw是领路车辆的偏航和跟随车辆的偏航之间的差。
8.根据权利要求7所述的系统,其中,所述跟随车辆的处理器被配置为使用跟随车辆的传感器来确定领路车辆和跟随车辆之间的距离d以及领路车辆和跟随车辆之间的方位角α。
9.根据权利要求7所述的系统,其中,所述跟随车辆的处理器被配置为经由V2V通信来获得领路车辆的偏航,经由传感器来获得跟随车辆的偏航,并且将差ΔYaw确定为从跟随车辆的偏航减去领路车辆的偏航。
10.根据权利要求7所述的系统,其中,所述跟随车辆的处理器被配置为通过计算跟随车辆的方向盘角SWAF来确定跟随车辆的路径,所述计算包括确定领路车辆在领路车辆的路径中的一点处的偏航,并确定从跟随车辆到领路车辆的路径中的该点的距离,所述跟随车辆的处理器被配置为通过确定领路车辆的路径中的该点和在该点处与领路车辆的路径相切的线之间的角度来确定领路车辆在领路车辆的路径中的该点处的偏航,并且所述跟随车辆的处理器被配置为通过使用作为速度的函数的调谐参数来计算跟随车辆的方向盘角SWAF。
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
US17/088,215 US11465623B2 (en) | 2020-11-03 | 2020-11-03 | Semi-autonomous reversing of a follower vehicle |
US17/088,215 | 2020-11-03 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114527738A true CN114527738A (zh) | 2022-05-24 |
Family
ID=81184643
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110525131.1A Pending CN114527738A (zh) | 2020-11-03 | 2021-05-14 | 跟随车辆的半自主倒车 |
Country Status (3)
Country | Link |
---|---|
US (1) | US11465623B2 (zh) |
CN (1) | CN114527738A (zh) |
DE (1) | DE102021113940A1 (zh) |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3913295B2 (ja) * | 1996-09-30 | 2007-05-09 | 本田技研工業株式会社 | 自動追従システム |
US8116921B2 (en) * | 2008-08-20 | 2012-02-14 | Autonomous Solutions, Inc. | Follower vehicle control system and method for forward and reverse convoy movement |
US8626406B2 (en) * | 2011-12-22 | 2014-01-07 | Deere & Company | Method and system for transferring material between vehicles |
SE541795C2 (en) * | 2017-09-22 | 2019-12-17 | Sentient Ip Ab | Method and system for controlling vehicle lane holding |
AU2019301524A1 (en) * | 2018-07-07 | 2023-03-16 | Peloton Technology, Inc. | Control of automated following in vehicle convoys |
-
2020
- 2020-11-03 US US17/088,215 patent/US11465623B2/en active Active
-
2021
- 2021-05-14 CN CN202110525131.1A patent/CN114527738A/zh active Pending
- 2021-05-30 DE DE102021113940.6A patent/DE102021113940A1/de active Pending
Also Published As
Publication number | Publication date |
---|---|
DE102021113940A1 (de) | 2022-05-05 |
US20220135037A1 (en) | 2022-05-05 |
US11465623B2 (en) | 2022-10-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
US10678247B2 (en) | Method and apparatus for monitoring of an autonomous vehicle | |
US8428843B2 (en) | Method to adaptively control vehicle operation using an autonomic vehicle control system | |
CN107128314B (zh) | 用于牵引车辆的增强的车辆横向控制 | |
US8180525B2 (en) | Method and system for assisting a driver when parking or maneuvering a motor vehicle | |
CN106061814B (zh) | 对超过lcc的转向转矩限制的预先警报 | |
US10600257B2 (en) | Method and apparatus for monitoring of an autonomous vehicle | |
EP3787911A1 (en) | Trailer detection and autonomous hitching | |
US20200238980A1 (en) | Vehicle control device | |
JP2019077291A (ja) | 車両制御装置 | |
CN111976722A (zh) | 包括自主控制系统的用于控制车辆的方法和设备 | |
US20200070819A1 (en) | Obstacle avoidance apparatus and obstacle avoidance route generating apparatus | |
Péter et al. | Vision and odometry based autonomous vehicle lane changing | |
CN115303262A (zh) | 车辆控制方法、装置、终端设备及计算机可读存储介质 | |
JP2017030396A (ja) | 車両の走行制御装置 | |
US11912360B2 (en) | Vehicle control method, vehicle control system, and vehicle | |
JP2019066444A (ja) | 位置演算方法、車両制御方法及び位置演算装置 | |
JP2019012345A (ja) | 右左折時衝突被害軽減装置 | |
CN114291071B (zh) | 一种车辆稳定性控制主动介入时机的判定方法、系统、可读存储介质及车辆 | |
CN114527738A (zh) | 跟随车辆的半自主倒车 | |
CN116118770A (zh) | 面向稳健自动驾驶控制的车辆感知系统的自适应合理化器 | |
CN113602285B (zh) | 一种车辆自动驾驶的控制方法、装置、设备及介质 | |
JP2019159797A (ja) | 右左折時衝突被害軽減装置 | |
CN115042779A (zh) | 拖车车道偏离警告和车道保持辅助 | |
JP2020035174A (ja) | 目標軌跡の生成方法 | |
US20230009606A1 (en) | Automated driving method, automated driving system, and storage medium |
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 |