CN112937545B - 一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 - Google Patents
一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 Download PDFInfo
- Publication number
- CN112937545B CN112937545B CN202110305005.5A CN202110305005A CN112937545B CN 112937545 B CN112937545 B CN 112937545B CN 202110305005 A CN202110305005 A CN 202110305005A CN 112937545 B CN112937545 B CN 112937545B
- Authority
- CN
- China
- Prior art keywords
- steering
- driver
- torque
- control
- vehicle
- 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
- 230000010485 coping Effects 0.000 title claims abstract description 8
- 230000033001 locomotion Effects 0.000 claims abstract description 54
- 230000004044 response Effects 0.000 claims abstract description 9
- 238000013461 design Methods 0.000 claims abstract description 3
- 230000001133 acceleration Effects 0.000 claims description 22
- 230000006870 function Effects 0.000 claims description 19
- 230000008859 change Effects 0.000 claims description 12
- 230000005540 biological transmission Effects 0.000 claims description 9
- 230000036962 time dependent Effects 0.000 claims description 4
- 238000013016 damping Methods 0.000 claims description 3
- 230000006866 deterioration Effects 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 3
- 230000004907 flux Effects 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 230000006399 behavior Effects 0.000 abstract description 2
- 238000010586 diagram Methods 0.000 description 4
- 238000004891 communication Methods 0.000 description 3
- 238000005516 engineering process Methods 0.000 description 3
- 238000011217 control strategy Methods 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 230000003321 amplification Effects 0.000 description 1
- 230000009286 beneficial effect Effects 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
- 238000003199 nucleic acid amplification method Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
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/14—Adaptive cruise control
-
- 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
- B60W10/00—Conjoint control of vehicle sub-units of different type or different function
- B60W10/20—Conjoint control of vehicle sub-units of different type or different function including control of steering systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D6/00—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits
Landscapes
- Engineering & Computer Science (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明公开了一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法,包括:车辆信号模块,自动驾驶控制器、转向系统、转向轮。车辆信号模块提供车辆运行状态的必要信息,自动驾驶控制器根据自动驾驶功能的要求,将相关指令发送给转向系统以驱动转向轮;转向系统通过算法判断驾驶员对于车辆运行的干扰行为,根据干扰和危害程度的不同,设计自适应转向干扰控制率,控制转向执行单元抑制和消除驾驶员转向干扰,保证车辆横向运动的稳定性。该控制系统响应快,能够实时保证转向系统对自动驾驶要求的精确跟随,能够有效增强自动驾驶横向控制安全。
Description
技术领域
本发明涉及自动驾驶车辆转向系统领域,特别是涉及一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法。
背景技术
自动驾驶技术的发展对于汽车产业具有里程碑式的意义,人们期待利用车辆的智能传感技术和控制设备提高道路交通的安全性,进一步提高驾驶的舒适性。然而自动驾驶也在颠覆一些传统的技术观念,例如,传统的汽车的主导是驾驶员,车辆的控制权完全由驾驶员决定,从功能安全要求的角度来看,任何违背驾驶员意图的操作都是有害的。
然而,人机共驾的格局会在L3,L4自动驾驶的智能汽车系统里面长期存在;在大多数的驾驶场景下,驾驶的主体会在智能汽车和驾驶员之间切换。在智能汽车为主导的驾驶工况下,驾驶员的角色转换为乘员,在某些情况下,驾驶员的操作与智能汽车的控制会有冲突,因此必须要有技术能够解耦驾驶员/乘员对智能汽车转向控制的影响,保证横向控制的时效性;特别是基于预期功能安全的极端场景下,横向控制的感知,判断,决策,执行的时间需要控制在毫秒级。现在大部分的研究都是把转向系统作为执行器,决策及控制在转向系统的上位机,人机共驾情况下横向控制系统信息传递链比较复杂。
因此,如何合理地控制,预防驾驶员干扰对于智能汽车在自动驾驶过程中的横向动态的影响是非常具有现实安全意义的。
发明内容
为解决上述技术问题,本发明提供一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法;在自动驾驶车辆行驶过程中,利用转向系统系统信息、车辆状态和自动驾驶控制信息,通过算法判断驾驶员对于车辆运行的干扰行为,根据干扰和危害程度的不同,设计自适应转向干扰控制率,控制转向执行单元抑制和消除驾驶员转向干扰,保证车辆横向运动的稳定性。
本发明提出了一种应对驾驶员干扰的自动驾驶汽车转向控制系统,包括:车辆信号模块,自动驾驶控制器、转向系统、转向轮。
所述的车辆信号模块提供车辆运行状态的必要信息,包括车速、横摆角速度、纵向加速度、侧向加速度等;车速是表征车辆运行速度的特征信号,横摆角速度是表征车辆稳定程度的特征信号,纵向加速度是表征车辆前进方向的速度变化,侧向加速度是表征车辆前进时侧向方向的速度变化;
所述的自动驾驶控制器根据自动驾驶功能的要求,将需要转向系统响应的输出轴转角指令发送给横向运动控制器;
所述的转向系统包括转向方向盘、扭矩传感器单元、转角传感器单元、横向运动控制器、电机、助力器、输出轴、齿轮齿条;
转向方向盘用于获取驾驶员输入,以便驾驶员的输入转换为操纵扭矩,并将扭矩传递到扭矩传感器单元;
扭矩传感器单元将转向方向盘传递的扭矩转换为电信号,并将该扭矩信号实时传递给横向运动控制器;
转角传感器单元将转向方向盘转动的角度转换为电信号,并将该角度信号实时传递给横向运动控制器;
电机、助力器、输出轴、齿轮齿条组成转向系统执行单元、其功能是将横向运动控制器的控制指令转换为电机的扭矩,并通过助力器的放大,经过输出轴的转移,带动齿轮齿条的运动。
所述的转向轮被齿条驱动,实现车辆的横向运动。
上述方案中,所述的横向运动控制器接收扭矩传感器单元、转角传感器单元、自动驾驶控制器、车速、横摆角速度、纵向加速度、侧向加速度信号、根据实时情况的变化,计算出合适的控制指令,驱动转向系统执行单元完成车辆的横向需要。
上述方案中,转向系统的机械连接顺序为,转向方向盘通过扭矩传感器单元和转角传感器单元转向力矩输入到输出轴,再到齿轮齿条,最后驱动转向轮;另外并联传递路径为横向运动控制器控制电机扭矩,通过助力器放大电机扭矩,传递到输出轴,再到齿轮齿条,然后驱动转向轮。
上述方案中,横向运动控制器包括:横向运动控制模块、转向扭矩控制模块、扩张状态观测模块。
所述的横向运动控制模块根据转向角度请求和扩张状态观测模块输出的控制偏差,生成控制律保证转向角度响应的精准性;
所述的转向扭矩控制模块是根据电机实际工作电流计算出电机扭矩,并且对扭矩值进行实时的监测;
所述的扩张状态观测模块,通过接收实际输出轴角度和电机控制电流,建立对于驾驶员干扰的控制观测量。
上述方案中,转向角度请求和输出轴角度都基于转向系统中的转角传感器单元信号得到。
本发明还提出了一种基于上述应对驾驶员干扰的自动驾驶汽车转向控制系统的控制方法,包括如下工作模式:
1)手动驾驶阶段
转向系统根据驾驶员输入作为横向控制的期望目标,其中驾驶员输入力矩传递到转向方向盘,通过扭矩传感器单元监测,并发送信号传递到横向运动控制器,横向运动控制器根据助力扭矩请求,从而驱动转向系统执行单元,分配合适的横向位移,以精确控制转向轮。
2)自动驾驶模式阶段
横向运动控制器接收自动驾驶控制器的指令,然后驱动转向系统执行单元,在自动驾驶模式中,由于转向方向盘与转向系统执行单元通过机械相连接,因此驾驶员输入将视为对自动驾驶动态过程的干扰。
自动驾驶模式阶段,横向运动控制器仍将接收扭矩传感器单元信号,但是不作为执行指令,仅仅是驾驶员干扰的判断输入。
在自动驾驶模式,驾驶员干扰程度的判断,需要根据当前车辆的动态特征,其动态特征的定义为计算指标Da=∑(k1V,k2Ya,k3Llog,k4Llat),其中k1,k2,k3,k4为可标定系数,根据车辆情况设定,其一般范围:k1为0.1~0.2,k2为1~2,k3为0.5~1,k4为0.5~1;V,Ya,Llog,Llat分别为车速、横摆角速度、纵向加速度、侧向加速度;当动态特征指标Da大于门限值D0时,且扭矩传感器信号值大于设定值,驾驶员干扰条件成立。
当判断驾驶员干扰成立,转向系统为了保证响应自动驾驶控制器的指令,需要对驾驶员的转向干扰进行抑制和消除,以保证转向执行系统输出的精确性,其中主要的目标是系统输出的转向输出轴角度θs跟随自动驾驶控制器的指令需求,不受驾驶员施加在转向方向盘的力矩干扰造成转向角度偏差。
在本发明一个较佳实施例中,自动驾驶控制器将转向角度请求发送给横向运动控制器,控制器中的扩张状态观测模块接收电机控制电流和输出轴实际输出角度,计算出观测偏差量,以便于在横向运动控制模块中补偿,这个补偿值即为控制律。横向运动控制模块根据扩张状态观测模块的输入,分配电机控制电流,从而控制电机输出扭矩,加上驾驶员的干扰力矩,最终输出到转向输出轴,并且产生实际的转向角度。
对于转向系统根据自动驾驶车辆转向需求建立基于输出轴的动力学方程:
其中Js为转向系统等效转动惯量,Bs为转向系统等效阻尼,θs为转向轴角度,Ta为助力扭矩,Tr为负载扭矩;
其中Tm为助力电机输出扭矩,Ga为助力器传动比,为传动效率;
其中Pn为电机极对数,ψf为电机转子磁链,iq为电机定子Q轴电流;
当驾驶员在自动驾驶工况下,干预转向方向盘时,修正的转向动力学方程为:
其中TI为驾驶员作用在方向盘的干扰力矩;
根据实际情况需要,可以将自动驾驶控制器目标转角与输出轴角度θs的基准设为一致,从而更好抑制消除驾驶员输入的干扰。
根据以上1.1,1.2,1.3,2.1的转向系统动力学方程,可以推导出系统输出的转向角度θs和电机输入控制电流i(t)之间关系为:
其中i(t)为电机定子Q轴电流iq随时间变化的函数,θ(t)是输出轴角度θs随时间变化的函数。
则转向系统应对驾驶员干预的系统可以描述为如下二阶系统:
其中x1=θ(t),
考虑到转向系统的机械变差和路面的变化,将驾驶员的随机干扰和转向系统的扰动当作一个新的状态变量:
x3(t)=F(x1,x2,TI(t),t)
加入原二阶系统中,得到新的状态方程:
对以上状态方程系统建立状态观测器:
其中,
ε1为状态观测器与输出轴角度跟踪误差,z1为x1的跟踪值,z2为x2的跟踪值,z3为3的跟踪值,β01,和fal(ε1,α2,δ)为非线性函数,δ为误差限值。
其中,参数α1和α2为可标定量,取值范围为2~10,根据车辆状态进行设置,得到最终的控制律为:
其中i(t0)为电机定子Q轴初始电流。
即转向系统根据自动驾驶控制器的角度请求,在驾驶员干扰情况下,通过设定的控制律,将干扰抑制消除。
本发明的有益效果:
1、本发明利用转向系统抑制驾驶员的干扰输入,能够有效增强自动驾驶横向控制安全。
2、本发明在不增加硬件成本的前提下,利用系统控制策略提升驾驶安全性,具有很好的社会经济效益。
3、本发明基于已有转向系统的系统架构,能够同时支持自动驾驶和非自动驾驶,具有很好的适应性。
4.本发明除了可以抑制驾驶员干扰,同样可以抑制类似的外界环境干扰,能够提高自动驾驶车辆横向稳定性。
附图说明
图1是本发明一种应对驾驶员干扰的自动驾驶汽车转向控制系统结构示意图;
图2为车辆信号模块示意图;
图3为转向系统结构示意图
图4为横向运动控制器信号控制示意图
图5为应对驾驶员干扰的逻辑原理示意图;
具体实施方式
下面结合附图对本发明作进一步说明。
如图1所示,一种应对驾驶员干扰的自动驾驶汽车转向控制系统,包括:车辆信号模块,自动驾驶控制器、转向系统、转向轮。
车辆信号模块如图2所示,主要是提供车辆运行的动态变化,主要参数包括车速、横摆角速度、纵向加速度、侧向加速度;相关参数可以来自于ESC系统或者车身其他系统,需要经过整车标定,并且通过车辆CAN通讯接口发送信号;
自动驾驶控制器是车辆上自动驾驶功能的控制器,根据整车的功能定义,实现不同的自动驾驶功能,并且将整车的动态行驶要求分解到转向系统的控制指令,即转向系统需要响应的转向角度,指令信号的发出可以通过CAN通讯。
转向系统如图3所示,可以是管柱式,齿条式或者小齿轮助力式,为了方便理解,以管柱式助力电动转向系统为例,主要包括转向方向盘、扭矩传感器单元、转角传感器单元、横向运动控制器、电机、助力器、输出轴、齿轮齿条;上述方案中,转向系统的机械连接顺序为,转向方向盘通过扭矩传感器单元和转角传感器单元转向力矩输入到输出轴,再到齿轮齿条,最后驱动转向轮;另外并联传递路径为横向运动控制器控制电机扭矩,通过助力器放大电机扭矩,传递到输出轴,再到齿轮齿条,然后驱动转向轮。
转向方向盘用于获取驾驶员输入,以便驾驶员的输入转换为操纵扭矩,并将扭矩传递到扭矩传感器单元;扭矩传感器单元将转向方向盘传递的扭矩转换为电信号,并将该扭矩信号实时传递给横向运动控制器。信号类型可以是数字信号或者模拟量信号;转角传感器单元将转向方向盘转动的角度转换为电信号,并将该角度信号实时传递给横向运动控制器,信号类型可以是数字信号或者CAN通讯信号;通常情况下,扭矩传感器单元和角度传感器单元可以集成为一个总成部件,也可以作为独立部件,不会影响系统的功能。
电机、助力器、输出轴、齿轮齿条组成转向系统执行单元、其功能是将横向运动控制器的控制指令转换为电机的扭矩,并通过助力器的放大,经过输出轴的转移,带动齿轮齿条的运动;电机可以是有刷电机或者永磁同步电机,本例中以永磁同步电机为例,助力器的助力比例可以根据车辆的需要改变,一般为20左右。
转向轮与转向系统的齿条通过拉杆连接,将齿条的移动转化为转向轮的角度变化,实现车辆的横向运动。
如图4所示,转向系统中的横向运动控制器接收扭矩传感器单元、转角传感器单元、自动驾驶控制器、车速、横摆角速度、纵向加速度、侧向加速度信号、根据自动驾驶功能、驾驶员输入、外界情况的变化,计算出合适的控制指令,通过控制器上的电路设计,驱动电机产生力矩,通过助力器放大力矩,驱动输出轴,齿轮齿条,最后完成车辆的横向运动的需要。
横向运动控制器是转向系统软件和控制算法的载体,集成了本发明的控制策略,主要包括:横向运动控制模块、转向扭矩控制、扩张状态观测模块。
横向运动控制模块根据转向角度请求和扩张状态观测模块输出的控制偏差,生成控制律保证转向角度响应的精准性;转向扭矩控制是根据电机实际工作电流计算出电机扭矩,并且对扭矩值进行实时的监测;扩张状态观测模块,通过接收实际输出轴角度和电机控制电流,建立对于驾驶员干扰的控制观测量。其中,转向角度请求和输出轴角度都基于转向系统中的转角传感器单元信号。
一种应对驾驶员干扰的自动驾驶汽车转向控制方法,包括非自动驾驶模式下驾驶员手动驾驶模式和自动驾驶模式下的自动转向工作模式;
在手动驾驶阶段,转向系统根据驾驶员输入作为横向控制的期望目标,其中驾驶员输入力矩传递到转向方向盘,通过扭矩传感器单元监测,并发送信号传递到横向运动控制器,横向运动控制器根据助力扭矩请求,从而驱动转向系统执行单元,分配合适的横向位移,以精确控制转向轮。
自动驾驶模式阶段,横向运动控制器接收自动驾驶控制器的指令,然后驱动转向系统执行单元,在自动驾驶模式中,由于转向方向盘与转向系统执行单元通过机械相连接,因此驾驶员输入将视为对自动驾驶动态过程的干扰。自动驾驶模式阶段,横向运动控制器仍将接收扭矩传感器单元信号,但是不作为执行指令,仅仅是驾驶员干扰的判断输入。
在自动驾驶模式,驾驶员干扰程度的判断,需要根据当前车辆的动态特征,其动态特征的定义为计算指标Da=∑(k1V,k2Ya,k3Llog,k4Llat),其中k1,k2,k3,k4为可标定系数,根据车辆情况设定;V,Ya,Llog,Llat分别为车速、横摆角速度、纵向加速度、侧向加速度;当动态特征指标Da大于门限值D0时,且扭矩传感器信号值大于设定值,驾驶员干扰条件成立。
当判断驾驶员干扰成立,转向系统为了保证响应自动驾驶控制器的指令,需要对驾驶员的转向干扰进行抑制和消除,以保证转向执行系统输出的精确性,其中主要的目标是系统输出的转向输出轴角度θs跟随自动驾驶控制器的指令需求,不受驾驶员施加在转向方向盘的力矩干扰造成转向角度偏差。
如图5所示,自动驾驶控制器将转向角度请求发送给横向运动控制器,控制器中的扩张状态观测模块接收电流控制电流和输出轴实际输出角度,计算出观测偏差量,以便于在横向运动控制模块中补偿,这个补偿值即为控制律。横向运动控制模块根据扩张状态观测模块的输入,分配电机控制电流,从而控制电机输出扭矩,加上驾驶员的干扰力矩,最终输出到转向输出轴,并且产生实际的转向角度。
在本发明一个较佳实施例中,对于转向系统根据自动驾驶车辆转向需求建立基于输出轴的动力学方程:
其中Js为转向系统等效转动惯量,Bs为转向系统等效阻尼,θs为转向轴角度,Ta为助力扭矩,Tr为负载扭矩;
其中Tm为助力电机输出扭矩,Ga为助力器传动比,为传动效率;
其中Pn为电机极对数,ψf为电机转子磁链,iq为定子Q轴电流;
以上方程的建立是基于电机工作状态下转向系统的基本状态,以电机控制电流为控制量和输出轴角度为输出量。
在自动驾驶工况下,当驾驶员干预转向方向盘时,修正的转向动力学方程为:
其中TI为驾驶员作用在方向盘的干扰力矩;
根据实际情况需要,可以将自动驾驶控制器目标转角与输出轴角度θs的基准设为一致,从而更好抑制消除驾驶员输入的干扰。
综合上述的方程组,可以推导出系统输出的输出轴角度θs和输入控制电流i(t)之间关系为:
其中i(t)为电机定子Q轴电流随时间变化的函数,θ(t)是输出轴角度随时间变化的函数。
则转向系统应对驾驶员干预的系统可以描述为如下二阶系统:
其中x1=θ(t),
考虑到转向系统的机械变差和路面的变化,将驾驶员的随机干扰和转向系统的扰动当作一个新的状态变量:
x3(t)=F(x1,x2,TI(t),t)
加入原二阶系统中,得到新的状态方程:
对以上状态方程系统建立状态观测器:
其中fal(ε1,α1,δ)和fal(ε1,α2,δ)为非线性函数
其中,参数α1和α2为可标定量,根据车辆状态进行设置,得到最终的控制律为:
其中i(t0)为电机定子Q轴初始电流。
将上述控制律集成到转向系统的横向运动控制器,即将驾驶员干扰抑制和消除。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,它们并非用以限制本发明的保护范围,凡未脱离本发明技术所创的等效方式或变更均应包含在本发明的保护范围之内。
Claims (8)
1.一种应对驾驶员干扰的自动驾驶汽车转向控制系统,其特征在于,包括:车辆信号模块、自动驾驶控制器、转向系统、转向轮;
所述的车辆信号模块用于采集车辆运行状态信息,包括车速、横摆角速度、纵向加速度、侧向加速度;车速是表征车辆运行速度的特征信号,横摆角速度是表征车辆稳定程度的特征信号,纵向加速度是表征车辆前进方向的速度变化,侧向加速度是表征车辆前进时侧向方向的速度变化;
所述的自动驾驶控制器根据自动驾驶功能的要求,将与转向系统的相关指令发送给转向系统内的横向运动控制器;
所述的转向系统包括转向方向盘、扭矩传感器单元、转角传感器单元、横向运动控制器、电机、助力器、输出轴、齿轮齿条;
转向方向盘用于获取驾驶员输入,以便驾驶员的输入转换为操纵扭矩,并将扭矩传递到扭矩传感器单元;
扭矩传感器单元将转向方向盘传递的扭矩转换为电信号,并将该扭矩的电信号实时传递给横向运动控制器;
转角传感器单元将转向方向盘转动的角度转换为电信号,并将该角度的电信号实时传递给横向运动控制器;
电机、助力器、输出轴、齿轮齿条组成转向系统执行单元,其功能是将横向运动控制器的控制指令转换为电机的扭矩,并通过助力器的放大,经过输出轴的转移,带动齿轮齿条的运动;
所述的转向轮由所述齿轮齿条驱动,实现车辆的横向运动;
所述的横向运动控制器接收扭矩传感器单元、转角传感器单元、自动驾驶控制器、车速、横摆角速度、纵向加速度、侧向加速度的信号,根据实时情况的变化,计算出合适的控制指令,驱动转向系统完成车辆的横向需要;
所述横向运动控制器包括:横向运动控制模块、转向扭矩控制模块、扩张状态观测模块;
所述的横向运动控制模块根据转向角度请求和扩张状态观测模块输出的控制偏差,生成控制律保证转向角度响应的精准性;
所述的转向扭矩控制模块是根据电机实际工作电流计算出电机扭矩,并且对扭矩值进行实时的监测;
所述的扩张状态观测模块,通过接收实际输出轴角度和电机控制电流,建立对于驾驶员干扰的控制观测量。
2.根据权利要求1所述的一种应对驾驶员干扰的自动驾驶汽车转向控制系统,其特征在于,所述的转向角度请求和输出轴角度都基于转向系统中的转角传感器单元的信号得到。
3.根据权利要求1所述的一种应对驾驶员干扰的自动驾驶汽车转向控制系统,其特征在于,所述的转向系统的机械驱动关系为:一方面,转向方向盘通过扭矩传感器单元和转角传感器单元将转向力矩输入到输出轴,再到齿轮齿条,最后驱动转向轮;另一方面,转向方向盘通过扭矩传感器单元并联传递至横向运动控制器控制电机扭矩,通过助力器放大电机扭矩,传递到输出轴,再到齿轮齿条,然后驱动转向轮。
4.根据权利要求1所述的一种应对驾驶员干扰的自动驾驶汽车转向控制系统的一种应对驾驶员干扰的自动驾驶汽车转向控制方法,其特征在于,
在自动驾驶模式时,首先进行驾驶员干扰判断:根据当前车辆的动态特征指标Da,当动态特征指标Da大于门限值D0时,且扭矩传感器单元的信号值大于设定值,驾驶员干扰条件成立;其动态特征的定义为计算指标Da=∑(k1V,k2Ya,k3Llog,k4Llat),其中k1,k2,k3,k4为可标定系数,根据车辆情况设定;V,Ya,Llog,Llat分别为车速、横摆角速度、纵向加速度、侧向加速度;
当判断驾驶员干扰成立之后,自动驾驶控制器将转向角度请求发送给横向运动控制器,控制器中的扩张状态观测模块接收电机控制电流和输出轴角度,计算出观测偏差量,以便于在横向运动控制模块中补偿,这个补偿值即为控制律;横向运动控制模块根据扩张状态观测模块的输入,分配电机控制电流,从而控制电机输出扭矩,加上驾驶员的干扰力矩,最终输出到转向输出轴,并且产生实际的转向角度。
5.根据权利要求4所述的一种应对驾驶员干扰的自动驾驶汽车转向控制方法,其特征在于,所述控制律的设计方法包括:
对于转向系统根据自动驾驶车辆转向需求建立基于输出轴的动力学方程:
1.1:
其中Js为转向系统等效转动惯量,Bs为转向系统等效阻尼,θs为输出轴角度,Ta为助力扭矩,Tr为负载扭矩;
1.2:
其中Tm为助力电机输出扭矩,Ga为助力器传动比,为传动效率;
1.3:
其中Pn为电机极对数,ψf为电机转子磁链,iq为电机定子Q轴电流。
6.根据权利要求5所述的一种应对驾驶员干扰的自动驾驶汽车转向控制方法,其特征在于,所述控制律的设计还包括:当驾驶员在自动驾驶工况下,干预转向方向盘时,修正的转向动力学方程为:
2.1:
其中TI为驾驶员作用在方向盘的干扰力矩;
根据实际情况需要,将自动驾驶控制器目标转角与输出轴角度θs的基准设为一致,从而更好抑制消除驾驶员输入的干扰;
根据以上1.1,1.2,1.3,2.1的转向系统动力学方程,推导出系统输出的输出轴角度和电机控制电流之间关系为:
其中i(t)为电机定子Q轴电流iq随时间变化的函数,θ(t)是输出轴角度θs随时间变化的函数。
7.根据权利要求6所述的一种应对驾驶员干扰的自动驾驶汽车转向控制方法,其特征在于,所述控制律的设计还包括:
将转向系统应对驾驶员干预的系统描述为如下二阶系统方程:
其中x1=θ(t),考虑到转向系统的机械变差和路面的变化,将驾驶员的随机干扰和转向系统的扰动当作一个新的状态变量:
x3(t)=F(x1,x2,TI(t),t)
加入原二阶系统中,得到新的状态方程:
对以上状态方程对应的系统建立状态观测器:
其中fal(ε1,α1,δ)和fal(ε1,α2,δ)为非线性函数
其中,参数α1和α2为可标定量,根据车辆状态进行设置,得到最终的控制律为:
其中i(t0)为电机定子Q轴初始电流。
8.根据权利要求4所述的一种应对驾驶员干扰的自动驾驶汽车转向控制方法,其特征在于,所述控制方法还包括:
在手动驾驶模式时,转向系统根据驾驶员输入作为横向控制的期望目标,其中驾驶员输入力矩传递到转向方向盘,通过扭矩传感器单元监测,并发送信号传递到横向运动控制器,横向运动控制器根据助力扭矩请求,从而驱动转向系统执行单元,分配合适的横向位移,以精确控制转向轮。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110305005.5A CN112937545B (zh) | 2021-03-18 | 2021-03-18 | 一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110305005.5A CN112937545B (zh) | 2021-03-18 | 2021-03-18 | 一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112937545A CN112937545A (zh) | 2021-06-11 |
CN112937545B true CN112937545B (zh) | 2024-07-12 |
Family
ID=76227884
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110305005.5A Active CN112937545B (zh) | 2021-03-18 | 2021-03-18 | 一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112937545B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114348112B (zh) * | 2021-12-27 | 2022-11-22 | 博世华域转向系统有限公司 | 一种适用于半自动驾驶场景的汽车转向控制方法 |
CN114987220B (zh) * | 2022-05-07 | 2024-11-01 | 苏州朗高电机有限公司 | 一种新能源汽车抑制驾乘人员晕车的控制方法 |
CN115107802B (zh) * | 2022-06-20 | 2024-07-19 | 重庆长安汽车股份有限公司 | 一种人机共驾转向控制方法、系统及汽车 |
CN115520032A (zh) * | 2022-09-30 | 2022-12-27 | 华为数字能源技术有限公司 | 一种电机控制模块的控制器、电机的控制方法及相关设备 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN209739145U (zh) * | 2018-12-29 | 2019-12-06 | 南京航空航天大学 | 基于驾驶员行为辨识的线控转向双电机系统 |
CN111674457A (zh) * | 2020-05-26 | 2020-09-18 | 南京航空航天大学 | 基于驾驶员特性的主动前轮转向系统及其控制方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3649119B2 (ja) * | 2000-12-12 | 2005-05-18 | 日産自動車株式会社 | レーンキープアシスト制御装置 |
JP5543906B2 (ja) * | 2010-12-22 | 2014-07-09 | 富士重工業株式会社 | 車両のパワーステアリング制御装置 |
WO2014122997A1 (ja) * | 2013-02-07 | 2014-08-14 | 日本精工株式会社 | 電動パワーステアリング装置 |
DE102016116292B4 (de) * | 2015-09-03 | 2019-02-14 | Steering Solutions Ip Holding Corporation | Steuerungssystem und Verfahren für eine modellbasierte Schätzung eines Fahrerdrehmoments |
GB2549328A (en) * | 2016-04-15 | 2017-10-18 | Jaguar Land Rover Ltd | Vehicle steering system |
ES2825374T3 (es) * | 2016-07-05 | 2021-05-17 | Uisee Tech Beijing Ltd | Procedimiento y sistema de control de dirección de vehículo de conducción autónoma |
JP6489135B2 (ja) * | 2017-01-13 | 2019-03-27 | トヨタ自動車株式会社 | 車両の運転支援装置 |
KR102224996B1 (ko) * | 2017-06-30 | 2021-03-10 | 현대모비스 주식회사 | 전동식 파워 스티어링 시스템의 토크 보상 장치 및 방법 |
JP7093504B2 (ja) * | 2018-04-17 | 2022-06-30 | 株式会社ジェイテクト | ドライバトルク推定装置およびそれを備えた操舵装置 |
JP2020059362A (ja) * | 2018-10-09 | 2020-04-16 | 株式会社ジェイテクト | ドライバトルク推定装置およびそれを備えた電動パワーステアリング装置 |
KR102579300B1 (ko) * | 2018-11-22 | 2023-09-18 | 현대자동차주식회사 | 자율주행차량의 조향 제어시스템 및 방법 |
CN110077458B (zh) * | 2019-03-20 | 2021-03-26 | 同济大学 | 一种基于自抗扰控制的智能车转角控制方法 |
CN110780594B (zh) * | 2019-11-22 | 2022-04-01 | 中国科学院电工研究所 | 一种智能车的路径跟踪方法及系统 |
CN111007722B (zh) * | 2019-12-18 | 2021-01-01 | 厦门大学 | 一种四轮转向自动驾驶汽车横向鲁棒容错控制系统及方法 |
CN110937020B (zh) * | 2019-12-27 | 2024-07-26 | 郑州日产汽车有限公司 | 适于自动驾驶汽车的电动转向控制系统 |
-
2021
- 2021-03-18 CN CN202110305005.5A patent/CN112937545B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN209739145U (zh) * | 2018-12-29 | 2019-12-06 | 南京航空航天大学 | 基于驾驶员行为辨识的线控转向双电机系统 |
CN111674457A (zh) * | 2020-05-26 | 2020-09-18 | 南京航空航天大学 | 基于驾驶员特性的主动前轮转向系统及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112937545A (zh) | 2021-06-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112937545B (zh) | 一种应对驾驶员干扰的自动驾驶汽车转向控制系统及方法 | |
EP3321149B1 (en) | Electric power steering device | |
EP3453592B1 (en) | Electric power steering device | |
CN110606121B (zh) | 一种线控转向路感模拟控制方法 | |
JP4293021B2 (ja) | 車両用操舵装置 | |
CN104247252B (zh) | 车辆用减振控制装置以及车辆用减振控制方法 | |
CN107848571B (zh) | 使用了电动助力转向机构的驾驶辅助控制装置 | |
EP2017161B1 (en) | Vehicle steering apparatus | |
US11964713B2 (en) | Vehicle steering device | |
EP3459823B1 (en) | Control device for electric power steering device | |
EP1731408B1 (en) | Vehicle steering apparatus | |
EP1942044A1 (en) | Controller of electric power steering device | |
US7878295B2 (en) | Vehicle steering apparatus | |
EP3632774B1 (en) | Controller for steering system and method for controlling steering system | |
CN109159816B (zh) | 一种线控四轮转向汽车及其控制方法 | |
CN111591341B (zh) | 电动助力转向装置 | |
CN110435754B (zh) | 一种电液复合转向系统的人机共驾模式切换装置及方法 | |
US20220355856A1 (en) | Vehicle steering device | |
CN209739145U (zh) | 基于驾驶员行为辨识的线控转向双电机系统 | |
JP2013544710A (ja) | ステアリングシステム調節機能により実施されるチェック方法 | |
JP2020192908A (ja) | 車両用操向装置 | |
CN118339070A (zh) | 马达控制装置 | |
CN113815718B (zh) | 一种基于三电机控制的线控汽车转向控制方法 | |
WO2023062853A1 (ja) | モータ制御装置 | |
EP4431367A1 (en) | Steering device |
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 |