详情

原文传递一种基于微分平坦的智能车避障控制方法

专利名称：	一种基于微分平坦的智能车避障控制方法
摘要：	本发明公开了一种基于微分平坦的自主驾驶车辆避障控制方法，包括以下步骤：判断自主车辆采取何种驾驶子操作；建立简化车辆系统模型；找到平坦输出，并用其及其有限阶导数表示系统状态和控制输入；对平坦输出进行参数化；进行基于微分平坦的自主驾驶车辆避障控制器设计并完成控制；本方法通过判断纵向距离与安全距离的关系来决策采取何种驾驶操作，采用微分平坦原理，使车辆在保持车辆行驶稳定性的前提下，在较短时间内避开障碍物；本方法使得智能车可以更实时的去应对周围道路，交通和环境条件以及驾驶场景，保持车辆行驶的稳定性，并满足高速公路行车对最低车速的限制要求；采用微分平坦控制，降低了规划空间的维度，提高了控制速度。
专利类型：	发明专利
国家地区组织代码：	吉林;22
申请人：	吉林大学
发明人：	郭洪艳;薄悦;朱飞白;申忱;陈虹;刘俊
专利状态：	有效
申请日期：	2018-12-27T00:00:00+0800
发布日期：	2019-04-26T00:00:00+0800
申请号：	CN201811607568.4
公开号：	CN109677403A
代理机构：	长春吉大专利代理有限责任公司
代理人：	刘驰宇
分类号：	B60W30/09(2012.01);B;B60;B60W;B60W30
申请人地址：	130012 吉林省长春市前进大街2699号
主权项：	1.一种基于微分平坦的智能车避障控制方法，其特征在于，包括以下步骤：步骤一、操作规划：判断自主车辆采取何种驾驶子操作在处理避障问题的思想上，提出了操作规划的思路，即自主车辆的任何驾驶过程都可以分解为一系列基本驾驶子操作的组合，驾驶子操作包括巡航和换道；自主车辆与前方障碍车辆的纵向距离： d＝\|xobs-xx\| (1) 基于车辆制动过程运动学分析的避障安全距离模型：其中，d为自主车辆与前方障碍车辆的纵向距离；xobs为前方障碍车辆的纵向距离；xx为自主车辆的纵向距离；Ds为避障安全距离；vx为自主车辆的纵向速度，v2为障碍车辆的纵向速度，ax为自主车辆的制动减速度，a2为障碍车辆的制动减速度；d0为自主车辆和障碍车辆均处于静止状态时两车辆之间应保持的最小安全距离，d0取0.5m；tx为自主车辆制动系统协调时间，tx取0～2s；thum为驾驶员的制动反应时间，thum取0.3～2.0s；车辆位置xobs、xh，速度vx、v2以及加速度ax、a2由自主车辆中的传感器测量得到；为保证足够的安全，简化安全距离模型，本方法假设一种极限工况，即假设前方障碍车辆静止，忽略驾驶员的制动反应时间，即v2＝0，thum＝0，安全距离模型简化为：根据纵向距离与安全距离的大小来决策采取何种驾驶子操作：当自主车辆与前方障碍车辆的纵向距离d大于或等于安全距离Ds，即d≥Ds时，自主车辆保持行车道巡航；当自主车辆与前方障碍车辆的纵向距离d小于安全距离Ds，即d＜Ds时，自主车辆需要超越前方障碍车辆，进行换道；步骤二、建立简化的车辆系统模型：式中，其中，大地坐标系以自主车辆初始位置为大地坐标系的坐标原点O1，自主车辆初始前进方向为大地坐标系的横轴，即X1轴的正方向；垂直于X1轴指向驾驶员左侧的方向为大地坐标系的纵轴，即Y1轴的正方向；车辆坐标系以自主车辆质心为车辆系的坐标原点O2，沿着车身向前的方向为车辆坐标系的横轴，即X2轴的正方向；垂直于X2轴指向驾驶员左侧的方向为车辆坐标系的纵轴，即Y2轴的正方向；垂直于X2轴和Y2轴并通过自主车辆的质心指向上方的方向为车辆坐标系的纵轴Z2； x为系统的状态向量；u为系统控制量；A为系统矩阵；B为输入矩阵；y为自主车辆的质心在大地坐标系下的侧向位移，单位：m；vy为自主车辆的侧向速度，单位：m/s；γ为自主车辆的横摆角，单位：rad；为自主车辆的横摆角速度，单位：rad/s；δsw为自主车辆的方向盘转角，单位：rad；vx为自主车辆的纵向速度，单位：m/s；Cf为自主车辆前轮轮胎的侧偏刚度，单位：N/rad；Cr为自主车辆后轮轮胎的侧偏刚度，单位：N/rad；m为自主车辆的质量，单位：kg；a为自主车辆的质心到自主车辆前轴的距离，单位：m；b为自主车辆质心到自主车辆后轴的距离，单位：m；Is为自主车辆的方向盘转角到自主车辆的前轮转角的转向系角传动比；Iz为自主车辆绕车辆坐标系纵轴Z2的转动惯量，单位：kg·m2；步骤三、采用微分平坦方法：首先确定平坦输出，用选取的平坦输出z及其有限阶导数来表示系统状态和控制输入： (1)平坦输出： z＝y (15) 其中，y为自主车辆的质心大地坐标系下的侧向位移； (2)系统状态的平坦输出表示：用y表示自主车辆的质心在大地坐标系下的侧向位移，根据车辆坐标系与大地坐标系的转换关系可得到自主车辆在大地坐标系下的侧向位移y与自主车辆的纵向速度vx和自主车辆的侧向速度vy之间的关系如下：自主车辆工作在稳定工况，横摆角很小，即γ≈0，因此可有如下近似：式(16)便可以化简为：自主车辆的质心速度v为：前方可行道路区域的道路曲率ρ为：自主车辆的质心侧偏角β可用式(11)求得： β＝-k1ρ3v+k2ρ (21) 其中，k1，k2为曲线参数，取k1＝10.1，k2＝102537；将式(19)和式(20)带入式(21)可以得到自主车辆的质心侧偏角β的平坦输出表示：自主车辆的横摆角γ可由式(23)求得：将式(22)带入式(23)可以得到自主车辆横摆角γ的平坦输出表示M：其中，M为自主车辆横摆角γ的平坦输出表示；再将式(24)带入式(18)可得自主车辆侧向速度vy的平坦输出表示N：其中，N为自主车辆的侧向速度vy的平坦输出表示；对自主车辆的横摆角γ求导可以得到自主车辆的横摆角速度因此，对自主车辆横摆角γ的平坦输出表示M求导可以得到自主车辆横摆角速度的平坦输出表示如(26)：其中，为自主车辆的横摆角速度的平坦输出表示； (3)控制输入的平坦输出表示：根据力平衡方程、线性轮胎模型以及自主车辆的方向盘转角到自主车辆的前轮转角的转向系角传动比Is可以得到自主车辆的方向盘转角δsw表达式，如式(27)：由式(28)可知，需要得到自主车辆的侧向速度vy的一阶导数因此对式(25)求导可得：其中，为自主车辆的侧向速度vy的一阶导数的平坦输出表示；将式(25)、式(26)以及式(28)带入式(27)中得到自主车辆的方向盘转角δsw的平坦输出表示：步骤四、将平坦输出参数化：平坦输出参数化过程中，考虑到自主车辆的侧向运动为变加速运动，所以将自主车辆质的心在大地坐标系下的侧向位移y参数化为时间的三次函数： y＝b3t3+b2t2+b1t+b0 (30) 其中，b3,b2,b1,b0为待优化参数；步骤五、采用微分平坦方法进行自主避障控制器设计，为使自主车辆在尽可能短的时间内避开障碍物，并保证自主避障控制器输出的控制量始终平稳，目标函数为：满足：其中，J为优化函数的目标函数；t为任意时刻；Δt为滚动时域；yr为通过自主车辆感知系统得到的前方可行道路区域中心线；δswmin为自主车辆的方向盘转角δsw的最小值；δswmax为自主车辆的方向盘转角δsw的最大值；ymin为自主车辆在大地坐标系下的侧向位移y的最小值；ymax为自主车辆在大地坐标系下的侧向位移y的最大值；步骤六、将优化参数b3,b2,b1,b0带入式(30)、式(25)、式(26)、式(24)及式(19)可以得到最优的系统状态y,vy,γ和控制量δsw；根据步骤一中给出的规则判断自主车辆采取何种子操作：当自主车辆与前方障碍车辆的纵向距离d大于或等于安全距离Ds，即d≥Ds时，自主车辆保持行车道巡航，不需要进行换道避障操作；当自主车辆与前方障碍车辆的纵向距离d小于安全距离Ds，即d＜Ds时，自主车辆需要超越前方障碍车辆，进行换道，将优化出的控制量δsw作用于自主车辆执行机构，即可完成换道避障操作。 2.根据权利要求1所述的一种基于微分平坦的智能车避障控制方法，其特征在于，步骤二中建立简化的车辆系统模型的具体过程为： (1)建立车辆动力学模型忽略车辆的纵向动力学，而只考虑车辆的侧向动力学及横摆方向的动力学；选取线性二自由度的车辆动力学模型，根据牛顿第二定律，考虑车辆的侧向运动和横摆运动，力和力矩的平衡关系如式(4)所示：其中，m为自主车辆的质量，单位：kg；vx为自主车辆的纵向速度，单位：m/s；vy为自主车辆的侧向速度，单位：m/s；δf为自主车辆的前轮转角，单位：rad；γ为自主车辆的横摆角，单位：rad；为自主车辆的横摆角速度，单位：rad/s；a为自主车辆都质心到自主车辆前轴的距离，单位：m；b为自主车辆的质心到自主车辆后轴的距离，单位：m；Fyf为自主车辆前轮轮胎侧偏力，单位：N；Fyr为自主车辆后轮轮胎侧偏力，单位：N；Iz为自主车辆绕车辆坐标系纵轴Z2的转动惯量，单位：kg·m2；由于轮胎的侧偏角通常都比较小，因此可以认为轮胎工作在线性区域，忽略轮胎的非线性特性，轮胎力可以计算如下：其中，Cf为自主车辆前轮轮胎的侧偏刚度，单位：N/rad；Cr为自主车辆后轮轮胎的侧偏刚度，单位：N/rad；αf为自主车辆前轮轮胎侧偏角，单位：rad；αr为自主车辆后轮轮胎侧偏角，单位：rad；根据坐标系规定及几何关系，自主车辆前轮轮胎侧偏角αf和自主车辆后轮轮胎侧偏角αr可以用如下形式表示：自主车辆在稳定工况下行驶，前轮转角和横摆角都很小，因此可以进行如下近似：把式(5)、式(6)以及式(7)分别带入动力学方程式(4)，整理可得： (2)侧向位移与方向盘转角用y表示自主车辆在大地坐标系下的侧向位移，根据车辆坐标系与大地坐标系的转换关系可得到y与vy和vx之间的关系如下：自主车辆工作在稳定工况，横摆角很小，即γ≈0，因此可有如下近似：式(9)便可以化简为自主车辆的前轮转角δf与自主车辆的方向盘转角δsw的关系如式(12)，其中Is为自主车辆的方向盘转角到自主车辆的前轮转角的转向系角传动比 δsw＝Isδf (12) (3)建立简化的车辆系统模型结合式(8)，式(11)和式(12)，则可得车辆系统运动和动力学的微分方程式，具体如式(13)所示：本方法选取自主车辆的方向盘转角δsw作为车辆系统的控制量，而车辆系统的状态量则选取为基于此，车辆系统模型可被描述成式(14)所示的状态空间模型：式中，其中，x为系统的状态向量；u为系统控制量；y为系统输出；A为系统矩阵；B为输入矩阵。 3.根据权利要求1所述的一种基于微分平坦的智能车避障控制方法，其特征在于，步骤五中采用微分平坦方法进行自主避障控制器设计的具体过程为： (1)优化问题分析自主避障控制器需要实现以下一些设计目标： 1)使自主车辆在尽可能短的时间内避开障碍车辆，保持车辆行驶的稳定性； 2)使自主车辆在遵守交通规则的前提下确保其行驶的稳定性，需要对自主车辆的方向盘转角δsw以及自主车辆的质心在大地坐标系下的侧向位移y的范围进行限定； 3)保证自主避障控制器输出的控制量始终平稳，避免出现过大的控制动作； (2)自主避障控制器设计本方法做出如下假设：假设自主车辆的纵向速度vx为恒值；设计目标1)可由最小化式(31)中目标函数实现：其中，t为任意时刻；Δt为滚动时域；y为自主车辆的质心在大地坐标系下的侧向位移，单位，m；yr为通过自主车辆感知系统得到的前方可行道路区域的中心线，单位，rad；设计目标3)可由最小化式(32)中目标函数实现：对于有多个目标的优化问题，需要引入权重系数来对对各个优化目标的需求冲突进行衡量和处理，以获得一个最合适的优化结果；优化目标为：其中，t为任意时刻；Δt为滚动时域；Γ1,Γ2为J1和J2的相对权重系数；为了实现设计目标2)需要对自主车辆的方向盘转角δsw以及自主车辆的质心在大地坐标系下的侧向位移y的范围进行限定：采用微分平坦方法进行避障控制器设计，整理为：满足：其中，J为优化函数的目标函数；t为任意时刻；Δt为滚动时域；yr为通过自主车辆感知系统得到的前方可行道路区域中心线；δswmin为自主车辆的方向盘转角δsw的最小值；δswmax方向盘转角δsw的最大值；ymin为自主车辆在大地坐标系下的侧向位移y的最小值；ymax为自主车辆在大地坐标系下的侧向位移y的最大值。
所属类别：	发明专利