CN113741450B - 一种车辆自动驾驶横向自适应控制方法 - Google Patents
一种车辆自动驾驶横向自适应控制方法 Download PDFInfo
- Publication number
- CN113741450B CN113741450B CN202111010194.XA CN202111010194A CN113741450B CN 113741450 B CN113741450 B CN 113741450B CN 202111010194 A CN202111010194 A CN 202111010194A CN 113741450 B CN113741450 B CN 113741450B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- matrix
- current
- error
- control input
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 239000011159 matrix material Substances 0.000 claims abstract description 100
- 230000014509 gene expression Effects 0.000 claims description 27
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 238000005070 sampling Methods 0.000 claims description 6
- 238000010586 diagram Methods 0.000 description 3
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
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
- 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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- 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/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to 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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种车辆自动驾驶横向自适应控制方法,包括如下步骤:(1)根据Frenet坐标系下的二自由度车辆动力学矩阵方程获取系数矩阵A和B,对系数矩阵A和B进行离散化;(2)根据离散化的系数矩阵和计算反馈矩阵;(3)计算车辆当前位置与匹配点之间的误差矩阵;(4)根据反馈矩阵和轨迹曲率,计算前馈控制输入;(5)根据反馈控制输入和前馈控制输入得到总控制输入,将总控制输入传递给控制器进行车辆的自动控制。本发明利用控制权重矩阵R设置参数自调整策略后,自动驾驶车辆根据不同的转弯半径工况,选择不同的控制矩阵R,从而使得LQR算法能够自适应输出不同的转弯角度,在满足跟踪轨迹精度的基础上保证了车辆转向舒适性的要求。
Description
技术领域
本发明涉及自动驾驶横向运动控制领域,特别涉及一种车辆自动驾驶横向自适应控制方法。
背景技术
车辆自动驾驶控制***根据上层决策、规划***发出的规划目标路径信息,输出相应的控制参数,使车辆按照规划的目标路径行驶,控制***的好坏不仅决定了车辆跟踪目标路径的精度,还会影响车辆的舒适性。
当前自动驾驶控制分为横向控制与纵向控制,现有的横线控制技术包括纯跟踪算法、Stanley算法、LQR算法、MPC算法等,其中LQR算法应用最为广泛,但现有技术无法实现LQR算法的自适应参数调整控制。
专利申请CN110568758A提出了一种自动驾驶汽车的参数自适应横向运动LQR控制方法,在车辆位置与规划路径的距离偏差与航向偏差不同时,选择不同的状态权重矩阵Q增益值;但该专利申请对Q矩阵中的横向距离偏差、横摆角偏差项对应的矩阵参数进行设计,忽略了横向速度偏差、横摆角速度偏差对车辆横向控制的影响,与实际应用有一定差异,且该专利申请并没有对控制权重矩阵R设置参数自调整策略,使得自动驾驶车辆在不同工况行驶过程中,因为转向盘转角过大影响了车辆舒适性。
发明内容
发明目的:针对以上问题,本发明目的是提供一种车辆自动驾驶横向自适应控制方法。
技术方案:本发明的一种车辆自动驾驶横向自适应控制方法,包括如下步骤:
(1)根据Frenet坐标系下的二自由度车辆动力学矩阵方程获取系数矩阵A和B,对系数矩阵A和B进行离散化;
(2)输入状态权重矩阵Q和控制权重矩阵R,根据离散化的系数矩阵和/>计算反馈矩阵K;
(3)根据当前车辆状态矩阵和规划轨迹矩阵,计算车辆当前位置与匹配点之间的误差矩阵err,所述匹配点为集中规划离散轨迹点中距离当前车辆位置距离最近的规划点;
(4)根据反馈矩阵K和轨迹曲率,计算前馈控制输入δf;
(5)根据反馈控制输入和前馈控制输入得到总控制输入,将总控制输入传递给控制器进行车辆的自动控制;
所述步骤(2)中的控制权重矩阵R随车辆转弯半径进行调整,表达式为:
式中r为车辆转弯半径,kR为控制增益,Rmax为控制增益的最大值。
进一步,所述步骤(1)二自由度车辆动力学矩阵方程为:
其中表示误差矩阵的导数,err表示误差矩阵,u为控制量,表示前轮转角;
获取车辆当前行驶数据,上式写成:
其中Cαf为车辆前轮侧偏刚度、Cαr为车辆后轮侧偏刚度、a为车辆质心到前轴的距离、b为车辆质心到后轴的距离、Iz为车辆绕Z轴的转动惯量、m为车辆的质量、vx为车辆在纵向的车速、ed为横向位置误差、为横向速度误差、/>为横摆角误差、/>为横摆角速度误差;
得到系数矩阵A的表达式为:
系数矩阵B的表达式为:
系数矩阵A和B方程为连续方程,将两个矩阵进行离散化处理,分别为:
其中E为单位矩阵,dt为采样时间;
则Frenet坐标系下的二自由度车辆动力学矩阵方程离散化为:
其中k表示当前离散矩阵方程的采样时刻。
进一步,所述步骤(2)状态权重矩阵Q为:
其中q1至q4分别表示横向位置误差ed、横向速度误差横摆角误差/>横摆角速度误差/>的权重值;
根据黎卡提方程计算矩阵P,表达式为:
则计算得到反馈矩阵K的表达式为:
进一步,步骤(3)中根据车辆自动驾驶定位模块与底层信息可知当前车辆状态矩阵为其中x为当前车辆纵向位移,y为当前车辆横向位移,vx为当前车辆纵向速度,vy为当前车辆横向速度,/>为当前车辆横摆角,/>为当前车辆横摆角速度;
由车辆自动驾驶规划模块提供规划轨迹矩阵为[xr,yr,θr,kr]T,其中xr为当前规划的车辆纵向位移,yr为当前规划的车辆横向位移,θr为当前规划的车辆横摆角,kr为当前规划的轨迹曲率;
计算车辆当前位置与集中规划离散轨迹点每个点的距离,得到距离当前车辆位置距离最近的规划点,将该规划点称为匹配点,下标记为dmin,则匹配点的规划信息矩阵为[xd min,yd min,θd min,kd min]T,当前车辆位置的误差矩阵各项表达式为:
ed=[-sin(θd min),cos(θd min)][x-xd min,y-yd min]T
其中kd min=kr,θd min=θr。
进一步,将4×4反馈矩阵K的第3行记为K(3),令K3=K(3),所述步骤(4)中的前馈控制输入δf表达式为:
进一步,所述步骤(5)反馈控制输入uk包括反馈矩阵和误差矩阵,表达式为:
uk=-Kerr
所述总控制输入δ表达式为:δ=uk+δf=-Kerr+δf。
有益效果:本发明与现有技术相比,其显著优点是:本发明利用控制权重矩阵R设置参数自调整策略后,自动驾驶车辆根据不同的转弯半径工况,选择不同的控制矩阵R,从而使得LQR算法能够自适应输出不同的转弯角度,在满足跟踪轨迹精度的基础上保证了车辆转向舒适性的要求。
附图说明
图1为本发明流程图;
图2为二自由度车辆动力学模型示意图;
图3为坐标系转换示意图;
图4为全状态反馈控制示意图。
具体实施方式
如图1所示,本实施例所述的一种车辆自动驾驶横向自适应控制方法,包括如下步骤:
(1)根据Frenet坐标系下的二自由度车辆动力学矩阵方程获取系数矩阵A和B,对系数矩阵A和B进行离散化。
如图2所示,二自由度车辆动力学矩阵方程为:
其中表示误差矩阵的导数,err表示误差矩阵,u为控制量,表示前轮转角;
获取车辆当前行驶数据,上式写成:
其中Cαf为车辆前轮侧偏刚度、Cαr为车辆后轮侧偏刚度、a为车辆质心到前轴的距离、b为车辆质心到后轴的距离、Iz为车辆绕Z轴的转动惯量、m为车辆的质量、vx为车辆在纵向的车速、ed为横向位置误差、为横向速度误差、/>为横摆角误差、/>为横摆角速度误差;
得到系数矩阵A的表达式为:
系数矩阵B的表达式为:
系数矩阵A和B方程为连续方程,将两个矩阵进行离散化处理,分别为:
其中E为单位矩阵,dt为采样时间;
则Frenet坐标系下的二自由度车辆动力学矩阵方程离散化为:
其中k表示当前离散矩阵方程的采样时刻。
(2)输入状态权重矩阵Q和控制权重矩阵R,根据离散化的系数矩阵和/>计算反馈矩阵K;
控制权重矩阵R随车辆转弯半径进行调整,表达式为:
式中r为车辆转弯半径,kR为控制增益,Rmax为控制增益的最大值,当车辆处于不同的转弯半径时,控制权重矩阵的取值不同。
状态权重矩阵Q为:
其中q1至q4分别表示横向位置误差ed、横向速度误差横摆角误差/>横摆角速度误差/>的权重值;
根据黎卡提方程计算矩阵P,表达式为:
则计算得到反馈矩阵K的表达式为:
(3)根据当前车辆状态矩阵和规划轨迹矩阵,计算车辆当前位置与匹配点之间的误差矩阵err,其中匹配点为集中规划离散轨迹点中距离当前车辆位置距离最近的规划点;
根据车辆自动驾驶定位模块与底层信息可知当前车辆状态矩阵为其中x为当前车辆纵向位移,y为当前车辆横向位移,vx为当前车辆纵向速度,vy为当前车辆横向速度,/>为当前车辆横摆角,/>为当前车辆横摆角速度;
如图3所示,由车辆自动驾驶规划模块提供规划轨迹矩阵为[xr,yr,θr,kr]T,其中xr为当前规划的车辆纵向位移,yr为当前规划的车辆横向位移,θr为当前规划的车辆横摆角,kr为当前规划的轨迹曲率;
计算车辆当前位置与集中规划离散轨迹点每个点的距离,得到距离当前车辆位置距离最近的规划点,将该规划点称为匹配点,下标记为dmin,则匹配点的规划信息矩阵为[xd min,yd min,θd min,kd min]T,当前车辆位置的误差矩阵各项表达式为:
ed=[-sin(θd min),cos(θd min)][x-xd min,y-yd min]T
其中kd min=kr,θd min=θr,表示法向向量。
(4)根据反馈矩阵K和轨迹曲率,计算前馈控制输入δf;
将4×4反馈矩阵K的第3行记为K(3),令K3=K(3),则前馈控制输入δf表达式为:
(5)根据反馈控制输入和前馈控制输入得到总控制输入,将总控制输入传递给控制器进行车辆的自动控制,其中图4为全状态反馈控制示意图。
反馈控制输入uk包括反馈矩阵和误差矩阵,表达式为:
uk=-Kerr
总控制输入δ表达式为:δ=uk+δf=-Kerr+δf。
Claims (2)
1.一种车辆自动驾驶横向自适应控制方法,其特征在于,包括如下步骤:
(1)根据Frenet坐标系下的二自由度车辆动力学矩阵方程获取系数矩阵A和B,对系数矩阵A和B进行离散化;
(2)输入状态权重矩阵Q和控制权重矩阵R,根据离散化的系数矩阵A和B计算反馈矩阵K;
(3)根据当前车辆状态矩阵和规划轨迹矩阵,计算车辆当前位置与匹配点之间的误差矩阵,所述匹配点为集中规划离散轨迹点中距离当前车辆位置距离最近的规划点;
(4)根据反馈矩阵K和轨迹曲率,计算前馈控制输入;
(5)根据反馈控制输入和前馈控制输入得到总控制输入,将总控制输入传递给控制器进行车辆的自动控制;
所述步骤(1)二自由度车辆动力学矩阵方程为:
其中表示误差矩阵的导数,err表示误差矩阵,u为控制量,表示前轮转角;
获取车辆当前行驶数据,上式写成:
其中Cαf为车辆前轮侧偏刚度、Cαr为车辆后轮侧偏刚度、a为车辆质心到前轴的距离、b为车辆质心到后轴的距离、Iz为车辆绕Z轴的转动惯量、m为车辆的质量、vx为车辆在纵向的车速、ed为横向位置误差、为横向速度误差、/>为横摆角误差、/>为横摆角速度误差,δf为前馈控制输入;
得到系数矩阵A的表达式为:
系数矩阵B的表达式为:
系数矩阵A和B方程为连续方程,将两个矩阵进行离散化处理,分别为:
其中E为单位矩阵,dt为采样时间;
则Frenet坐标系下的二自由度车辆动力学矩阵方程离散化为:
其中k表示当前离散矩阵方程的采样时刻;
所述步骤(2)中的控制权重矩阵R随车辆转弯半径进行调整,表达式为:
式中r为车辆转弯半径,kR为控制增益,Rmax为控制增益的最大值;
所述步骤(2)状态权重矩阵Q为:
其中q1至q4分别表示横向位置误差ed、横向速度误差横摆角误差/>横摆角速度误差/>的权重值;
根据黎卡提方程计算矩阵P,表达式为:
则计算得到反馈矩阵K的表达式为:
将4×4反馈矩阵K的第3行记为K(3),令K3=K(3),所述步骤(4)中的前馈控制输入δf表达式为:
所述步骤(5)反馈控制输入uk包括反馈矩阵和误差矩阵,表达式为:
uk=-Kerr
所述总控制输入δ表达式为:δ=uk+δf=-Kerr+δf。
2.根据权利要求1所述的横向自适应控制方法,其特征在于,步骤(3)中根据车辆自动驾驶定位模块与底层信息得知当前车辆状态矩阵为其中x为当前车辆纵向位移,y为当前车辆横向位移,vx为当前车辆纵向速度,vy为当前车辆横向速度,/>为当前车辆横摆角,/>为当前车辆横摆角速度;
由车辆自动驾驶规划模块提供规划轨迹矩阵为[xr,yr,θr,kr]T,其中xr为当前规划的车辆纵向位移,yr为当前规划的车辆横向位移,θr为当前规划的车辆横摆角,kr为当前规划的轨迹曲率;
计算车辆当前位置与集中规划离散轨迹点每个点的距离,得到距离当前车辆位置距离最近的规划点,将该规划点称为匹配点,下标记为dmin,则匹配点的规划信息矩阵为[xdmin,ydmin,θdmin,kdmin]T,当前车辆位置的误差矩阵各项表达式为:
ed=[-sin(θdmin),cos(θdmin)][x-xdmin,y-ydmin]T
其中kdmin=kr,θdmin=θr。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111010194.XA CN113741450B (zh) | 2021-08-31 | 2021-08-31 | 一种车辆自动驾驶横向自适应控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111010194.XA CN113741450B (zh) | 2021-08-31 | 2021-08-31 | 一种车辆自动驾驶横向自适应控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113741450A CN113741450A (zh) | 2021-12-03 |
CN113741450B true CN113741450B (zh) | 2023-11-21 |
Family
ID=78734104
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111010194.XA Active CN113741450B (zh) | 2021-08-31 | 2021-08-31 | 一种车辆自动驾驶横向自适应控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113741450B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114368380B (zh) * | 2022-01-06 | 2023-02-17 | 上海宏景智驾信息科技有限公司 | 一种适应不同载重的自动驾驶半挂卡车横向控制方法 |
CN115071732A (zh) * | 2022-07-14 | 2022-09-20 | 东风商用车有限公司 | 一种基于lqr的smc商用车智能驾驶横向控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108417069A (zh) * | 2018-04-20 | 2018-08-17 | 东北大学 | 一种车辆速度及路径规划***及方法 |
CN110568758A (zh) * | 2019-09-12 | 2019-12-13 | 中汽研(天津)汽车工程研究院有限公司 | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 |
CN111638712A (zh) * | 2020-05-26 | 2020-09-08 | 三一专用汽车有限责任公司 | 自动驾驶车辆横向运动控制方法、装置和自动驾驶车辆 |
CN111845774A (zh) * | 2020-07-20 | 2020-10-30 | 上海大学 | 一种基于横纵向协调的自动驾驶汽车动态轨迹规划及跟踪方法 |
WO2021073079A1 (zh) * | 2019-10-17 | 2021-04-22 | 南京航空航天大学 | 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法 |
CN113110500A (zh) * | 2021-05-10 | 2021-07-13 | 的卢技术有限公司 | 一种自动驾驶汽车低速自动泊车横向控制方法 |
CN113120001A (zh) * | 2021-05-11 | 2021-07-16 | 雄狮汽车科技(南京)有限公司 | 自动驾驶车辆的横向控制方法、装置及车辆 |
CN113183957A (zh) * | 2021-05-24 | 2021-07-30 | 前海七剑科技(深圳)有限公司 | 车辆控制方法、装置、设备及自动驾驶车辆 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110395120A (zh) * | 2019-08-14 | 2019-11-01 | 厦门金龙联合汽车工业有限公司 | 一种四轮分布式驱动客车的横摆运动控制方法 |
-
2021
- 2021-08-31 CN CN202111010194.XA patent/CN113741450B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108417069A (zh) * | 2018-04-20 | 2018-08-17 | 东北大学 | 一种车辆速度及路径规划***及方法 |
CN110568758A (zh) * | 2019-09-12 | 2019-12-13 | 中汽研(天津)汽车工程研究院有限公司 | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 |
WO2021073079A1 (zh) * | 2019-10-17 | 2021-04-22 | 南京航空航天大学 | 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法 |
CN111638712A (zh) * | 2020-05-26 | 2020-09-08 | 三一专用汽车有限责任公司 | 自动驾驶车辆横向运动控制方法、装置和自动驾驶车辆 |
CN111845774A (zh) * | 2020-07-20 | 2020-10-30 | 上海大学 | 一种基于横纵向协调的自动驾驶汽车动态轨迹规划及跟踪方法 |
CN113110500A (zh) * | 2021-05-10 | 2021-07-13 | 的卢技术有限公司 | 一种自动驾驶汽车低速自动泊车横向控制方法 |
CN113120001A (zh) * | 2021-05-11 | 2021-07-16 | 雄狮汽车科技(南京)有限公司 | 自动驾驶车辆的横向控制方法、装置及车辆 |
CN113183957A (zh) * | 2021-05-24 | 2021-07-30 | 前海七剑科技(深圳)有限公司 | 车辆控制方法、装置、设备及自动驾驶车辆 |
Non-Patent Citations (1)
Title |
---|
基于MPC的自动驾驶车辆横向路径跟踪控制;陈威;廖文浩;刘明春;;南昌大学学报(工科版)(第03期);78-87 * |
Also Published As
Publication number | Publication date |
---|---|
CN113741450A (zh) | 2021-12-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111638712B (zh) | 自动驾驶车辆横向运动控制方法、装置和自动驾驶车辆 | |
CN111610780B (zh) | 一种自动驾驶车路径跟踪控制方法及其装置 | |
CN109144076B (zh) | 一种多车辆横纵向耦合协同控制***及控制方法 | |
CN113741450B (zh) | 一种车辆自动驾驶横向自适应控制方法 | |
CN110568758B (zh) | 一种自动驾驶汽车的参数自适应横向运动lqr控制方法 | |
CN110588633B (zh) | 一种智能汽车极限工况下路径跟踪与稳定控制方法 | |
CN112519882B (zh) | 一种车辆参考轨迹跟踪方法及*** | |
CN113608530B (zh) | 一种带有pid转角补偿的参数自整定lqr路径跟踪方法 | |
CN113753080B (zh) | 一种自动驾驶汽车横向运动自适应参数控制方法 | |
CN112622895B (zh) | 一种应用于自动驾驶的轨迹控制的预估控制方法 | |
CN110262229B (zh) | 基于mpc的车辆自适应路径追踪方法 | |
CN111679575B (zh) | 一种基于鲁棒模型预测控制的智能汽车轨迹跟踪控制器及其构造方法 | |
CN112109732A (zh) | 一种智能驾驶自适应曲线预瞄方法 | |
CN113031443A (zh) | 一种带有主动安全和自适应预瞄的车辆横向运动控制方法 | |
CN113183957A (zh) | 车辆控制方法、装置、设备及自动驾驶车辆 | |
CN110008600A (zh) | 车辆稳定性控制器性能保守性的设计方法 | |
CN114368381B (zh) | 一种基于横摆角速度预估的统一时序卡车横向控制方法 | |
CN114625002B (zh) | 一种基于模型预测控制的车辆横纵向集成控制方法 | |
CN114407880B (zh) | 一种无人驾驶紧急避障路径跟踪方法 | |
CN117518779A (zh) | 一种参数自适应的智能巡逻车高精度轨迹跟踪控制方法 | |
CN116691668A (zh) | 一种大型智能车辆的横向控制方法 | |
CN113311698B (zh) | 车道保持控制方法、控制装置和车辆 | |
CN115214715A (zh) | 车辆自动驾驶的横向控制方法和控制装置、车辆 | |
CN112558620B (zh) | 一种欠驱动自主水下航行器的航向修正路径跟踪方法 | |
CN115167135A (zh) | 反馈与模型前馈串级的无人驾驶车辆自趋优位姿控制*** |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |