CN205396080U - 一种汽车主动避撞*** - Google Patents
一种汽车主动避撞*** Download PDFInfo
- Publication number
- CN205396080U CN205396080U CN201620037056.9U CN201620037056U CN205396080U CN 205396080 U CN205396080 U CN 205396080U CN 201620037056 U CN201620037056 U CN 201620037056U CN 205396080 U CN205396080 U CN 205396080U
- Authority
- CN
- China
- Prior art keywords
- sensor
- automobile
- controller
- centerdot
- electronic control
- 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.)
- Expired - Fee Related
Links
- 238000012545 processing Methods 0.000 claims abstract description 11
- 230000001133 acceleration Effects 0.000 claims description 9
- 238000000034 method Methods 0.000 abstract description 14
- 230000002596 correlated effect Effects 0.000 abstract 1
- 230000000875 corresponding effect Effects 0.000 abstract 1
- 239000002245 particle Substances 0.000 description 26
- 238000005457 optimization Methods 0.000 description 21
- 206010039203 Road traffic accident Diseases 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 230000004888 barrier function Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 208000027418 Wounds and injury Diseases 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000006378 damage Effects 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 208000014674 injury Diseases 0.000 description 1
- 230000009191 jumping Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 239000011159 matrix material Substances 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012827 research and development Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Landscapes
- Steering Control In Accordance With Driving Conditions (AREA)
- Control Of Driving Devices And Active Controlling Of Vehicle (AREA)
Abstract
本实用新型公开了一种汽车主动避撞***,包括前视雷达、摄像头、车速传感器、横摆角速度传感器、质心侧偏角传感器、信号处理模块、电子控制电源ECU、油门控制器、转向控制器、制动控制器。汽车在行驶过程中,电子控制单元实时采集各个传感器经信号处理模块传来的信号,并实时判断当前时刻汽车所处的路况与车况,如若此时可能发生危险情况,则ECU通过执行内部预先设定的轨迹规划程序产生一条连续无碰的可执行轨迹,并将相关信号输出到油门控制器、转向控制器与制动控制器进行相应操作,以避免危险情况的发生。本实用新型能够在紧急情况下辅助驾驶员对汽车进行操作,能够提高行车主动安全性能。
Description
技术领域
本实用新型涉及汽车辅助驾驶领域,尤其涉及一种汽车主动避撞***。
背景技术
随着智能交通在全球范围的兴起,汽车辅助驾驶技术受到了越来越多的关注,其研究的主要目的在于降低日趋严重的交通事故发生率,提高现有道路交通效率。国际上众多的研究机构,工业设计单位对其研发过程正投入大量的人力、物力、财力来进行相关关键技术的研发。
主动避撞***作为汽车辅助驾驶技术的一项重要研究内容,其研究的主要目的是提高车辆驾驶的安全性能,其主要利用现代信息技术、传感技术来扩展驾驶人员的感知能力,将外界信息(如车速、障碍物距离、速度、方向等)传递给驾驶人员的同时综合利用车况与路况信息,判断汽车当前运行状况的安全程度,在紧急情况下能自动的采取措施控制汽车,使得汽车主动地避开危险,保证汽车安全行驶或最大可能的减小事故的伤害程度。汽车只有具备了这样的主动安全性能,才可能从根本上减少交通事故,提高交通安全。
轨迹规划技术是主动避撞***中的一项关键技术,要想实现对车辆的智能控制,其前提条件是就要生成可行的参考轨迹,并将轨迹的参数提供给跟踪控制器,以便于控制器能够控制汽车按照所规划的轨迹行驶,因此,如何在紧急情况下规划一条可行的无碰轨迹显得尤为重要。
实用新型内容
本实用新型所要解决的技术问题是针对背景技术中所涉及到的缺陷,提供一种汽车主动避撞***,解决了在紧急情况下主动避撞***的轨迹规划问题,通过软硬件相结合的方式在保证汽车操纵稳定性的同时有效的避开障碍物,避免交通事故的发生,实现了汽车的主动安全功能。
本实用新型为解决上述技术问题采用以下技术方案:
一种汽车主动避撞***,包含前视雷达、摄像头、信号处理模块、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、电子控制电源ECU、油门控制器、转向控制器和制动控制器;
所述前视雷达、摄像头通过信号处理模块和所述电子控制电源ECU相连;所述电子控制电源ECU分别和、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、油门控制器、转向控制器、制动控制器相连;
所述前视雷达与摄像头均安装在汽车前方,用于检测汽车前方的道路情况,并将所测得的信号经信号处理模块处理后传递给所述电子控制单元ECU;
所述车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器分别用于感应汽车的速度、横摆角速度、质心侧偏角和前轮转向角,并将采集到的信号经处理后送入到电子控制单元ECU;
所述电子控制单元ECU用于根据接收到的信号输出相应的信号到油门控制器、转向控制器、制动控制器,进行相应加速、减速、制动操作,以保证行车安全。
本实用新型还公开了一种基于以上汽车主动避撞***的轨迹规划方法,包含以下步骤:
步骤1),通过前视雷达与摄像头获取汽车前方障碍物的距离、速度、加速度和宽度,并将前方障碍物的与汽车之间的距离与预先设定的安全距离阈值对比,如果其小于预设的安全距离阈值,则执行步骤2);
步骤2),通过车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器获取汽车的速度、横摆角速度、质心侧偏角和前轮转向角;
步骤3),根据汽车的横摆角、前轮转向角、纵向速度、前轴与后轴之间的间距、以及后轴中点的纵向坐标和侧向坐标建立汽车三自由度运动学模型;
步骤4),用七次多项式参数化待生成轨迹;
步骤5),根据汽车三自由度运动学模型和参数化的待生成轨迹设置轨迹优化模型约束条件、设定目标函数以及优化变量,并根据汽车的纵向速度、横摆角速度、质心侧偏角、前轮转向角、以及汽车前方障碍物距离、速度、加速度对其进行求解,得到轨迹优化模型;
步骤6),基于动态粒子群优化算法,对所建立的轨迹优化模型进行求解,得到规划轨迹。
作为该汽车主动避撞***的轨迹规划方法的进一步优化方案,根据以下公式建立步骤3)中所述的汽车三自由度运动学模型:
其中,x和y分别是汽车后轴中点的纵向坐标和侧向坐标,θ是汽车的横摆角,δ是汽车前轮转向角,v是汽车的纵向速度,l是汽车前轴与后轴之间的间距,t是轨迹规划的当前时间。
作为该汽车主动避撞***的轨迹规划方法的进一步优化方案,步骤5)中所述的七次多项式参数化的轨迹方程为:
其中,xd0、xd1、xd2、xd3、xd4、xd5、xd6、xd7、yd0、yd1、yd2、yd3、yd4、yd5、yd6、yd7是多项式的待定系数,(xd(t),yd(t))为待生成轨迹。
作为该汽车主动避撞***的轨迹规划方法的进一步优化方案,步骤6所述的轨迹优化模型的约束条件为:
(R0+R1)2≤[PL-1(H1-Mxd6-Nxd7)+xd6t6+xd7t7-x0-vx(t-t0)]2
+[PL-1(H2-Myd6-Nyd7)+yd6t6+yd7t7-y0-vy(t-t0)]2;
其中,
P=[1tt2t3t4t5],
t0为轨迹规划初始时刻,tf为轨迹规划终了时刻,为初始时刻t0汽车的状态,为终了时刻tf汽车的状态;
R0为汽车长度的一半,R1为与障碍物宽度的一半;
目标函数为 其中,w1和w2是权重系数,且w1+w2=1;ay是汽车侧向加速度;
优化的变量为xd6、xd7、yd6、yd7。
本实用新型采用以上技术方案与现有技术相比,具有以下技术效果:
1.本实用新型所述的轨迹规划方法所生成的轨迹满足各种非完整约束和执行机构约束;
2.本实用新型所述的轨迹规划方法所生成的轨迹轨迹曲率具有连续性,具有动态实时性,能够适应动态变化的道路环境;
3.通过跟踪本实用新型所述的轨迹规划方法所生成的轨迹能使汽车有效地避开障碍物,防止交通事故的发生。
附图说明
图1是本实用新型主动避撞***结构示意图;
图2是本实用新型主动避撞过程示意图;
图3是本实用新型的汽车三自由度运动学模型。
具体实施方式
下面结合附图对本实用新型的技术方案做进一步的详细说明:
如图1所示,本实用新型公开了一种汽车主动避撞***,包含前视雷达、摄像头、信号处理模块、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、电子控制单元ECU、油门控制器、转向控制器和制动控制器;
所述前视雷达、摄像头通过信号处理模块和所述电子控制电源ECU相连;所述电子控制电源ECU分别和、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、油门控制器、转向控制器、制动控制器相连;
所述前视雷达与摄像头均安装在汽车前方,用于检测汽车前方的道路情况,并将所测得的信号经信号处理模块处理后传递给所述电子控制单元ECU;
所述车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器分别用于感应汽车的速度、横摆角速度、质心侧偏角和前轮转向角,并将采集到的信号经处理后送入到电子控制单元ECU;
所述电子控制单元ECU用于根据接收到的信号输出相应的信号到油门控制器、转向控制器、制动控制器,进行相应加速、减速、制动操作,以保证行车安全。
本实用新型还公开了一种基于该汽车主动避撞***的轨迹规划方法,包含以下具体步骤:
步骤1、通过前视雷达与摄像头获取汽车前方障碍物的距离、速度、加速度和宽度,并将前方障碍物的与汽车之间的距离与预先设定的安全距离阈值对比,如果其小于预设的安全距离阈值,则执行步骤2。
步骤2、通过车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器获取汽车的纵向速度、横摆角速度、质心侧偏角和前轮转向角。
步骤3、建立汽车三自由度运动学模型,如图3所示:
其中,x和y分别是汽车后轴中点的纵向坐标和侧向坐标,θ是汽车的横摆角,δ是汽车前轮转向角,v是汽车的纵向速度,l是汽车前轴与后轴之间的间距,t是轨迹规划的当前时间。
步骤4、进入循环。
步骤5、设轨迹规划初始时刻为t0,轨迹规划终了时刻为tf,用七次多项式参数化待生成轨迹:
其中,xd0、xd1、xd2、xd3、xd4、xd5、xd6、xd7、yd0、yd1、yd2、yd3、yd4、yd5、yd6、yd7是多项式的待定系数。
步骤6、根据汽车三自由度运动学模型和参数化的待生成轨迹设置轨迹优化模型约束条件、设定目标函数以及优化变量,并根据汽车的纵向速度、横摆角速度、质心侧偏角、前轮转向角,以及汽车前方障碍物距离、速度、加速度对其进行求解,得到轨迹优化模型:
1)约束条件:
设在初始时刻t0车辆A的状态为在终了时刻tf车辆A的状态为并且所设计轨迹为(xd(t),yd(t))。然后,根据车辆运动学模型(1),施加在所设计轨迹上的等式约束条件如下:
将轨迹方程(2)代入到等式约束条件(3)中,并将其化为矩阵形式,其系数可以由以下方程来确定:
其中,
且
将方程(4)代入到轨迹方程(2)可以得到轨迹方程的进一步表达式:
其中P=[1tt2t3t4t5]。
为了实现避碰的要求,还需要满足一些不等式约束条件:
(R0+R1)2≤[xd(t)-x0-vx(t-t0)]2+[yd(t)-y0-vy(t-t0)]2
(6)
其中,R0为汽车长度的一半,R1为与障碍物宽度的一半;
将方程(5)代入到(6)中可以得到进一步的表达式:
(R0+R1)2≤[PL-1(H1-Mxd6-Nxd7)+xd6t6+xd7t7-x0-vx(t-t0)]2
+[PL-1(H2-Myd6-Nyd7)+yd6t6+yd7t7-y0-vy(t-t0)]2(7)
2)目标函数,一般来说,在智能汽车主动避撞的过程中,所规划轨迹必须满足一些条件,例如,在保证车辆稳定性的同时有效地避开障碍物,基于这样的考虑,选择以下函数作为优化的目标函数:
其中,w1和w2是权重系数,且w1+w2=1;ay是汽车侧向加速度;;
3)优化变量,从方程(5)中很容易看到,待优化的变量为:xd6、xd7、yd6、yd7。
步骤7、基于动态粒子群优化算法,对所建立的轨迹优化模型进行求解,以得到所需轨迹:
粒子群优化算法,又称微粒群算法,其基于粒子构成的群体,针对每个优化问题的解都是寻找其可行空间中的一个粒子。为了让粒子能在全局范围内搜索并保持粒子的多样性,本实用新型采用动态粒子群算法(dynamicParticleSwarmOptimization,DPSO)对轨迹优化模型进行优化。
如果粒子群的D维空间位置向量为xi=(xi1,xi2,...,xiD),每个xi表示解空间中一个潜在的可行解,可根据目标函数计算出的适应值来判断其是否为最优解。第i个粒子的D维空间速度向量为vi=(vi1,vi2,...,viD),第i个粒子个体最优位置Pi=(Pi1,Pi2,...,PiD),粒子群群体最优位置Li=(Li1,Li2,...,LiD),粒子群群体全局最优位置G=(G1,G2,...,GD)迭代公式如下:
vi(t+1)=ωvit+b1r1(pi(t)-xi(t))+b2r2(Li(t)-xi(t))+b2r3(G(t)-xi(t))(9)
式中:b1、b2、b3为正常数;r1、r2、r3为[0,1]内的随机数;参数ω为惯性因子。
设ω依据循环次数从ωs线性递减至ωe,最大循环次数为Imax,循环的当前次数为Ic,则ω的值可以通过下式得出:
式中:ωs为优化最初的惯性因子;ωe为优化结束的惯性因子。
粒子群中粒子在t+1时刻的位置通过下式求出:
xi(t+1)=xi(t)+vi(t+1)(11)
如果粒子群更新为之后超越了定义域界限,则需要重新调整粒子的位置,使其落在决策空间内,新位置可按照下式计算:
xi(t+1)=xi(t)+λvi(t+1)(12)
λ=2/(γ2+2)(13)
式中:λ为速度调整系数,其介于(0,1)之间;γ为调整次数,当γ大于3时,粒子速度变为反向。
粒子i和k之间的距离||xi-xk||可以通过下式求得:
式中:d为决策变量的维数。
动态粒子群的生成:如果已生成m个粒子群,假设与粒子群a最近的粒子群为b,如果他们之间的距离大于Dmax,则需要生成一个粒子群xm+1,群内第i个粒子第k维分量可以由下式求得:
式中:C1、C2为[0,1]内的随机数;round(·)为取整函数,因此,round(0.5+C2)为0或1。
步骤8、ECU将所生成轨迹的相关参数输出到油门控制器、转向控制器、制动控制器,并执行相应操作,以精确跟踪所生成轨迹。
步骤9、跳转到步骤4,进行下一时刻的轨迹求解与跟踪,如此循环,直至规划结束,完成整个避撞过程,如图2所示。
本技术领域技术人员可以理解的是,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本实用新型所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
以上所述的具体实施方式,对本实用新型的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本实用新型的具体实施方式而已,并不用于限制本实用新型,凡在本实用新型的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本实用新型的保护范围之内。
Claims (1)
1.一种汽车主动避撞***,其特征在于,包含前视雷达、摄像头、信号处理模块、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、电子控制电源ECU、油门控制器、转向控制器和制动控制器;
所述前视雷达、摄像头通过信号处理模块和所述电子控制电源ECU相连;所述电子控制电源ECU分别和、车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器、油门控制器、转向控制器、制动控制器相连;
所述前视雷达与摄像头均安装在汽车前方,用于检测汽车前方的道路情况,并将所测得的信号经信号处理模块处理后传递给所述电子控制单元ECU;
所述车速传感器、横摆角速度传感器、质心侧偏角传感器、方向盘转角传感器分别用于感应汽车的速度、横摆角速度、质心侧偏角和前轮转向角,并将采集到的信号经处理后送入到电子控制单元ECU;
所述电子控制单元ECU用于根据接收到的信号输出相应的信号到油门控制器、转向控制器、制动控制器,进行相应加速、减速、制动操作,以保证行车安全。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201620037056.9U CN205396080U (zh) | 2016-01-14 | 2016-01-14 | 一种汽车主动避撞*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201620037056.9U CN205396080U (zh) | 2016-01-14 | 2016-01-14 | 一种汽车主动避撞*** |
Publications (1)
Publication Number | Publication Date |
---|---|
CN205396080U true CN205396080U (zh) | 2016-07-27 |
Family
ID=56450756
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201620037056.9U Expired - Fee Related CN205396080U (zh) | 2016-01-14 | 2016-01-14 | 一种汽车主动避撞*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN205396080U (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105691388A (zh) * | 2016-01-14 | 2016-06-22 | 南京航空航天大学 | 一种汽车主动避撞***及其轨迹规划方法 |
CN108859998A (zh) * | 2018-06-14 | 2018-11-23 | 辽宁工业大学 | 一种前车防追尾装置及其控制方法 |
CN109017975A (zh) * | 2018-07-02 | 2018-12-18 | 南京航空航天大学 | 一种智能转向***的控制方法及其控制*** |
CN110293977A (zh) * | 2019-07-03 | 2019-10-01 | 北京百度网讯科技有限公司 | 用于显示增强现实警示信息的方法和装置 |
CN110703754A (zh) * | 2019-10-17 | 2020-01-17 | 南京航空航天大学 | 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法 |
-
2016
- 2016-01-14 CN CN201620037056.9U patent/CN205396080U/zh not_active Expired - Fee Related
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105691388A (zh) * | 2016-01-14 | 2016-06-22 | 南京航空航天大学 | 一种汽车主动避撞***及其轨迹规划方法 |
CN108859998A (zh) * | 2018-06-14 | 2018-11-23 | 辽宁工业大学 | 一种前车防追尾装置及其控制方法 |
CN109017975A (zh) * | 2018-07-02 | 2018-12-18 | 南京航空航天大学 | 一种智能转向***的控制方法及其控制*** |
CN110293977A (zh) * | 2019-07-03 | 2019-10-01 | 北京百度网讯科技有限公司 | 用于显示增强现实警示信息的方法和装置 |
CN110703754A (zh) * | 2019-10-17 | 2020-01-17 | 南京航空航天大学 | 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法 |
CN110703754B (zh) * | 2019-10-17 | 2021-07-09 | 南京航空航天大学 | 一种自动驾驶车辆路径与速度高度耦合的轨迹规划方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105691388B (zh) | 一种汽车主动避撞***及其轨迹规划方法 | |
CN205396080U (zh) | 一种汽车主动避撞*** | |
Hamid et al. | Autonomous emergency braking system with potential field risk assessment for frontal collision mitigation | |
Polack et al. | The kinematic bicycle model: A consistent model for planning feasible trajectories for autonomous vehicles? | |
Ferrara et al. | Second order sliding mode control of vehicles with distributed collision avoidance capabilities | |
Yi et al. | Real time integrated vehicle dynamics control and trajectory planning with MPC for critical maneuvers | |
CN109334564B (zh) | 一种防碰撞的汽车主动安全预警*** | |
CN107065567A (zh) | 一种基于自适应神经网络约束控制的自动停车控制*** | |
Huang et al. | Model predictive control-based lane change control system for an autonomous vehicle | |
Chen et al. | Human–machine shared control for lane departure assistance based on hybrid system theory | |
CN113619574A (zh) | 一种车辆避让方法、装置、计算机设备和存储介质 | |
Sabry et al. | Fuzzy control of autonomous intelligent vehicles for collision avoidance using integrated dynamics | |
Xu et al. | Design and implementation of driving control system for autonomous vehicle | |
Ao et al. | Robust active post-impact motion control for restraining a second crash | |
Chen et al. | Lane keeping control for autonomous 4WS4WD vehicles subject to wheel slip constraint | |
Yue et al. | Automated hazard escaping trajectory planning/tracking control framework for vehicles subject to tire blowout on expressway | |
Choi et al. | Emergency driving support algorithm with steering torque overlay and differential braking | |
Zhong et al. | Optimal lane change control of intelligent vehicle based on MPC | |
Zhang et al. | Minimum time lane changing problem of vehicle handling inverse dynamics considering the driver’s intention | |
Lundahl et al. | Towards lane-keeping electronic stability control for road-vehicles | |
Nguyen et al. | Takagi-sugeno model-based steering control for autonomous vehicles with actuator saturation | |
Li et al. | Spatial-based predictive control for vehicle collision avoidance by steering maneuvers | |
Rahim et al. | A longitudinal speed controller for autonomous multi-trailer articulated heavy vehicles | |
Gordon et al. | A flexible hierarchical control method for optimal collision avoidance | |
Zheng et al. | Model predictive control for intelligent vehicle lane change |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160727 Termination date: 20190114 |
|
CF01 | Termination of patent right due to non-payment of annual fee |