CN114115260A - 自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 - Google Patents
自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 Download PDFInfo
- Publication number
- CN114115260A CN114115260A CN202111386656.8A CN202111386656A CN114115260A CN 114115260 A CN114115260 A CN 114115260A CN 202111386656 A CN202111386656 A CN 202111386656A CN 114115260 A CN114115260 A CN 114115260A
- Authority
- CN
- China
- Prior art keywords
- vehicle
- point
- angle
- origin
- headang0
- 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 title claims abstract description 31
- 238000009434 installation Methods 0.000 claims description 17
- 238000013519 translation Methods 0.000 claims description 6
- 238000010276 construction Methods 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 238000012545 processing Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000011065 in-situ storage Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供了一种自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其步骤包括:获取计算GPS安装位置坐标、车辆前后铰接角;根据车辆行驶方向确定GPS定位基准点;实时获取车辆前方规划的目标路径点;确定目标点与车辆坐标系原点的象限方位及目标角度;计算目标点与实车原点坐标的直线距离;计算目标点与原点的航向角;确定车辆坐标系下的目标点坐标、目标转向角实现车辆行驶方向控制。本发明所述的GPS定位基准点,确定前进时车头位置和倒退时车尾位置,防止车辆行驶超出路径行驶,实现自动驾驶的路径跟踪功能,及提高路径跟踪的控制精度,适用于前后双轴分别带驱动和转向系统的铰接车、前驱动前转向的铰接车、前后双驱前转向的铰接车等多种车型。
Description
技术领域
本发明属于自动驾驶铰接车领域,尤其是涉及一种自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法。
背景技术
铰接车是用铰链装置连接在一起的两节或多节车身组成的轮式车辆和履带式车辆,使用专门的液压机构,能够使车身相对的在水平面或垂直纵断(或横断)面上移动,靠各车身之间的连接环的相互转动而改变前进方向。
对于铰接式的自动无人驾驶车辆在车辆直线行驶和转向行驶过程,由于前后两部分车体是通过铰接式进行连接的,所以会随着车辆的摆动导致前后两部分车体都在摆动,导致车辆无法按直线行驶和转向时走S弯甚至过渡转向。
尤其是车辆转向时,车辆的前半部分转向时,势必会导致车辆后半部分也同时向相同方向摆动转向,对自动无人驾驶来说车辆控制及路径的跟踪寻迹造成很大的影响。
基于车辆运动模型进行路径跟踪寻迹控制时,是以实际GSP点和目标路径GPS点的重合程度来控制车辆行驶的,如果不对车辆模型定位进行重新构建,势必会因为车辆GPS实际安装位置的影响导致车辆行驶超出路径直线和转向时,按图1的GPS安装位置会超出半个车身的长度,如果目标路径的周围环境有路基、障碍物、塌陷等情况,会导致车辆出现安全事故,同时也很大程度的影响路径跟踪的控制精度。
发明内容
有鉴于此,本发明旨在提出一种自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,以了解决铰接车辆直线和转向行驶的性能,正确的进行路径规划,保证路径安全稳定的行驶。
为达到上述目的,本发明的技术方案是这样实现的:
自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:具体步骤:
S1、构建车辆模型
S11、获取GPS安装位置的车辆经纬度、初始航向角HeadAng0,并将GPS安装位置经纬度转换成UTM坐标系下GPS安装位置坐标(X0,Y0);
S12、获取车辆公共轴线与车辆前半部分中心线形成的前车铰接角α和车辆公共轴线与车辆后半部分中心线形成的后车铰接角β;
S13、根据车辆行驶方向对车辆模型进行重构,确定GPS定位基准点在车辆上的位置,并根据GPS安装位置坐标(X0,Y0)、初始航向角HeadAng0、铰接角α、铰接角β计算GPS定位基准点处的基准点坐标、基准点航向角;
S2、构建路径追踪模型
S21、输入路径规划中的目标路径点,实时获取车辆前方规划的目标路径点(Xr,Yr);
S22、以GPS定位基准点为车辆坐标系的原点(X0’,Y0’),确定目标点与车辆坐标系原点的象限方位及目标点度HeadAngr;
S23、计算目标点与实车原点坐标的直线距离S;
S24、目标航向角转换,以车辆坐标系原点为参考点,计算目标点与原点的航向角HeadAngr’;
S25、确定车辆坐标系下的目标点坐标(Xr’,Yr’)。
S26、根据车辆坐标系的原点(X0’,Y0’)和目标点坐标(Xr’,Yr’),计算车辆目标转向角;
S3、实现车辆控制
将目标转向角转换为方向盘角度,并将方向盘角度输入转向系统,转向系统控制车辆转向机构达到期望的目标转向角。
进一步的,步骤S11中,GPS安装位置为车辆前半部分,并且接近车辆铰接点位置;设定GPS安装位置为初始原点,设定初始原点坐标为(X0,Y0),初始航向角为HeadAng0;
步骤S12中,获取前车铰接角α和后车铰接角β均是通过转向传感器获取车辆的转向角度,所述车辆转向角度即为铰接点的铰接角。
进一步的,步骤S13中,确定车辆GPS定位基准点:当车辆向前行驶时,把车辆GPS定位基准点平移到车头位置,作为主定位点;当车辆倒退行驶时,把车辆GPS定位基准点平移到车尾位置,作为主定位点;
计算GPS定位基准点处的基准点坐标、基准点航向角方法:
在车辆前进时,由于GPS位置安装在车辆前半部分,而车辆的前半部分为刚性车,故可使用车辆长度来修正平移,获取GPS定位基准点的基准点坐标及基准点航向角,设定前进时重新构建的GPS基准点坐标为(X1,Y1),基准点航向角为HeadAng1,车辆铰接角为α,车辆左转α为正,右转α为负;
车辆前进时,GPS定位基准点的基准点航向角为:
HeadAng1=HeadAng0+α(HeadAng0+α<360),
或者,HeadAng1=(HeadAng0+α)-360(HeadAng0+α>360)
车辆前进时,车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng1≤90时,
基准点坐标为X1=X0+Lf*sin(HeadAng1),Y1=Y0+Lf*cos(HeadAng1);
当90<HeadAng1≤180时,
基准点坐标为X1=X0+Lf*cos(HeadAng1-90),
Y1=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng1≤270时,
基准点坐标为X1=X0-Lf*sin(HeadAng1-180),
Y1=Y0-Lf*cos(HeadAng1-180);
当270<HeadAng1≤360时,
基准点坐标为X1=X0-Lf*cos(HeadAng1-270),
Y1=Y0+Lf*sin(HeadAng1-270);
在车辆倒退时,使用车辆长度来进行修正平移和铰接点的角度综合处理构建,获取GPS定位基准点的基准点坐标及基准点航向角,设定车辆倒退行驶时重新构建的GPS基准点坐标为(X2,Y2),基准点航向角为HeadAng2,车辆铰接角为β,车辆左转β为正,右转β为负;
车辆倒退,GPS定位基准点的基准点航向角为:
HeadAng2=HeadAng0+180-(α+β)(0<HeadAng0≤180),
HeadAng2=HeadAng0-180-(α+β)(180<HeadAng0≤360);
车辆倒退,车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng2≤90时,
基准点坐标为X2=X0+Lf*sin(HeadAng2),Y2=Y0+Lf*cos(HeadAng2);
当90<HeadAng2≤180时,
基准点坐标为X2=X0+Lf*cos(HeadAng2-90),
Y2=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng2≤270时,
基准点坐标为X2=X0-Lf*sin(HeadAng2-180),
Y2=Y0-Lf*cos(HeadAng2-180);
当270<HeadAng2≤360时,
基准点坐标为X2=X0-Lf*cos(HeadAng2-270),Y2=Y0+Lf*sin(HeadAng2-270)。
进一步的,步骤S22中,所述以GPS定位基准点为车辆坐标系的原点为:
设定车辆坐标系原点为(X0’,Y0’),基于车辆坐标系控制把车辆模型重构后的GPS定位基准点作为车辆坐标系原点,即车辆前进时的原点为(X1,Y1),则X0’=X1、Y0’=Y1;车辆后退时的原点为(X2,Y2),则X0’=X2、Y0’=Y2;
所述确定目标点与车辆坐标系原点的象限方位及目标点度HeadAngr方法:
设定车辆的原点航向角为HeadAng0’,其中车辆前进时的原点航向角为HeadAng0’=HeadAng1;车辆后退时的原点航向角为HeadAng0’=HeadAng2;
当Xr-X0’>0,且Yr-Y0’>0时,目标点在车辆原点的第一象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’));
当Xr-X0’>0,且Yr-Y0’<0时,目标点在车辆原点的第二象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+90;
当Xr-X0’<0,且Yr-Y0’<0时,目标点在车辆原点的第三象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’))+180;
当Xr-X0’<0,且Yr-Y0’>0时,目标点在车辆原点的第四象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+270。
进一步的,步骤S23中,计算目标点与车辆原点坐标的直线距离S的公式:
进一步的,步骤S24中,计算目标点与原点的航向角HeadAngr’方法:
当0≤HeadAng0’≤90时,
目标点在第一、第二象限时,目标点与原点的航向角为HeadAngr’=HeadAngr,目标点在第四象限时,目标点与原点的航向角HeadAngr’=HeadAngr-360;
当90<HeadAng0’≤180时,
目标点在第一、第二、第三象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-90;
当180<HeadAng0’≤270时,
目标点在第二、第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-180;
当270<HeadAng0’≤360时,
目标点在第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-270,目标点在第一象限时,目标点与原点的航向角为HeadAngr’=HeadAngr+90。
进一步的,步骤S25中,确定车辆坐标系下的目标点坐标(Xr’,Yr’)公式:
当0≤HeadAng0’≤90时,
HeadAng0’≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-HeadAngr’),
Yr’=S*sin(HeadAng0’-HeadAngr’),
HeadAng0’<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-HeadAng0’),
Yr’=S*sin(HeadAngr’-HeadAng0’);
当90<HeadAng0’≤180时,
HeadAng0’-90≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-90-HeadAngr’),
Yr’=S*sin(HeadAng0’-90-HeadAngr’);
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-90)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-90));
当180<HeadAng0’≤270时,
HeadAng0’-180≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-180-HeadAngr’),
Yr’=S*sin(HeadAng0’-180-HeadAngr’),
HeadAng0’-180<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-180)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-180));
当270<HeadAng0’≤360时,
HeadAng0’-270≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-270-HeadAngr’),
Yr’=S*sin(HeadAng0’-270-HeadAngr’),
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-270)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-270))。
进一步的,步骤S26中,根据车辆原点(X0’,Y0’)和车辆坐标系目标点坐标(Xr’,Yr’),计算车辆目标转向角方法:
车辆前进时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆前进向右转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆前进向左转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’));
车辆后退时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆倒退向右转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆倒退向左转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’))。
进一步的,步骤S3中,将目标转向角θ转换为方向盘角度ang公式为:
ang=θ*K,
K为转向系统的方向盘转角与车辆转角的比例系关系系数。
相对于现有技术,本发明所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法具有以下有益效果:
(1)本发明所述的对车辆模型定位进行重新构建,设置GPS定位基准点,确定前进时车头位置和倒退时车尾位置,防止车辆行驶超出路径行驶,提高路径跟踪的控制精度。
(2)本发明所述的搭建铰接车车辆模型,分别根据车辆前进和车辆后退两种模式进行计算,分别建立车辆坐标系,将GPS定位基准点设定为车辆坐标系原点,建立目标点坐标与车辆坐标系原点关系,简化计算,优化路径跟踪模型。
附图说明
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明实施例所述的铰接车示意图;
图2为本发明实施例所述的铰接车转向时以后车中心线为纵向的示意图;
图3为本发明实施例所述的铰接车直线行驶示意图;
图4为本发明实施例所述的铰接车转向时以公共轴线为纵向的示意图;
图5为本发明实施例所述的车辆GPS重构解析图;
图6为本发明实施例所述的路径目标点坐标与车辆坐标系原点关系图。
具体实施方式
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。
在本发明的描述中,需要理解的是,术语“中心”、“纵向”、“横向”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”等仅用于描述目的,而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”等的特征可以明示或者隐含地包括一个或者更多个该特征。在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以通过具体情况理解上述术语在本发明中的具体含义。
下面将参考附图并结合实施例来详细说明本发明。
如图1至图6所示,自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:具体步骤为:
S1、构建车辆模型
S11、获取GPS安装位置的车辆经纬度、初始航向角HeadAng0,并将GPS安装位置经纬度转换成UTM坐标系下GPS安装位置坐标(X0,Y0);
S12、获取车辆公共轴线与车辆前半部分中心线形成的前车铰接角α和车辆公共轴线与车辆后半部分中心线形成的后车铰接角β;
S13、根据车辆行驶方向对车辆模型进行重构,确定GPS定位基准点在车辆上的位置,并根据GPS安装位置坐标(X0,Y0)、初始航向角HeadAng0、前车铰接角α、后车铰接角β计算GPS定位基准点处的基准点坐标、基准点航向角;
S2、构建路径追踪模型
S21、输入路径规划中的目标路径点,实时获取车辆前方规划的目标路径点(Xr,Yr);
S22、以GPS定位基准点为车辆坐标系的原点(X0’,Y0’),确定目标点与车辆坐标系原点的象限方位及目标点度HeadAngr;
S23、计算目标点与实车原点坐标的直线距离S;
S24、目标航向角转换,以车辆坐标系原点为参考点,计算目标点与原点的航向角HeadAngr’;
S25、确定车辆坐标系下的目标点坐标(Xr’,Yr’)。
S26、根据车辆坐标系的原点(X0’,Y0’)和目标点坐标(Xr’,Yr’),计算车辆目标转向角;
S3、实现车辆控制
将目标转向角转换为方向盘角度,并将方向盘角度输入转向系统,转向系统控制车辆转向机构达到期望的目标转向角。
如图1、图2所示,步骤S11中,GPS安装位置为车辆前半部分,并且接近车辆铰接点位置;设定GPS安装位置为初始原点,设定初始原点坐标为(X0,Y0),初始航向角为HeadAng0;
所述GPS可直接安装在铰接点正上方,GPS能够实时检测出车辆的坐标(经纬度)和初始航向角(车头前进方向,0-360度),将经纬度转换成UTM坐标系的坐标;设定GPS安装位置为初始原点,设定初始原点坐标为(X0,Y0),初始航向角为HeadAng0。
步骤S12中,获取前车铰接角α和后车铰接角β均是通过转向传感器获取车辆的转向角度,所述车辆转向角度即为铰接点的铰接角。
如图3、图4所示,车辆直线行驶时,公共轴线与车辆几何中心线重合;在铰接车转向过程中,车辆公共轴线不变,车体前后部分车辆中心线与公共轴线形成的夹角即为铰接角,通过转向传感器获取车辆公共轴线与车辆前半部分中心线形成的前车铰接角α和车辆公共轴线与车辆后半部分中心线形成的后车铰接角β。
如图1、图2所示,步骤S13中,确定车辆GPS定位基准点:当车辆向前行驶时,把车辆GPS定位基准点平移到车头位置,作为主定位点;当车辆倒退行驶时,把车辆GPS定位基准点平移到车尾位置,作为主定位点;
计算GPS定位基准点处的基准点坐标、基准点航向角方法:
在车辆前进时,由于GPS位置安装在车辆前半部分,而车辆的前半部分为刚性车,故可使用车辆长度来修正平移,获取GPS定位基准点的基准点坐标及基准点航向角,设定前进时重新构建的GPS基准点坐标为(X1,Y1),基准点航向角为HeadAng1,车辆铰接角为α,车辆左转α为正,右转α为负;
车辆前进时,GPS定位基准点的基准点航向角为:
HeadAng1=HeadAng0+α(HeadAng0+α<360),
或者,HeadAng1=(HeadAng0+α)-360(HeadAng0+α>360)
车辆前进时,车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng1≤90时,
基准点坐标为X1=X0+Lf*sin(HeadAng1),Y1=Y0+Lf*cos(HeadAng1);
当90<HeadAng1≤180时,
基准点坐标为X1=X0+Lf*cos(HeadAng1-90),
Y1=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng1≤270时,
基准点坐标为X1=X0-Lf*sin(HeadAng1-180),
Y1=Y0-Lf*cos(HeadAng1-180);
当270<HeadAng1≤360时,
基准点坐标为X1=X0-Lf*cos(HeadAng1-270),
Y1=Y0+Lf*sin(HeadAng1-270);
在车辆倒退时,使用车辆长度来进行修正平移和铰接点的角度综合处理构建,获取GPS定位基准点的基准点坐标及基准点航向角,设定车辆倒退行驶时重新构建的GPS基准点坐标为(X2,Y2),基准点航向角为HeadAng2,车辆铰接角为β,车辆左转β为正,右转β为负;
车辆倒退,GPS定位基准点的基准点航向角为:
HeadAng2=HeadAng0+180-(α+β)(0<HeadAng0≤180),
HeadAng2=HeadAng0-180-(α+β)(180<HeadAng0≤360);车辆倒退,
车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng2≤90时,
基准点坐标为X2=X0+Lf*sin(HeadAng2),Y2=Y0+Lf*cos(HeadAng2);
当90<HeadAng2≤180时,
基准点坐标为X2=X0+Lf*cos(HeadAng2-90),
Y2=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng2≤270时,
基准点坐标为X2=X0-Lf*sin(HeadAng2-180),
Y2=Y0-Lf*cos(HeadAng2-180);
当270<HeadAng2≤360时,
基准点坐标为X2=X0-Lf*cos(HeadAng2-270),Y2=Y0+Lf*sin(HeadAng2-270)。
如图5、图6所示,步骤S22中,所述以GPS定位基准点为车辆坐标系的原点为:
设定车辆坐标系原点为(X0’,Y0’),基于车辆坐标系控制把车辆模型重构后的GPS定位基准点作为车辆坐标系原点,即车辆前进时的原点为(X1,Y1),则X0’=X1、Y0’=Y1;车辆后退时的原点为(X2,Y2),则X0’=X2、Y0’=Y2;所述确定目标点与车辆坐标系原点的象限方位及目标点度HeadAngr方法:
设定车辆的原点航向角为HeadAng0’,其中车辆前进时的原点航向角为HeadAng0’=HeadAng1;车辆后退时的原点航向角为HeadAng0’=HeadAng2;
当Xr-X0’>0,且Yr-Y0’>0时,目标点在车辆原点的第一象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’));
当Xr-X0’>0,且Yr-Y0’<0时,目标点在车辆原点的第二象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+90;
当Xr-X0’<0,且Yr-Y0’<0时,目标点在车辆原点的第三象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’))+180;
当Xr-X0’<0,且Yr-Y0’>0时,目标点在车辆原点的第四象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+270。
如图5、图6所示,步骤S23中,计算目标点与车辆原点坐标的直线距离S的公式:
如图5、图6所示,步骤S24中,计算目标点与原点的航向角HeadAngr’方法:
当0≤HeadAng0’≤90时,
目标点在第一、第二象限时,目标点与原点的航向角为HeadAngr’=HeadAngr,目标点在第四象限时,目标点与原点的航向角HeadAngr’=HeadAngr-360;
当90<HeadAng0’≤180时,
目标点在第一、第二、第三象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-90;
当180<HeadAng0’≤270时,
目标点在第二、第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-180;
当270<HeadAng0’≤360时,
目标点在第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-270,目标点在第一象限时,目标点与原点的航向角为HeadAngr’=HeadAngr+90。
在路径规划时,选取的目标点不会选取车辆正后方的目标点,从而出现在车辆追踪控制时出现车辆原地掉头的行驶现象,所以在坐标系转换时就只考虑目标点在原点的同象限及相邻象限的情况。
如图5、图6所示,步骤S25中,确定车辆坐标系下的目标点坐标(Xr’,Yr’)公式:
当0≤HeadAng0’≤90时,
HeadAng0’≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-HeadAngr’),
Yr’=S*sin(HeadAng0’-HeadAngr’),
HeadAng0’<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-HeadAng0’),
Yr’=S*sin(HeadAngr’-HeadAng0’);
当90<HeadAng0’≤180时,
HeadAng0’-90≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-90-HeadAngr’),
Yr’=S*sin(HeadAng0’-90-HeadAngr’);
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-90)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-90));
当180<HeadAng0’≤270时,
HeadAng0’-180≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-180-HeadAngr’),
Yr’=S*sin(HeadAng0’-180-HeadAngr’),
HeadAng0’-180<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-180)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-180));
当270<HeadAng0’≤360时,
HeadAng0’-270≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-270-HeadAngr’),
Yr’=S*sin(HeadAng0’-270-HeadAngr’),
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-270)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-270))。
如图5、图6所示,步骤S26中,根据车辆原点(X0’,Y0’)和车辆坐标系目标点坐标(Xr’,Yr’),计算车辆目标转向角方法:
车辆前进时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆前进向右转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆前进向左转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’));
车辆后退时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆倒退向右转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆倒退向左转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’))。
任何时间下都是基于车辆为车辆坐标系的原点,故车辆原点坐标(X0’,Y0’)为(0,0),同时目标点坐标也是基于车辆坐标系的转换而来(Xr’,Yr’)。
如图5、图6所示,步骤S3中,将目标转向角θ转换为方向盘角度ang公式为:
ang=θ*K,
K为转向系统的方向盘转角与车辆转角的比例系关系系数。
把步骤2中计算出来的目标转向角θ转换成方向盘角度ang,并将方向盘角度ang输入转向系统,转向系统控制器通过其转向闭环控制算法控制转向机构达到目标期望转向角ang,实车车辆转向控制。同时自动驾驶系统根据设计的目标车速给底盘控制器VCU,VCU控制发动机(或电机)、变速箱实现目标车速的控制,从而达到车辆按目标路径行驶的路径跟踪控制目的。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (9)
1.自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:具体步骤:
S1、构建车辆模型,其步骤如下:
S11、获取GPS安装位置的车辆经纬度、初始航向角HeadAng0,并将经纬度转换成UTM坐标系下GPS安装位置坐标(X0,Y0);
S12、获取车辆公共轴线与车辆前半部分中心线形成的前车铰接角α和车辆公共轴线与车辆后半部分中心线形成的后车铰接角β;
S13、根据车辆行驶方向对车辆模型进行重构,确定GPS定位基准点在车辆上的位置,并根据GPS安装位置坐标(X0,Y0)、初始航向角HeadAng0、铰接角α、铰接角β计算GPS定位基准点处的基准点坐标、基准点航向角;
S2、构建路径追踪模型,其步骤如下:
S21、输入路径规划中的目标路径点,实时获取车辆前方规划的目标路径点(Xr,Yr);
S22、以GPS定位基准点为车辆坐标系的原点(X0’,Y0’),确定目标点与车辆坐标系原点的象限方位及目标点角度HeadAngr;
S23、计算目标点与实车原点坐标的直线距离S;
S24、目标航向角转换,以车辆坐标系原点为参考点,计算目标点与原点的航向角HeadAngr’;
S25、确定车辆坐标系下的目标点坐标(Xr’,Yr’);
S26、根据车辆坐标系的原点(X0’,Y0’)和目标点坐标(Xr’,Yr’),计算车辆目标转向角;
S3、实现车辆控制,其具体内筒如下:
将目标转向角转换为方向盘角度,并将方向盘角度输入转向系统,转向系统控制车辆转向机构达到期望的目标转向角。
2.根据权利要求1所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S11中,GPS安装位置为车辆前半部分,并且接近车辆铰接点位置;设定GPS安装位置为初始原点,设定初始原点坐标为(X0,Y0),初始航向角为HeadAng0;
步骤S12中,获取前车铰接角α和后车铰接角β均是通过转向传感器获取车辆的转向角度,所述车辆转向角度即为铰接点的铰接角。
3.根据权利要求2所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S13中,确定车辆GPS定位基准点:当车辆向前行驶时,把车辆GPS定位基准点平移到车头位置,作为主定位点;当车辆倒退行驶时,把车辆GPS定位基准点平移到车尾位置,作为主定位点;
计算GPS定位基准点处的基准点坐标、基准点航向角方法:
在车辆前进时,使用车辆长度来修正平移,获取GPS定位基准点的基准点坐标及基准点航向角,设定前进时重新构建的GPS基准点坐标为(X1,Y1),基准点航向角为HeadAng1,车辆铰接角为α,车辆左转α为正,右转α为负;
车辆前进时,GPS定位基准点的基准点航向角为:
HeadAng1=HeadAng0+α(HeadAng0+α<360),
或者,HeadAng1=(HeadAng0+α)-360(HeadAng0+α>360)
车辆前进时,车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng1≤90时,
基准点坐标为X1=X0+Lf*sin(HeadAng1),Y1=Y0+Lf*cos(HeadAng1);
当90<HeadAng1≤180时,
基准点坐标为X1=X0+Lf*cos(HeadAng1-90),
Y1=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng1≤270时,
基准点坐标为X1=X0-Lf*sin(HeadAng1-180),
Y1=Y0-Lf*cos(HeadAng1-180);
当270<HeadAng1≤360时,
基准点坐标为X1=X0-Lf*cos(HeadAng1-270),
Y1=Y0+Lf*sin(HeadAng1-270);
在车辆倒退时,使用车辆长度来进行修正平移和铰接点的角度综合处理构建,获取GPS定位基准点的基准点坐标及基准点航向角,设定车辆倒退行驶时重新构建的GPS基准点坐标为(X2,Y2),基准点航向角为HeadAng2,车辆铰接角为β,车辆左转β为正,右转β为负;
车辆倒退,GPS定位基准点的基准点航向角为:
HeadAng2=HeadAng0+180-(α+β)(0<HeadAng0≤180),
HeadAng2=HeadAng0-180-(α+β)(180<HeadAng0≤360);
车辆倒退,车辆GPS定位基准点的基准点坐标为:
当0≤HeadAng2≤90时,
基准点坐标为X2=X0+Lf*sin(HeadAng2),Y2=Y0+Lf*cos(HeadAng2);
当90<HeadAng2≤180时,
基准点坐标为X2=X0+Lf*cos(HeadAng2-90),
Y2=Y0-Lf*sin(HeadAng1-90);
当180<HeadAng2≤270时,
基准点坐标为X2=X0-Lf*sin(HeadAng2-180),
Y2=Y0-Lf*cos(HeadAng2-180);
当270<HeadAng2≤360时,
基准点坐标为X2=X0-Lf*cos(HeadAng2-270),
Y2=Y0+Lf*sin(HeadAng2-270)。
4.根据权利要求3所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S22中,以GPS定位基准点为车辆坐标系的原点为:
设定车辆坐标系原点为(X0’,Y0’),基于车辆坐标系控制把车辆模型重构后的GPS定位基准点作为车辆坐标系原点,即车辆前进时的原点为(X1,Y1),则X0’=X1、Y0’=Y1;车辆后退时的原点为(X2,Y2),则X0’=X2、Y0’=Y2;
确定目标点与车辆坐标系原点的象限方位及目标点度HeadAngr方法:
设定车辆的原点航向角为HeadAng0’,其中车辆前进时的原点航向角为HeadAng0’=HeadAng1;车辆后退时的原点航向角为HeadAng0’=HeadAng2;
当Xr-X0’>0,且Yr-Y0’>0时,目标点在车辆原点的第一象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’));
当Xr-X0’>0,且Yr-Y0’<0时,目标点在车辆原点的第二象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+90;
当Xr-X0’<0,且Yr-Y0’<0时,目标点在车辆原点的第三象限,则目标点度HeadAngr=atan(abs(Xr-X0’)/abs(Yr-Y0’))+180;
当Xr-X0’<0,且Yr-Y0’>0时,目标点在车辆原点的第四象限,则目标点度HeadAngr=atan(abs(Yr-Y0’)/abs(Xr-X0’))+270。
6.根据权利要求5所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S24中,计算目标点与原点的航向角HeadAngr’方法:
当0≤HeadAng0’≤90时,
目标点在第一、第二象限时,目标点与原点的航向角为HeadAngr’=HeadAngr,目标点在第四象限时,目标点与原点的航向角HeadAngr’=HeadAngr-360;
当90<HeadAng0’≤180时,
目标点在第一、第二、第三象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-90;
当180<HeadAng0’≤270时,
目标点在第二、第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-180;
当270<HeadAng0’≤360时,
目标点在第三、第四象限时,目标点与原点的航向角为HeadAngr’=HeadAngr-270,目标点在第一象限时,目标点与原点的航向角为HeadAngr’=HeadAngr+90。
7.根据权利要求6所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S25中,确定车辆坐标系下的目标点坐标(Xr’,Yr’)公式:
当0≤HeadAng0’≤90时,
HeadAng0’≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-HeadAngr’),
Yr’=S*sin(HeadAng0’-HeadAngr’),
HeadAng0’<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-HeadAng0’),
Yr’=S*sin(HeadAngr’-HeadAng0’);
当90<HeadAng0’≤180时,
HeadAng0’-90≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-90-HeadAngr’),
Yr’=S*sin(HeadAng0’-90-HeadAngr’);
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-90)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-90));
当180<HeadAng0’≤270时,
HeadAng0’-180≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-180-HeadAngr’),
Yr’=S*sin(HeadAng0’-180-HeadAngr’),
HeadAng0’-180<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-180)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-180));
当270<HeadAng0’≤360时,
HeadAng0’-270≥HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAng0’-270-HeadAngr’),
Yr’=S*sin(HeadAng0’-270-HeadAngr’),
HeadAng0’-90<HeadAngr’,
目标点坐标为Xr’=S*cos(HeadAngr’-(HeadAng0’-270)),
Yr’=S*sin(HeadAngr’-(HeadAng0’-270))。
8.根据权利要求7所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S25中,根据车辆原点(X0’,Y0’)和车辆坐标系目标点坐标(Xr’,Yr’),计算车辆目标转向角方法:
车辆前进时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆前进向右转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆前进向左转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’));
车辆后退时:
当Yr’-Y0’≥0,说明目标点在车辆的右侧,故车辆倒退向右转向行驶,转向角度为θ=-arctan(abs(Yr’-Y0’)/abs(Xr’-X0’)),
当Yr’-Y0’<0,说明目标点在车辆的左侧,故车辆倒退向左转向行驶,转向角度为θ=arctan(abs(Yr’-Y0’)/abs(Xr’-X0’))。
9.根据权利要求8所述的自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法,其特征在于:步骤S3中,将目标转向角θ转换为方向盘角度ang公式为:ang=θ*K,
K为转向系统的方向盘转角与车辆转角的比例关系系数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111386656.8A CN114115260A (zh) | 2021-11-22 | 2021-11-22 | 自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111386656.8A CN114115260A (zh) | 2021-11-22 | 2021-11-22 | 自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114115260A true CN114115260A (zh) | 2022-03-01 |
Family
ID=80439508
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111386656.8A Pending CN114115260A (zh) | 2021-11-22 | 2021-11-22 | 自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114115260A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114715273A (zh) * | 2022-04-27 | 2022-07-08 | 西安优迈智慧矿山研究院有限公司 | 基于双imu传感器的铰接式矿卡转向角度测量方法、系统及装置 |
Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1486259A (zh) * | 2000-12-01 | 2004-03-31 | �����ʩ���عɷݹ�˾ | 铰接式车辆的车轮循迹机构 |
CN103786800A (zh) * | 2014-01-20 | 2014-05-14 | 吉林大学 | 一种半挂式公路客车 |
CN105929433A (zh) * | 2016-06-20 | 2016-09-07 | 株洲太昌电子信息技术股份有限公司 | 一种轨道车精确定位方法和系统 |
CN106096599A (zh) * | 2016-04-28 | 2016-11-09 | 浙江工业大学 | 一种基于涂色块的内部集卡定位方法 |
CN107346134A (zh) * | 2017-08-29 | 2017-11-14 | 北京矿冶研究总院 | 一种地下矿用铰接式车辆无人驾驶控制方法及装置 |
CN208076726U (zh) * | 2018-01-09 | 2018-11-09 | 合肥华科信息科技有限公司 | 一种驾考挂车轮廓的精确gps定位装置 |
CN109348401A (zh) * | 2018-09-21 | 2019-02-15 | 交通运输部公路科学研究所 | 基于无线定位技术的汽车列车行驶姿态监测系统及方法 |
CN110006419A (zh) * | 2018-01-04 | 2019-07-12 | 郑州宇通客车股份有限公司 | 一种基于预瞄的车辆轨迹跟踪点确定方法 |
CN110103725A (zh) * | 2019-05-24 | 2019-08-09 | 河北优控新能源科技有限公司 | 基于轮毂电机转速信号的分布式驱动汽车稳定控制方法 |
CN111361502A (zh) * | 2020-03-23 | 2020-07-03 | 长沙立中汽车设计开发股份有限公司 | 一种用于铰接工程车辆变角度全景环视系统的实现方法 |
CN111538331A (zh) * | 2020-04-24 | 2020-08-14 | 北京科技大学 | 一种地下无人铰接车的反应式导航方法 |
CN113525509A (zh) * | 2020-04-14 | 2021-10-22 | 郑州宇通客车股份有限公司 | 一种铰接车辆转向控制方法及装置 |
CN113661100A (zh) * | 2019-04-09 | 2021-11-16 | 沃尔沃卡车集团 | 用于估算包括一个以上铰接角的车辆组合的挂车的轴距长度的方法 |
-
2021
- 2021-11-22 CN CN202111386656.8A patent/CN114115260A/zh active Pending
Patent Citations (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1486259A (zh) * | 2000-12-01 | 2004-03-31 | �����ʩ���عɷݹ�˾ | 铰接式车辆的车轮循迹机构 |
CN103786800A (zh) * | 2014-01-20 | 2014-05-14 | 吉林大学 | 一种半挂式公路客车 |
CN106096599A (zh) * | 2016-04-28 | 2016-11-09 | 浙江工业大学 | 一种基于涂色块的内部集卡定位方法 |
CN105929433A (zh) * | 2016-06-20 | 2016-09-07 | 株洲太昌电子信息技术股份有限公司 | 一种轨道车精确定位方法和系统 |
CN107346134A (zh) * | 2017-08-29 | 2017-11-14 | 北京矿冶研究总院 | 一种地下矿用铰接式车辆无人驾驶控制方法及装置 |
CN110006419A (zh) * | 2018-01-04 | 2019-07-12 | 郑州宇通客车股份有限公司 | 一种基于预瞄的车辆轨迹跟踪点确定方法 |
CN208076726U (zh) * | 2018-01-09 | 2018-11-09 | 合肥华科信息科技有限公司 | 一种驾考挂车轮廓的精确gps定位装置 |
CN109348401A (zh) * | 2018-09-21 | 2019-02-15 | 交通运输部公路科学研究所 | 基于无线定位技术的汽车列车行驶姿态监测系统及方法 |
CN113661100A (zh) * | 2019-04-09 | 2021-11-16 | 沃尔沃卡车集团 | 用于估算包括一个以上铰接角的车辆组合的挂车的轴距长度的方法 |
CN110103725A (zh) * | 2019-05-24 | 2019-08-09 | 河北优控新能源科技有限公司 | 基于轮毂电机转速信号的分布式驱动汽车稳定控制方法 |
CN111361502A (zh) * | 2020-03-23 | 2020-07-03 | 长沙立中汽车设计开发股份有限公司 | 一种用于铰接工程车辆变角度全景环视系统的实现方法 |
CN113525509A (zh) * | 2020-04-14 | 2021-10-22 | 郑州宇通客车股份有限公司 | 一种铰接车辆转向控制方法及装置 |
CN111538331A (zh) * | 2020-04-24 | 2020-08-14 | 北京科技大学 | 一种地下无人铰接车的反应式导航方法 |
Non-Patent Citations (2)
Title |
---|
卢慧娟: "基于DYC控制全轮驱动铰接车行驶稳定性分析", 机械设计与制造, no. 9, 30 September 2016 (2016-09-30), pages 44 - 49 * |
廖明: "R&S测试车后处理软件ROSEVAL的使用经验", 电信技雍, no. 11, 31 December 1999 (1999-12-31), pages 28 - 30 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114715273A (zh) * | 2022-04-27 | 2022-07-08 | 西安优迈智慧矿山研究院有限公司 | 基于双imu传感器的铰接式矿卡转向角度测量方法、系统及装置 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110949374B (zh) | 基于两段二阶贝塞尔曲线的自动平行泊车路径规划方法 | |
US10795369B2 (en) | System and method for controlling a vehicle | |
CN106886215B (zh) | 一种基于多轴无轨电车循迹跟踪系统及具有其的电车 | |
CN107826164B (zh) | 一种基于电助力的多轮转向系统及控制方法 | |
CN110244731B (zh) | 三节编组虚拟轨道列车主动循迹控制方法 | |
CN109270933A (zh) | 基于圆锥曲线的无人驾驶避障方法、装置、设备及介质 | |
CN105197010A (zh) | 辅助泊车系统以及辅助泊车控制方法 | |
CN205440522U (zh) | 一种自动驾驶转向控制装置 | |
CN110244718B (zh) | 一种可自动避障的巡视智能小车 | |
CN114115260A (zh) | 自动驾驶铰接车的车辆模型搭建及路径跟踪控制方法 | |
CN111487976B (zh) | 一种倒车轨迹跟踪方法 | |
CN111596671A (zh) | 一种无人智能清扫车轨迹跟踪控制方法及系统 | |
CN111596657A (zh) | 一种agv及其轨道运动方法 | |
CN111609866B (zh) | 基于差分gps的园区车辆智能驾驶路径拟合跟踪控制方法 | |
CN114872792B (zh) | 一种车辆转向控制方法、装置、电子设备和存储介质 | |
CN111252078A (zh) | 用于无铰接角度传感器的半挂汽车列车倒车轨迹预测方法 | |
CN107010107B (zh) | 一种大客车液压主动转向系统及控制方法 | |
CN106152994A (zh) | 车轮转角测量装置、多轴转向车辆及车轮转角测量方法 | |
Liu et al. | Kinematics analysis and motion control of a mobile robot driven by three tracked vehicles | |
CN103970149B (zh) | 一种二维矢量调节机构的转角控制方法 | |
KR101093769B1 (ko) | 후진 선회시의 굴절 차량용 전 차륜 조향 제어 방법 | |
CN113914406B (zh) | 一种电动装载机路径跟踪系统及控制方法 | |
CN112606902B (zh) | 一种地铁轮胎式铺轨车的转向系统和转向方法 | |
Wei et al. | The impact of attitude feedback on the control performance and energy consumption in the path-following of unmanned rollers | |
CN117272693B (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 |