CN110871801B - 一种基于激光雷达车速估计的车辆启动控制方法 - Google Patents
一种基于激光雷达车速估计的车辆启动控制方法 Download PDFInfo
- Publication number
- CN110871801B CN110871801B CN202010061746.9A CN202010061746A CN110871801B CN 110871801 B CN110871801 B CN 110871801B CN 202010061746 A CN202010061746 A CN 202010061746A CN 110871801 B CN110871801 B CN 110871801B
- Authority
- CN
- China
- Prior art keywords
- vehicle
- data
- laser radar
- wheel
- torque
- 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 31
- 230000001133 acceleration Effects 0.000 claims abstract description 14
- 238000004422 calculation algorithm Methods 0.000 claims abstract description 11
- 238000001914 filtration Methods 0.000 claims abstract description 4
- 230000004927 fusion Effects 0.000 claims abstract description 4
- 238000005259 measurement Methods 0.000 claims abstract description 4
- 238000005457 optimization Methods 0.000 claims description 12
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000008569 process Effects 0.000 claims description 8
- 230000009466 transformation Effects 0.000 claims description 8
- 238000011426 transformation method Methods 0.000 claims description 7
- 230000008859 change Effects 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000001131 transforming effect Effects 0.000 claims description 3
- 239000013068 control sample Substances 0.000 claims 1
- 230000000694 effects Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000007792 addition Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
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
-
- 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
- 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/408—Radar; Laser, e.g. lidar
Landscapes
- Engineering & Computer Science (AREA)
- Automation & Control Theory (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- Mathematical Physics (AREA)
- Control Of Vehicle Engines Or Engines For Specific Uses (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本发明公开了一种基于激光雷达车速估计的车辆启动控制方法,特点是步骤如下:(1)首先通过车辆的轮式编码器获得车辆的速度数据,通过车载IMU惯性测量单元获得车辆的加速度数据和车辆的横摆角速度数据;(2)激光雷达里程计模块通过标准ICP算法获得激光雷达相对于车辆启动时刻的位姿数据;(3)车辆质心相对于车辆启动时刻的位姿数据;(4)通过卡尔曼滤波模块进行数据融合得到车辆纵向的车速数据和加速度数据以及车辆的横摆角速度数据;(5)根据车轮的动力学方程,通过PID控制方法,控制驱动电机输出到车轮的扭矩T,使得车辆的滑移率保持在预设最佳值附近,优点是能达到更好地启动控制效果,减小加速时间,提高整车动力性。
Description
技术领域
本发明涉及一种基于激光雷达车速估计的车辆启动控制方法。
背景技术
随着无人驾驶汽车的发展,越来越多的先进传感器技术被加入到无人驾驶汽车中,这不仅为上层感知决策层带来好处,而且对于车辆底层控制而言也是福音。更关键的是这些传感器对于无人车是必须的,也就是说在无人车的配置上,这些新的控制算法在不增加传感器甚至减少传统车辆某些传感器的前提下,提高整车的控制性能。如果用一句抽象的话说就是,我们如果能尽可能的了解系统,并将这些先验知识运用于控制系统的设计上,我们就可能得到更好的控制效果。最显而易见的一个例子是车速,因为车速对于无论是车辆防滑控制、牵引力控制还是车辆稳定性控制以及由它们组成的集成控制系统而言都是必不可少的,然而不幸的是,车辆的速度估计一直是车辆运动控制的一个难题。传统控制方法的难点在于,低速时很难通过轮速传感器来估计车速,对于四轮驱动汽车更是如此。
发明内容
本发明所要解决的技术问题是提供一种能达到更好地启动控制效果,减小加速时间,提高整车动力性的基于激光雷达车速估计的车辆启动控制方法。
本发明解决上述技术问题所采用的技术方案为:一种基于激光雷达车速估计的车辆启动控制方法,步骤如下:
(1)首先通过车辆的轮式编码器获得车辆的速度数据vwheel,通过车载IMU惯性测量单元获得车辆的加速度数据aimu和车辆的角速度数据wimu;
(2)激光雷达里程计模块通过标准ICP算法对激光雷达传感器获得的三维点云数据进行运动位姿估计,从而获得激光雷达相对于车辆启动时刻的位姿数据;
(3)将步骤(2)得到的激光雷达位姿数据通过外参数据进行激光雷达与车辆质心的齐次坐标变换,变换到车辆质心相对于车辆启动时刻的位姿数据,即得到车辆的位置数据xlidar,ylidar,zlidar,航向角数据θyaw,俯仰角数据θpitch,横滚角数据θroll;
(4)将步骤(1)得到的数据vwheel、aimu和wimu与步骤(3)得到的数据xlidar,ylidar,zlidar,θyaw,θpitch和θroll,通过ROS(Robot Operating System)软件包下的卡尔曼滤波模块进行数据融合,得到车辆的纵向速度vx和车辆的纵向加速度ax以及车辆的横摆角速度ω;
(5)建立车轮的动力学方程
其中ω为车辆的横摆角速度,vx为车辆的纵向速度,ax为车辆的纵向加速度,R为车轮半径,J为车轮的转动惯量,由轮胎参数获得;其中Fz为车轮垂向力,由车轮垂向力传感器获得;μ为附着系数,由查表获得;T为驱动电机输出到车轮的扭矩;λ为车辆的滑移率;表示横摆角速度的变化率,是车辆的横摆角速度的导数,表示车辆的滑移率的变化率,是车辆的滑移率的导数;
(6)根据步骤(5)建立的车轮动力学方程,通过PID控制方法,控制驱动电机输出到车轮的扭矩T,使得车辆的滑移率保持在预设最佳值附近。
步骤(2)中ICP算法流程具体如下:首先对激光雷达获取的前后连续两个激光雷达采样时刻的三维点云数据进行误差计算,然后采用最小二乘法进行迭代优化,优化目标是误差最小,优化变量是位姿数据,当迭代次数超过30次或者误差小于0.05m,则优化结束,获得优化后的位姿数据。
步骤(3)中通过外参数据将激光雷达相对于车辆启动时刻的位姿数据变换到车辆质心相对于车辆启动时刻的位姿数据,具体过程如下:
a.首先将外参标定数据,通过齐次坐标变换方法表示成齐次坐标变换矩阵Tvehicle_lidar;
b.将激光雷达得到的位姿数据,通过齐次坐标变换方法表示成齐次坐标位姿矩阵Tlidar;
c.计算得到车辆坐标系下的齐次坐标位姿矩阵Tvehicle=Tvehicle_lidar*Tlidar;
d.通过齐次坐标逆变换方法将Tvehitle表示为车辆坐标系下的位置数据xlidar,ylidar,zlidar,航向角数据θyaw,俯仰角数据θpitch,横滚角数据θroll。
步骤(6)中车辆的滑移率预设最佳值为0.25。滑移率到达25%驱动能力最大。
步骤(6)具体过程为:
b.根据步骤(5)的动力学方程,计算得到滑移率λ=0.25时的驱动电机输出到车轮的目标扭矩Ttarget;
d.通过PID控制算法,对输出扭矩进行控制,PID算法如下:
e.对控制采样序号加1,即k=k+1;
f.重复从a步骤开始,如果ek小于或等于0.5N*m,则PID收敛后,得到当前时刻的车轮的扭矩为Ti。
与现有技术相比,本发明的优点在于:本发明一种基于激光雷达车速估计的车辆启动控制方法,采用无人驾驶汽车需要配备的激光雷达等传感器来估计车速,克服了传统传统方法在低速时无法准确估计车速的弱点,从而能达到更好地启动控制效果,减小加速时间,提高整车的动力性。
附图说明
图1为轮胎滑移情况与其驱动能力的关系曲线。
以下结合附图实施例对本发明作进一步详细描述。
具体实施例
一种基于激光雷达车速估计的车辆启动控制方法,步骤如下:
(1)首先通过车辆的轮式编码器(国产、HKT30-301)获得车辆的速度数据vwheel,通过车载IMU惯性测量单元(深圳维特智能、HWT901B)获得车辆的加速度数据aimu和车辆的角速度数据wimu;
(2)激光雷达里程计模块(Velodyne、VLP-16)通过标准ICP算法对激光雷达传感器获得的三维点云数据进行运动位姿估计,从而获得激光雷达相对于车辆启动时刻的位姿数据;其中ICP算法流程如下:首先对激光雷达获取的前后连续两个激光雷达采样时刻的三维点云数据进行误差计算(现有的点云匹配及误差计算技术),然后采用最小二乘法进行迭代优化,优化目标是误差最小,优化变量是位姿数据,当迭代次数超过30次或者误差小于0.05m,则优化结束,获得优化后的位姿数据;
(3)将步骤(2)得到的激光雷达位姿数据通过外参数据(外参数据通过人工标定取得,人工标定就是人工操用激光测距仪(Bosch/博世,GLM30)进行激光雷达与车辆质心的距离及尺寸测量和标定)进行激光雷达与车辆质心的齐次坐标变换,变换到车辆质心相对于车辆启动时刻的位姿数据,即得到车辆的位置数据xlidar,ylidar,zlidar,航向角数据θyaw,俯仰角数据θpitch,横滚角数据θroll;通过外参数据将激光雷达相对于车辆启动时刻的位姿数据变换到车辆质心相对于车辆启动时刻的位姿数据,具体过程如下:
a.首先将外参标定数据,通过齐次坐标变换方法表示成齐次坐标变换矩阵Tvehicle_lidar;
b.将激光雷达得到的位姿数据,通过齐次坐标变换方法表示成齐次坐标位姿矩阵Tlidar;
c.计算得到车辆坐标系下的齐次坐标位姿矩阵Tvehicle=Tvehicle_lidar*Tlidar;
d.通过齐次坐标逆变换方法将Tvehicle表示为车辆坐标系下的位置数据xlidar,ylidar,Zlidar,航向角数据θyaw,俯仰角数据θpitch,横滚角数据θroll;
(4)将步骤(1)得到的数据vwheel、aimu和wimu与步骤(3)得到的数据xlidar,ylidar,zlidar,θyaw,θpitch和θroll,通过现有的ROS(Robot Operating System)软件包下的卡尔曼滤波模块进行数据融合,得到车辆的纵向速度vx和车辆的纵向加速度ax以及车辆的横摆角速度ω;
(5)建立车轮的动力学方程
其中ω为车辆的横摆角速度,vx为车辆的纵向速度,ax为车辆的纵向加速度,R为车轮半径,J为车轮的转动惯量,由轮胎参数获得;其中Fz为车轮垂向力,由车轮垂向力传感器获得;μ为附着系数,由查表获得;T为驱动电机输出到车轮的扭矩;λ为车辆的滑移率;表示横摆角速度的变化率,是车辆的横摆角速度的导数;表示车辆的滑移率的变化率,是车辆的滑移率的导数;
(6)根据步骤(5)建立的车轮动力学方程,通过PID控制方法,控制驱动电机输出到车轮的扭矩T,使得车辆的滑移率保持在预设最佳值附近。取车辆的滑移率=0.25时,驱动能力最大,具体过程为:
b.根据步骤(5)的动力学方程,计算得到滑移率λ=0.25时的驱动电机输出到车轮的目标扭矩Ttarget;
e.对控制采样序号加1,即k=k+1;
f.重复从a步骤开始,如果ek小于或等于0.5N*m,则PID收敛后,得到当前时刻的车轮的扭矩为Ti。
通常车轮在打滑时会失去驱动能力。图1给出轮胎滑移情况与其驱动能力的关系曲线,其横坐标为滑移率,由如下公式:
车辆猛启动时,轮胎会产生滑转,这对于启动时是不利的,从图1可以看出,在滑移率较小的时候,轮胎的的驱动能力是随着滑移率升高而升高,滑移率到达25%驱动能力最大,但是当轮胎滑移率再增大时,驱动能力反而减少,当轮胎急剧打滑时,我们的轮胎便工作在这个区域。驱动能力的减小,会使得加速时间变长,影响汽车的动力性。车轮的动力学过程可用如下方程表达:
Fx=μ(λ)Fz
其中T为驱动电机输出到车轮的扭矩(为我们可以控制的输入),R为车轮半径,Fx为车轮纵向驱动力,J为车轮的转动惯量,Fz为车轮垂向力,μ为附着系数,最终,最终车轮的动力学过程如下表达式所示:
为一个单输入单输出的非线性系统,可以使用各种控制方法,来控制λ使得其不超过限定值。
上述说明并非对本发明的限制,本发明也并不限于上述举例。本技术领域的普通技术人员在本发明的实质范围内,做出的变化、改型、添加或替换,也应属于本发明的保护范围。
Claims (5)
1.一种基于激光雷达车速估计的车辆启动控制方法,其特征在于步骤如下:
(2)激光雷达里程计模块通过标准ICP算法对激光雷达传感器获得的三维点云数据进行运动位姿估计,从而获得激光雷达相对于车辆启动时刻的位姿数据;
(5)建立车轮的动力学方程
其中为车辆的横摆角速度,为车辆的纵向速度,为车辆的纵向加速度, R为车轮半径,J为车轮的转动惯量,由轮胎参数获得;其中为车轮垂向力,由车轮垂向力传感器获得;为附着系数,由查表获得;T为驱动电机输出到车轮的扭矩;为车辆的滑移率;表示横摆角速度的变化率,是车辆的横摆角速度的导数;表示车辆的滑移率的变化率,是车辆的滑移率的导数;
(6)根据步骤(5)建立的车轮动力学方程,通过PID控制方法,控制驱动电机输出到车轮的扭矩T,使得车辆的滑移率保持在预设最佳值附近。
2.根据权利要求1所述的一种基于激光雷达车速估计的车辆启动控制方法,其特征在于步骤(2)中ICP算法流程具体如下:首先对激光雷达获取的前后连续两个激光雷达采样时刻的三维点云数据进行误差计算,然后采用最小二乘法进行迭代优化,优化目标是误差最小,优化变量是位姿数据,当迭代次数超过30次或者误差小于0.05m,则优化结束,获得优化后的位姿数据。
4.根据权利要求1所述的一种基于激光雷达车速估计的车辆启动控制方法,其特征在于:步骤(6)中车辆的滑移率的预设最佳值为0.25。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010061746.9A CN110871801B (zh) | 2020-01-20 | 2020-01-20 | 一种基于激光雷达车速估计的车辆启动控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010061746.9A CN110871801B (zh) | 2020-01-20 | 2020-01-20 | 一种基于激光雷达车速估计的车辆启动控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110871801A CN110871801A (zh) | 2020-03-10 |
CN110871801B true CN110871801B (zh) | 2020-07-03 |
Family
ID=69718529
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010061746.9A Active CN110871801B (zh) | 2020-01-20 | 2020-01-20 | 一种基于激光雷达车速估计的车辆启动控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110871801B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112731320A (zh) * | 2020-12-29 | 2021-04-30 | 福瑞泰克智能系统有限公司 | 车载雷达误差数据的估计方法、装置、设备及存储介质 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2017094068A1 (ja) * | 2015-11-30 | 2017-06-08 | パイオニア株式会社 | 速度算出装置、制御方法、プログラム及び記憶媒体 |
CN105882634B (zh) * | 2016-05-13 | 2018-06-12 | 南京理工大学 | 高鲁棒性车轮防滑控制方法、防滑控制系统及车辆 |
CN108322636A (zh) * | 2017-12-29 | 2018-07-24 | 吉林大学 | 一种基于机器视觉的车速估计器、车辆及估计方法 |
CN109606133B (zh) * | 2019-01-16 | 2020-10-20 | 浙江科技学院 | 基于双层控制的分布式驱动电动汽车转矩矢量控制方法 |
-
2020
- 2020-01-20 CN CN202010061746.9A patent/CN110871801B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN110871801A (zh) | 2020-03-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
WO2021103797A1 (zh) | 考虑复杂激励条件的车辆路面附着系数自适应估计方法 | |
CN109421552B (zh) | 分布式驱动电动汽车路面自适应驱动防滑控制方法及系统 | |
WO2018121595A1 (zh) | 四驱电动汽车的驱动防滑控制方法和装置 | |
WO2018121601A1 (zh) | 四驱电动汽车的驱动防滑控制方法和装置 | |
CN110271608B (zh) | 车辆转向控制方法、装置、系统以及车辆 | |
CN108839652B (zh) | 一种车辆失稳可控域的自动驾驶紧急避让系统 | |
US10391884B2 (en) | Drive power control device for electric vehicle | |
US11731611B2 (en) | Vehicle stability control method and device | |
CN107009916B (zh) | 考虑驾驶员意图分布式驱动电动汽车防滑控制系统及方法 | |
CN111483467B (zh) | 一种车辆控制方法及装置 | |
JPH06183288A (ja) | カーブ走行における車両安定性の制御装置 | |
US11648933B2 (en) | Method for controlling wheel slip of vehicle | |
CN109177746A (zh) | 一种用于轮边电机驱动车辆差动转向的控制系统及方法 | |
WO2022134929A1 (zh) | 一种确定车辆质量方法、装置、设备及介质 | |
CN115848381A (zh) | 估计最大横向加速度和横摆率的系统和方法 | |
CN110871801B (zh) | 一种基于激光雷达车速估计的车辆启动控制方法 | |
CN109849898A (zh) | 基于遗传算法混合优化gpc的车辆横摆稳定性控制方法 | |
CN114148411B (zh) | 一种轮式无人平台的漂移控制方法 | |
CN114148403B (zh) | 一种线控转向系统多工况稳定性控制方法 | |
CN113264048B (zh) | 车辆、操作车辆的系统和方法 | |
US11794747B2 (en) | Method for controlling an actuator of a vehicle | |
CN110606088B (zh) | 一种电动轮驱动防滑控制策略 | |
CN114523954A (zh) | 一种轮毂电机驱动的汽车横摆稳定性控制系统及控制方法 | |
CN112660107A (zh) | 一种改善分布式电驱动底盘功率循环的转矩分配方法 | |
JP7173893B2 (ja) | 車両制御装置、車両制御方法及び車両制御システム |
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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20230802 Address after: 315191 East 1st Road, Science Park, Jiangshan Town, Yinzhou District, Ningbo City, Zhejiang Province Patentee after: Shangyuan Zhixing (Ningbo) Technology Co.,Ltd. Address before: 315191 East 1st Road, Science Park, Jiangshan Town, Yinzhou District, Ningbo City, Zhejiang Province Patentee before: Zhejiang tianshangyuan Technology Co.,Ltd. |
|
TR01 | Transfer of patent right |