CN105172793B - 自动驾驶汽车的位姿估算方法 - Google Patents
自动驾驶汽车的位姿估算方法 Download PDFInfo
- Publication number
- CN105172793B CN105172793B CN201510627561.9A CN201510627561A CN105172793B CN 105172793 B CN105172793 B CN 105172793B CN 201510627561 A CN201510627561 A CN 201510627561A CN 105172793 B CN105172793 B CN 105172793B
- Authority
- CN
- China
- Prior art keywords
- msub
- automobile
- angle
- mrow
- wheel
- 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
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
- 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
-
- 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/28—Wheel 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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Mathematical Physics (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了自动驾驶汽车的位姿估算方法,包括:根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;根据汽车的方向盘转角计算汽车前轮轴的中心转向角;根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角。本发明只需要轮速传感器及方向盘转角传感器,配合简单的积分算法,即可完成对汽车位姿的估算,在使用成本上相比较依靠高精度的传感器而言大大降低,同时算法简单,易于实现,可广泛应用于自动驾驶行业中。
Description
技术领域
本发明涉及自动驾驶领域,特别是涉及一种自动驾驶汽车的位姿估算方法。
背景技术
自动驾驶技术的实现,需要实时获取车辆的位姿信息(位置和航向角),目前大多数科研机构及整车厂都是依靠高精度的GPS进行定位,结合陀螺仪、加速度计等进行自动驾驶汽车航向角的计算,谷歌研发的一些自动驾驶无人车则是依靠车顶搭载的多线激光雷达进行地图构建,利用SLAM技术实时估算车辆的位姿,这些方法都需要外加昂贵的传感器,同时测量精度受到传感器运行状态的影响很大,例如加速度计容易受到外部干扰而陀螺仪长时间使用容易产生漂移,GPS精度受到对流层折射、通讯延时等的影响。因为现有的自动驾驶汽车位姿估算方法都是基于高精度传感器来实现的,其高成本使得自动驾驶技术不易实现量产,同时基于单一的传感器数据不能保证估计的汽车位姿的精度和鲁棒性,通常的做法是利用多传感器进行数据的融合,弥补各自的缺陷,而多传感器数据融合算法复杂,算法的优劣直接影响到估算的汽车位姿的精度,成为自动驾驶技术的一个技术壁垒。总的来说,目前的自动驾驶汽车的位姿估算方法不仅需要采用高精度的传感器导致成本较高,而且识别算法较为复杂,这两个问题大大制约了自动驾驶汽车的位姿估算,也限制了自动驾驶技术的发展。
发明内容
为了解决上述的技术问题,本发明的目的是提供一种自动驾驶汽车的位姿估算方法。
本发明解决其技术问题所采用的技术方案是:
自动驾驶汽车的位姿估算方法,包括以下步骤:
S1、根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;
S2、根据汽车的方向盘转角计算汽车前轮轴的中心转向角;
S3、根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角。
进一步,所述步骤S1之前还包括以下步骤:
S0、初始化自动驾驶汽车的位置和航向角。
进一步,所述步骤S2,包括:
S21、根据汽车的方向盘转角计算汽车的齿条位移;
S22、对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角;
S23、对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角。
进一步,所述步骤S21,其具体为:
采用下式,根据方向盘转角计算汽车的齿条位移:
s=ηβ
其中,s表示汽车的齿条位移,β表示汽车的方向盘转角,η表示比例系数。
进一步,所述步骤S22,其具体为:
根据下式,对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角:
上式中,α1(s)表示汽车的左前轮转角,α2(s)表示汽车的右前轮转角,s表示汽车的齿条位移,ki和pi分别表示n次多项式系数,其中i=0,1,…,n。
进一步,所述步骤S23,其具体为:
根据下式对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角:
上式中,α表示汽车的中心转向角,α1表示汽车的左前轮转角,α2表示汽车的右前轮转角。
进一步,所述步骤S3,其具体为:
采用下式,根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角:
上式中,表示当前时刻汽车的x轴位置,表示当前时刻汽车的y轴位置,θt表示当前时刻汽车的航向角,表示上一时刻汽车的x轴位置,表示上一时刻汽车的y轴位置,θt-1表示上一时刻汽车的航向角,vf表示汽车的前轮轮速,△T表示采样周期,α表示汽车的中心转向角,l表示汽车的车身轴距。
本发明的有益效果是:本发明提供了一种自动驾驶汽车的位姿估算方法,包括:根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;根据汽车的方向盘转角计算汽车前轮轴的中心转向角;根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角。本方法通过轮速传感器获取汽车运动时的前轮轮速,同时将方向盘转角传感器采集的方向盘转角换算为前轮轴的中心转向角,利用迭代计算可估算得到任意时刻汽车的位置和航向角信息。只需要轮速传感器及方向盘转角传感器,配合简单的积分算法,即可完成对汽车位姿的估算,在使用成本上相比较依靠高精度的传感器而言大大降低,同时算法简单,易于实现。
附图说明
下面结合附图和实施例对本发明作进一步说明。
图1是本发明的自动驾驶汽车的位姿估算方法的流程图;
图2是本发明的自动驾驶汽车的位姿估算方法的具体实施例中建立的自动驾驶汽车的运动模型的示意图。
具体实施方式
参照图1,本发明提供了自动驾驶汽车的位姿估算方法,包括以下步骤:
S1、根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;
S2、根据汽车的方向盘转角计算汽车前轮轴的中心转向角;
S3、根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角。
进一步作为优选的实施方式,所述步骤S1之前还包括以下步骤:
S0、初始化自动驾驶汽车的位置和航向角。
进一步作为优选的实施方式,所述步骤S2,包括:
S21、根据汽车的方向盘转角计算汽车的齿条位移;
S22、对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角;
S23、对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角。
进一步作为优选的实施方式,所述步骤S21,其具体为:
采用下式,根据方向盘转角计算汽车的齿条位移:
s=ηβ
其中,s表示汽车的齿条位移,β表示汽车的方向盘转角,η表示比例系数。
进一步作为优选的实施方式,所述步骤S22,其具体为:
根据下式,对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角:
上式中,α1(s)表示汽车的左前轮转角,α2(s)表示汽车的右前轮转角,s表示汽车的齿条位移,ki和pi分别表示n次多项式系数,其中i=0,1,…,n。
进一步作为优选的实施方式,所述步骤S23,其具体为:
根据下式对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角:
上式中,α表示汽车的中心转向角,α1表示汽车的左前轮转角,α2表示汽车的右前轮转角。
进一步作为优选的实施方式,所述步骤S3,其具体为:
采用下式,根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角:
上式中,表示当前时刻汽车的x轴位置,表示当前时刻汽车的y轴位置,θt表示当前时刻汽车的航向角,表示上一时刻汽车的x轴位置,表示上一时刻汽车的y轴位置,θt-1表示上一时刻汽车的航向角,vf表示汽车的前轮轮速,△T表示采样周期,α表示汽车的中心转向角,l表示汽车的车身轴距。
以下结合具体实施例对本发明做详细说明。
参照图1,自动驾驶汽车的位姿估算方法,包括以下步骤:
S0、初始化自动驾驶汽车的位置和航向角;将自动驾驶汽车的航向角初始化为0,位置初始化为Gx=0,Gy=0。
S1、根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;
S2、根据汽车的方向盘转角计算汽车前轮轴的中心转向角,具体包括S21~S23:
S21、采用下式,根据方向盘转角计算汽车的齿条位移:
s=ηβ
其中,s表示汽车的齿条位移,β表示汽车的方向盘转角,η表示比例系数,η为固定值,表示齿条位移总量程与方向盘转角范围(左右打满的角度差,即方向盘转角总量程)的比值,假设齿条位移总量程为s0,汽车方向盘转角总量程为β0,那么可以计算获得比例系数:η=s0/β0。
因为方向盘通过长轴与齿轮固连,依靠齿轮啮合控制齿条的左右移动,齿条的平移通过空间连杆机构转为前轮的转向,由齿轮、齿条啮合关系可知,方向盘转角与齿条位移的关系可以近似处理为线性关系,当从方向盘传感器获取到方向盘转角β后可以通过固定的比例关系η获得齿条位移。
S22、根据下式,对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角:
上式中,α1(s)表示汽车的左前轮转角,α2(s)表示汽车的右前轮转角,s表示汽车的齿条位移,ki和pi分别表示n次多项式系数,其中i=0,1,…,n;
本步骤的两个多项式是通过实验测量得到齿条位移、左前轮转角以及右前轮转角的大量数据后,根据得到的数据进行曲线拟合而获得的,准确度高,可以根据齿条位移准确地计算出左前轮转角以及右前轮转角的值。ki(i=0,1,…,n)和pi(i=0,1,…,n)分别表示拟合曲线的对应的n次多项式系数。
S23、根据下式对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角:
上式中,α表示汽车的中心转向角,α1表示汽车的左前轮转角,α2表示汽车的右前轮转角。
S3、采用下式,根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角:
上式中,表示当前时刻汽车的x轴位置,表示当前时刻汽车的y轴位置,θt表示当前时刻汽车的航向角,表示上一时刻汽车的x轴位置,表示上一时刻汽车的y轴位置,θt-1表示上一时刻汽车的航向角,vf表示汽车的前轮轮速,△T表示采样周期,l表示汽车的车身轴距。
以下结合图2说明步骤S3中的计算公式的原理。
图2展示了自动驾驶汽车的运动学模型,图2中,ICC表示瞬时转向中心,(XG,OG,YG)为全局坐标系(里程计坐标系),(xR,oR,yR)为固联于车身的局部坐标系,定义全局坐标系与初始状态时车身的局部坐标系重合。t时刻,自动驾驶汽车在全局坐标系下的位姿为
结合图2可获得全局坐标系与局部坐标系的齐次变换矩阵如下:
本发明中,简化方向控制器的设计,不考虑车辆质量转移,对建立的自动驾驶汽车的运动模型釆用以下几点限制条件:
1、整个汽车视为刚体,车轮视为刚性轮,不考虑车轮与地面接触时的弹性变化对整个模型带来的影响;
2、汽车处于二维平面上运动,不考虑俯仰和侧倾带来的影响;
3、汽车运行的过程中,车轮在道路上作纯滚动运动,忽略滑动带来的影响;
4、汽车运行的过程中,路面始终能够给车轮提供足够的静摩擦力,车辆不产生相对滑移或者滑动。
因为以上4种情况属于较为特殊的情况,自动驾驶汽车一般不会碰到这些情况,因此结合以上的限定简化所建立的运动模型,从而简化计算过程。
基于上述限制条件,由图2中的几何关系可获得如下计算公式:
R=l/tanα
以及
其中,R表示汽车的实时转弯半径,ω表示汽车的角速度,vr_x、vr_y分别表示汽车的后轮轴中心点的速度vr在全局坐标系下沿X、Y轴的速度分量,α1表示汽车的左前轮转角,α2表示汽车的右前轮转角,α为前轮轴中心点的转向角即中心转向角,由阿克曼转向原理可知内侧轮转角比外侧轮转角大4度左右(图中为α1>α2),。在本算法开始启动时,初始化自动驾驶汽车的航向角为0,后续航向角则根据迭代公式计算,设θt为t时刻汽车的航向角,即局部坐标系x轴与全局坐标系X轴的夹角。定义逆时针方向时,转向角和航向角为正。
汽车后轮轴中心点的速度vr与前轮轮速vf的关系如下:
vr=vf cosα
因此可获得:
在采样周期△T内,可以假设中心点的速度vr保持不变,车沿直线行驶,则可由速度分量分别计算出一个采样周期△T内在全局部坐标系下的位移增量和如下:
因此,根据全局坐标系计算出的一个采样周期内的位移增量,可计算出在任意t时刻,自动驾驶汽车在全局坐标系下的位姿:
将对应的表达式代入上式,即可获得:
因此可获知,自动驾驶汽车的位姿由4个参数(vf,α,△T,l)确定,其中车身轴距l和采样周期△T对于特定的车型来说是固定值;vf由轮速传感器提采集获得,前轮轴中心转向角α可由方向盘转角传感器所采集的方向盘转角计算获得。
本方法基于阿克曼汽车转向原理,通过轮速传感器获取汽车运动时的前轮轮速,同时将方向盘转角传感器采集的方向盘转角换算为前轮轴的中心转向角,在微小的时间内认为汽车的行进速度及前轮轴的中心转向角不变,利用积分可估算得到任意时刻汽车的位置和航向角信息。只需要轮速传感器及方向盘转角传感器,配合简单的积分算法,即可完成对汽车位姿的估计,在使用成本上相比较依靠高精度的传感器而言大大降低,同时算法简单,易于实现。而且通过在连续的运动中将自动驾驶汽车的位姿进行反复的迭代积分,可实现对智能车位姿连续、稳定的估计与跟踪。
以上是对本发明的较佳实施进行了具体说明,但本发明创造并不限于所述实施例,熟悉本领域的技术人员在不违背本发明精神的前提下还可做出种种的等同变形或替换,这些等同的变型或替换均包含在本申请权利要求所限定的范围内。
Claims (5)
1.自动驾驶汽车的位姿估算方法,其特征在于,包括以下步骤:
S1、根据预设的采样周期,实时地采用轮速传感器获取自动驾驶汽车的前轮轮速,同时采用方向盘转角传感器获取自动驾驶汽车的方向盘转角;
S2、根据汽车的方向盘转角计算汽车前轮轴的中心转向角;
S3、根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角;
所述步骤S2,包括步骤S21~S23:
S21、根据汽车的方向盘转角计算汽车的齿条位移;
S22、对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角;
S23、对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角;
所述步骤S23,其具体为:
根据下式对汽车的左前轮转角和右前轮转角进行拟合后,获得汽车的中心转向角:
<mrow>
<mi>&alpha;</mi>
<mo>=</mo>
<mi>a</mi>
<mi>r</mi>
<mi>c</mi>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mn>2</mn>
<msub>
<mi>tan&alpha;</mi>
<mn>1</mn>
</msub>
<mo>&CenterDot;</mo>
<msub>
<mi>tan&alpha;</mi>
<mn>2</mn>
</msub>
</mrow>
<mrow>
<msub>
<mi>tan&alpha;</mi>
<mn>1</mn>
</msub>
<mo>+</mo>
<msub>
<mi>tan&alpha;</mi>
<mn>2</mn>
</msub>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
</mrow>
上式中,α表示汽车的中心转向角,α1表示汽车的左前轮转角,α2表示汽车的右前轮转角。
2.根据权利要求1所述的自动驾驶汽车的位姿估算方法,其特征在于,所述步骤S1之前还包括以下步骤:
S0、初始化自动驾驶汽车的位置和航向角。
3.根据权利要求1所述的自动驾驶汽车的位姿估算方法,其特征在于,所述步骤S21,其具体为:
采用下式,根据方向盘转角计算汽车的齿条位移:
s=ηβ
其中,s表示汽车的齿条位移,β表示汽车的方向盘转角,η表示比例系数。
4.根据权利要求1所述的自动驾驶汽车的位姿估算方法,其特征在于,所述步骤S22,其具体为:
根据下式,对齿条位移进行多项式计算后,分别获得汽车的左前轮转角和右前轮转角:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
<mo>=</mo>
<msub>
<mi>k</mi>
<mi>n</mi>
</msub>
<msup>
<mi>s</mi>
<mi>n</mi>
</msup>
<mo>+</mo>
<msub>
<mi>k</mi>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msup>
<mi>s</mi>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>0</mn>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>2</mn>
</msub>
<mrow>
<mo>(</mo>
<mi>s</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msub>
<mi>p</mi>
<mi>n</mi>
</msub>
<msup>
<mi>s</mi>
<mi>n</mi>
</msup>
<mo>+</mo>
<msub>
<mi>p</mi>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<msup>
<mi>s</mi>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>+</mo>
<mo>...</mo>
<mo>+</mo>
<msub>
<mi>p</mi>
<mn>1</mn>
</msub>
<mi>s</mi>
<mo>+</mo>
<msub>
<mi>p</mi>
<mn>0</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
上式中,α1(s)表示汽车的左前轮转角,α2(s)表示汽车的右前轮转角,s表示汽车的齿条位移,ki和pi分别表示n次多项式系数,其中i=0,1,…,n。
5.根据权利要求1所述的自动驾驶汽车的位姿估算方法,其特征在于,所述步骤S3,其具体为:
采用下式,根据当前时刻汽车的前轮轮速、中心转向角,对上一时刻汽车的位置和航向角进行迭代计算,进而获得当前时刻汽车的位置和航向角:
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<msub>
<mmultiscripts>
<mi>x</mi>
<mi>G</mi>
</mmultiscripts>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mmultiscripts>
<mi>x</mi>
<mi>G</mi>
</mmultiscripts>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>f</mi>
</msub>
<mi>&Delta;</mi>
<mi>T</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<msub>
<mi>&theta;</mi>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mmultiscripts>
<mi>y</mi>
<mi>G</mi>
</mmultiscripts>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mmultiscripts>
<mi>y</mi>
<mi>G</mi>
</mmultiscripts>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>f</mi>
</msub>
<mi>&Delta;</mi>
<mi>T</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<msub>
<mi>&theta;</mi>
<mi>t</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&theta;</mi>
<mi>t</mi>
</msub>
<mo>=</mo>
<msub>
<mi>&theta;</mi>
<mrow>
<mi>t</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mo>+</mo>
<msub>
<mi>v</mi>
<mi>f</mi>
</msub>
<mi>&Delta;</mi>
<mi>T</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&alpha;</mi>
<mo>/</mo>
<mi>l</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
上式中,Gxt表示当前时刻汽车的x轴位置,Gyt表示当前时刻汽车的y轴位置,θt表示当前时刻汽车的航向角,Gxt-1表示上一时刻汽车的x轴位置,Gyt-1表示上一时刻汽车的y轴位置,θt-1表示上一时刻汽车的航向角,vf表示汽车的前轮轮速,△T表示采样周期,α表示汽车的中心转向角,l表示汽车的车身轴距。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510627561.9A CN105172793B (zh) | 2015-09-25 | 2015-09-25 | 自动驾驶汽车的位姿估算方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510627561.9A CN105172793B (zh) | 2015-09-25 | 2015-09-25 | 自动驾驶汽车的位姿估算方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105172793A CN105172793A (zh) | 2015-12-23 |
CN105172793B true CN105172793B (zh) | 2017-08-22 |
Family
ID=54895391
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510627561.9A Active CN105172793B (zh) | 2015-09-25 | 2015-09-25 | 自动驾驶汽车的位姿估算方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105172793B (zh) |
Families Citing this family (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108007417B (zh) * | 2016-10-27 | 2021-02-05 | 上海华测导航技术股份有限公司 | 一种农机自动驾驶控制***角度传感器自动标定方法 |
CN108955720B (zh) * | 2018-09-10 | 2021-06-08 | 广东电网有限责任公司电力科学研究院 | 一种基于四轮独立驱动和转向的里程推算方法及装置 |
CN111452785A (zh) * | 2019-01-22 | 2020-07-28 | 上海汽车集团股份有限公司 | 一种基于自学习线路的泊车控制方法及装置 |
CN110208783B (zh) * | 2019-05-21 | 2021-05-14 | 同济人工智能研究院(苏州)有限公司 | 基于环境轮廓的智能车辆定位方法 |
CN113494910B (zh) * | 2020-04-02 | 2024-06-18 | 广州汽车集团股份有限公司 | 一种基于uwb定位的车辆定位方法、装置及存储介质 |
CN111854731B (zh) * | 2020-07-22 | 2022-04-29 | 中国第一汽车股份有限公司 | 一种位姿确定方法、装置、车辆及存储介质 |
CN112078570A (zh) * | 2020-08-04 | 2020-12-15 | 武汉乐庭软件技术有限公司 | 一种基于阿克曼转向模型的汽车定位方法 |
CN112157651B (zh) * | 2020-08-21 | 2022-04-15 | 深圳市优必选科技股份有限公司 | 位姿确定方法、装置及机器人 |
CN112083725B (zh) * | 2020-09-04 | 2021-11-30 | 湖南大学 | 一种面向自动驾驶车辆的结构共用多传感器融合定位*** |
CN114322978B (zh) * | 2020-10-10 | 2024-03-15 | 广州汽车集团股份有限公司 | 一种车辆定位方法、计算机设备、计算机可读存储介质 |
CN112985426B (zh) * | 2021-03-31 | 2022-09-13 | 天津大学 | 一种用于二轮车的定位方法 |
CN114104097B (zh) * | 2021-12-21 | 2023-06-27 | 华人运通(江苏)技术有限公司 | 转向控制方法、装置、***及可读存储介质 |
CN114882733B (zh) * | 2022-03-15 | 2023-12-01 | 深圳市德驰微视技术有限公司 | 基于域控制器的停车位获取方法、电子设备及存储介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102372000A (zh) * | 2010-08-23 | 2012-03-14 | 北京经纬恒润科技有限公司 | 获取泊车位参数的装置和*** |
CN102632891A (zh) * | 2012-04-06 | 2012-08-15 | 中国人民解放军军事交通学院 | 无人驾驶车辆实时跟踪行驶轨迹的计算方法 |
JP5012604B2 (ja) * | 2008-03-19 | 2012-08-29 | トヨタ自動車株式会社 | 車両用制御装置 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20070282504A1 (en) * | 2004-03-05 | 2007-12-06 | Continental Teves Ag & Co. Ohg | Parking Assistance |
CN102495631B (zh) * | 2011-12-09 | 2013-08-21 | 中国科学院合肥物质科学研究院 | 一种无人驾驶车辆跟踪预定轨迹的智能控制方法 |
-
2015
- 2015-09-25 CN CN201510627561.9A patent/CN105172793B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP5012604B2 (ja) * | 2008-03-19 | 2012-08-29 | トヨタ自動車株式会社 | 車両用制御装置 |
CN102372000A (zh) * | 2010-08-23 | 2012-03-14 | 北京经纬恒润科技有限公司 | 获取泊车位参数的装置和*** |
CN102632891A (zh) * | 2012-04-06 | 2012-08-15 | 中国人民解放军军事交通学院 | 无人驾驶车辆实时跟踪行驶轨迹的计算方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105172793A (zh) | 2015-12-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105172793B (zh) | 自动驾驶汽车的位姿估算方法 | |
CN104061899B (zh) | 一种基于卡尔曼滤波的车辆侧倾角与俯仰角估计方法 | |
CN107031654B (zh) | 一种多信息融合的汽车质心侧偏角估计方法 | |
CN113819914A (zh) | 一种地图构建方法及装置 | |
CN101033973B (zh) | 微小型飞行器微惯性组合导航***的姿态确定方法 | |
CN110001840B (zh) | 一种基于视觉传感器的多种路况下的两轮自平衡车运动控制方法 | |
CN108362288B (zh) | 一种基于无迹卡尔曼滤波的偏振光slam方法 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN106476883A (zh) | 车辆的行驶控制装置 | |
CN107063241A (zh) | 基于双gnss天线及单轴mems陀螺的前轮测角*** | |
CN108387236B (zh) | 一种基于扩展卡尔曼滤波的偏振光slam方法 | |
CN105987696A (zh) | 一种低成本车辆自动驾驶设计实现方法 | |
CN101846734A (zh) | 农用机械导航定位方法、***及农用机械工控机 | |
CN110077392A (zh) | 一种自动泊车定位***的航迹推算方法 | |
CN113819905A (zh) | 一种基于多传感器融合的里程计方法及装置 | |
CN103921266A (zh) | 一种基于Kinect的体感控制冰雪机器人方法 | |
CN110530361A (zh) | 一种基于农业机械双天线gnss自动导航***的转向角度估计器 | |
CN112433531A (zh) | 一种自动驾驶车辆的轨迹跟踪方法、装置及计算机设备 | |
CN112097792A (zh) | 一种阿克曼模型移动机器人里程计标定方法 | |
CN110426011A (zh) | 车辆转向角测量***及方法 | |
CN110489807B (zh) | 一种摇臂悬架结构巡视器的局部精确定位方法 | |
Zhang et al. | Learning end-to-end inertial-wheel odometry for vehicle ego-motion estimation | |
CN112389438A (zh) | 一种车辆转向***传动比的确定方法及装置 | |
CN114475581B (zh) | 基于轮速脉冲和imu卡尔曼滤波融合的自动泊车定位方法 | |
CN108955720A (zh) | 一种基于四轮独立驱动和转向的里程推算方法及装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20170726 Address after: 510000, Guangdong, Guangzhou, Guangzhou new Guangzhou knowledge city nine Buddha, Jianshe Road 333, room 245 Applicant after: Guangzhou Xiaopeng Automobile Technology Co. Ltd. Address before: 510006 Guangdong city of Guangzhou province Panyu District Xiaoguwei Street West outer ring road of Science Museum of Guangdong University of Technology No. 100 room 429431 Applicant before: GUANGZHOU CHENGXING ZHIDONG AUTOMOBILE SCIENCE & TECHNOLOGY CO., LTD. |
|
TA01 | Transfer of patent application right | ||
GR01 | Patent grant | ||
GR01 | Patent grant |