CN111619666A - 一种汽车主动转向系统的摩擦补偿方法 - Google Patents
一种汽车主动转向系统的摩擦补偿方法 Download PDFInfo
- Publication number
- CN111619666A CN111619666A CN202010456756.2A CN202010456756A CN111619666A CN 111619666 A CN111619666 A CN 111619666A CN 202010456756 A CN202010456756 A CN 202010456756A CN 111619666 A CN111619666 A CN 111619666A
- Authority
- CN
- China
- Prior art keywords
- friction compensation
- current
- compensation current
- value
- gain
- 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.)
- Granted
Links
Images
Classifications
-
- 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
- B62D6/001—Arrangements for automatically controlling steering depending on driving conditions sensed and responded to, e.g. control circuits the torque NOT being among the input parameters
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
Abstract
本发明提供一种汽车主动转向系统的摩擦补偿方法，当目标角度上次历史值与当前目标角度值不相等时，主动对转向系统进行补偿，补偿反应速度快，通过查表的方式对转向系统进行补偿，不需要过多的计算，补偿周期短；利用插值法计算表格中数据之间的数值，计算过程简单，补偿范围覆盖全面；设置摩擦补偿缓降退出，使得摩擦补偿可以平顺退出，提升转向的稳定性。从而实现汽车主动转向系统在自动泊车、车道保持等功能中具有稳定性和准确性的转向功能，避免实际角度跟踪到最终目标角度的整体时间长，及跟踪过程实时性差的问题；同时简化补偿过程，提高摩擦补偿的平顺性。
Description
技术领域
本发明涉及汽车自动驾驶技术领域，具体涉及一种汽车主动转向系统的摩擦补偿方法。
背景技术
汽车主动转向系统在自动泊车、车道保持等功能中作为一种转向执行机构。在该场景下，现有技术是先根据目标角度和实际角度插值查表得到目标转速，然后通过PI控制使实际转速跟踪目标转速。在实现过程中由于系统摩擦力的存在，使得实际角度在目标角度变化一定时间后才开始变化，这一较长的响应时间影响后续实际角度跟踪目标角度的实时性，对自动泊车功能或车道保持功能的上层策略规划产生影响。所以未添加摩擦补偿的汽车主动转向控制存在以下问题：
1、实际角度跟踪到最终目标角度的整体时间长，跟踪过程的实时性差；
2、较长的响应时间使得上层路径规划不得不一直等待，一个较小角度的转向实现较为困难。
发明内容
针对现有技术中的问题，本发明提供响应时间短、摩擦补偿结束时平稳的一种汽车主动转向系统的摩擦补偿方法。
一种汽车主动转向系统的摩擦补偿方法，其特征在于，包括以下步骤：
步骤1：当目标角度上次历史值与当前目标角度值不相等时，获取车速和转速；
步骤2：根据以下车速-转速对照表获得摩擦补偿电流N；
| 车速-转速 | 0deg/s | 10deg/s | 20deg/s | e |
| 0km/h | 0A | 2.8A | 0A | 0A |
| 5km/h | 0A | 3A | 0A | 0A |
| 10km/h | 0A | 3.2A | 0A | 0A |
| … | … | … | … | … |
| (m-1)*5km/h | 0A | 2.8+0.2*(m-1) | 0A | 0A |
其中，m为正整数，e>20deg/s；当转速大于20deg/s时，摩擦补偿电流为0A；当转速大于10deg/s，同时小于20deg/s时，摩擦补偿电流N1＝{2.8+0.2*(m-1)}*(20deg/s-转速)/10deg/s；当转速大于0deg/s，同时小于10deg/s时，摩擦补偿电流N2＝{2.8+0.2*(m-1)}*转速/10deg/s；
另外，当(m-2)*5km/h<车速<(m-1)*5km/h，同时转速为10deg/s时，摩擦补偿电流N3＝{车速–(m-2)*5}/5*0.2+{2.8+0.2*(m-2)}；
步骤4：通过低通滤波器对所述摩擦补偿电流N进行滤波，从而得到摩擦补偿电流N4
步骤5：获得最终摩擦补偿电流N5＝摩擦补偿电流N4*增益，并进入步骤1；
其中所述增益通过以下角度差–增益对照表查得；
| 角度差 | 0deg | 5deg | 20deg | 90deg | 120deg | f |
| 增益 | 0 | 0 | 1 | 1 | 0 | 0 |
其中，所述目标角度上次历史值和当前目标角度值之间的差值，f>120deg；当角度差小于5deg时，增益取零；当5deg<角度差<20deg时，增益F1＝角度差/(20deg–5deg)；当20deg<角度差<90deg时，增益F2＝1；当90deg<角度差<120deg时，增益F3＝(角度差–90)/30。
进一步为：所述低通滤波器表达式为：
本次滤波输出值＝a*本次采样值+(1-a)*上次的滤波输出值；
式中a为滤波系数；滤波系数a的取值范围为[0,1]；
低通滤波器的截止频率用下式计算：
FL＝a/(2π*t)；式中t为采样间隔时间。当采样间隔t足够小的时候，滤波系数越小，滤波结果越平稳，但是灵敏度越低；滤波系数越大，灵敏度越高，但是滤波结果越不稳定。在滤波系数的实际选择中需要寻找一个平衡，即在可接受的灵敏度范围内取得尽可能好的平稳度。
进一步为：所述步骤1中，当目标角度历史值与当前目标角度值相等时，获得上次最终摩擦补偿电流N5，本次最终摩擦补偿电流N6为所述上次最终摩擦补偿电流N5的缓降输出值。
进一步为：所述上次最终摩擦补偿电流N5缓降至零的时间为10±2ms。
本发明的有益效果：当目标角度历史值与当前目标角度值不相等时，主动对转向系统进行补偿，补偿反应速度快，通过查表的方式对转向系统进行补偿，不需要过多的计算，补偿周期短；利用插值法计算表格中数据之间的数值，计算过程简单，补偿范围覆盖全面；设置摩擦补偿缓降退出，使得摩擦补偿可以平顺退出，提升转向的稳定性。
附图说明
图1为本发明的系统框图；
图2为传统方案的系统框图。
具体实施方式
下面结合附图对本发明做详细说明。下面详细描述本发明的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，仅用于解释本发明，而不能解释为对本发明的限制。
一种汽车主动转向系统的摩擦补偿方法，如图1所示，包括以下步骤：
步骤1：当目标角度上次历史值与当前目标角度值不相等时，获取车速和转速；
步骤2：根据以下车速-转速对照表获得摩擦补偿电流N；
| 车速-转速 | 0deg/s | 10deg/s | 20deg/s | e |
| 0km/h | 0A | 2.8A | 0A | 0A |
| 5km/h | 0A | 3A | 0A | 0A |
| 10km/h | 0A | 3.2A | 0A | 0A |
| … | … | … | … | … |
| (m-1)*5km/h | 0A | 2.8+0.2*(m-1) | 0A | 0A |
其中，m为正整数，e>20deg/s；当转速大于20deg/s时，摩擦补偿电流为0A；当转速大于10deg/s，同时小于20deg/s时，摩擦补偿电流N1＝{2.8+0.2*(m-1)}*(20deg/s-转速)/10deg/s；当转速大于0deg/s，同时小于10deg/s时，摩擦补偿电流N2＝{2.8+0.2*(m-1)}*转速/10deg/s；
另外，当(m-2)*5km/h<车速<(m-1)*5km/h，同时转速为10deg/s时，摩擦补偿电流N3＝{车速–(m-2)*5}/5*0.2+{2.8+0.2*(m-2)}；
步骤4：通过低通滤波器对所述摩擦补偿电流N进行滤波，从而得到摩擦补偿电流N4
步骤5：获得最终摩擦补偿电流N5＝摩擦补偿电流N4*增益，并进入步骤1；
其中所述增益通过以下角度差–增益对照表查得；
| 角度差 | 0deg | 5deg | 20deg | 90deg | 120deg | f |
| 增益 | 0 | 0 | 1 | 1 | 0 | 0 |
其中，所述目标角度上次历史值和当前目标角度值之间的差值，f>120deg；当角度差小于5deg时，增益取零；当5deg<角度差<20deg时，增益F1＝角度差/(20deg–5deg)；当20deg<角度差<90deg时，增益F2＝1；当90deg<角度差<120deg时，增益F3＝(角度差–90)/30。
其中，所述低通滤波器表达式为：
本次滤波输出值＝a*本次采样值+(1-a)*上次的滤波输出值；
式中a为滤波系数，滤波系数a的取值范围为[0,1]；
低通滤波器的截止频率用下式计算：
FL＝a/(2π*t)；式中t为采样间隔时间。
另外，所述步骤1中，当目标角度历史值与当前目标角度值相等时，获得上次最终摩擦补偿电流N5，本次最终摩擦补偿电流N6为所述上次最终摩擦补偿电流N5的缓降输出值；所述上次最终摩擦补偿电流N5缓降至零的时间为10±2ms。
如图2所示，为传统技术方案，即未添加摩擦补偿的方案。由目标角度和实际角度的差值，通过位置环Map查表可以得到目标转速。然后通过PI控制器调节实际转速跟踪目标转速，从而实现实际角度跟踪目标角度的目的。该种方案未考虑系统中固有的摩擦力，本发明是将计算得到的摩擦补偿电流值叠加到传统技术方案中的主动转向电流上。
具体的，如以下实例，对涉及的输入变量设计如下：
目标角度上次历史值：6deg
当前目标角度值：0deg
转速：10deg/s
车速：5km/h
退出缓降定时：10ms
采样间隔t：0.0024s
上次的滤波输出值：3A
低通截至频率FL：10Hz
电流-转速Map：
| 车速-转速 | 0deg/s | 10deg/s | 20deg/s |
| 0km/h | 0A | 2.8A | 0A |
| 5km/h | 0A | 4A | 0A |
| 10km/h | 0A | 4.2A | 0A |
| … | … | … | … |
增益1-角度差Map：
| 角度差 | 0deg | 5deg | 20deg | 90deg | 120deg |
| 增益1 | 0 | 0 | 1 | 1 | 0 |
摩擦补偿进入判断条件满足时，由转速和车速查电流-转速Map表并插值得到：
摩擦补偿电流Map1＝4A；
滤波系数a＝FL*2π*t＝10*2*3.14*0.0024＝0.15；
本次滤波输出值＝a*摩擦补偿电流Map1+(1-a)*上次的滤波输出值＝0.15*4+(1-0.15)*3＝3.15A
由目标角度上次历史值和当前目标角度值查增益1-角度差Map表并插值得到：
摩擦补偿电流Gain1＝0+6deg/(20deg–5deg)＝0.4；
摩擦补偿电流1＝本次滤波输出值*摩擦补偿电流Gain1＝1.26A，故将1.26A的摩擦补偿电流叠加到主动转向电流上。
假设此刻满足了摩擦补偿退出判断条件，则叠加到主动转向电流上的摩擦补偿电流为由1.26A在10ms内缓降至零的电流。
以上显示和描述了本发明的基本原理、主要特征和优点。本行业的技术人员应该了解，本发明不受上述实施例的限制，上述实施例和说明书中描述的只是说明本发明的原理，在不脱离本发明精神和范围的前提下，本发明还会有各种变化和改进，这些变化和改进都落入要求保护的本发明范围内。本发明要求保护范围由所附的权利要求书及其等效物界定。
Claims (4)
1.一种汽车主动转向系统的摩擦补偿方法，其特征在于，包括以下步骤：
步骤1：当目标角度上次历史值与当前目标角度值不相等时，获取车速和转速；
步骤2：根据以下车速-转速对照表获得摩擦补偿电流N；
其中，m为正整数，e>20deg/s；当转速大于20deg/s时，摩擦补偿电流为0A；当转速大于10deg/s，同时小于20deg/s时，摩擦补偿电流N1＝{2.8+0.2*(m-1)}*(20deg/s-转速)/10deg/s；当转速大于0deg/s，同时小于10deg/s时，摩擦补偿电流N2＝{2.8+0.2*(m-1)}*转速/10deg/s；
另外，当(m-2)*5km/h<车速<(m-1)*5km/h，同时转速为10deg/s时，摩擦补偿电流N3＝{车速–(m-2)*5}/5*0.2+{2.8+0.2*(m-2)}；
步骤4：通过低通滤波器对所述摩擦补偿电流N进行滤波，从而得到摩擦补偿电流N4
步骤5：获得最终摩擦补偿电流N5＝摩擦补偿电流N4*增益，并进入步骤1；
其中所述增益通过以下角度差–增益对照表查得；
其中，所述目标角度上次历史值和当前目标角度值之间的差值，f>120deg；当角度差小于5deg时，增益取零；当5deg<角度差<20deg时，增益F1＝角度差/(20deg–5deg)；当20deg<角度差<90deg时，增益F2＝1；当90deg<角度差<120deg时，增益F3＝(角度差–90)/30。
2.根据权利要求1所述的一种汽车主动转向系统的摩擦补偿方法，其特征在于：所述低通滤波器表达式为：
本次滤波输出值＝a*本次采样值+(1-a)*上次的滤波输出值；
式中a为滤波系数，滤波系数a的取值范围为[0,1]。
3.根据权利要求1所述的一种汽车主动转向系统的摩擦补偿方法，其特征在于：所述步骤1中，当目标角度历史值与当前目标角度值相等时，获得上次最终摩擦补偿电流N5，本次最终摩擦补偿电流N6为所述上次最终摩擦补偿电流N5的缓降输出值。
4.根据权利要求3所述的一种汽车主动转向系统的摩擦补偿方法，其特征在于：所述上次最终摩擦补偿电流N5缓降至零的时间为10±3ms。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010456756.2A CN111619666B (zh) | 2020-05-26 | 2020-05-26 | 一种汽车主动转向系统的摩擦补偿方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202010456756.2A CN111619666B (zh) | 2020-05-26 | 2020-05-26 | 一种汽车主动转向系统的摩擦补偿方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111619666A true CN111619666A (zh) | 2020-09-04 |
| CN111619666B CN111619666B (zh) | 2021-04-30 |
Family
ID=72257149
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010456756.2A Active CN111619666B (zh) | 2020-05-26 | 2020-05-26 | 一种汽车主动转向系统的摩擦补偿方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111619666B (zh) |
Cited By (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113276944A (zh) * | 2021-05-10 | 2021-08-20 | 武汉乐庭软件技术有限公司 | 一种自动泊车系统方向盘转角平滑处理的方法 |
| US11731700B2 (en) | 2021-03-25 | 2023-08-22 | Ford Global Technologies, Llc | Friction compensation for vehicle system control |
Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1891552A (zh) * | 2006-05-30 | 2007-01-10 | 上海燃料电池汽车动力系统有限公司 | 具有主动回正及阻尼控制的电动助力转向系统 |
| CN101842279A (zh) * | 2007-11-20 | 2010-09-22 | 丰田自动车株式会社 | 转向控制装置以及使用其的车辆用转向装置 |
| CN102923189A (zh) * | 2012-10-11 | 2013-02-13 | 吉林大学 | 一种基于永磁同步电机的电动助力转向系统控制器及控制方法 |
| CN104340262A (zh) * | 2013-08-08 | 2015-02-11 | 现代摩比斯株式会社 | 电动式转向装置的驱动装置及方法 |
| JP2017210009A (ja) * | 2016-05-23 | 2017-11-30 | 日本精工株式会社 | 電動パワーステアリング装置 |
-
2020
- 2020-05-26 CN CN202010456756.2A patent/CN111619666B/zh active Active
Patent Citations (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN1891552A (zh) * | 2006-05-30 | 2007-01-10 | 上海燃料电池汽车动力系统有限公司 | 具有主动回正及阻尼控制的电动助力转向系统 |
| CN101842279A (zh) * | 2007-11-20 | 2010-09-22 | 丰田自动车株式会社 | 转向控制装置以及使用其的车辆用转向装置 |
| CN102923189A (zh) * | 2012-10-11 | 2013-02-13 | 吉林大学 | 一种基于永磁同步电机的电动助力转向系统控制器及控制方法 |
| CN104340262A (zh) * | 2013-08-08 | 2015-02-11 | 现代摩比斯株式会社 | 电动式转向装置的驱动装置及方法 |
| JP2017210009A (ja) * | 2016-05-23 | 2017-11-30 | 日本精工株式会社 | 電動パワーステアリング装置 |
Cited By (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US11731700B2 (en) | 2021-03-25 | 2023-08-22 | Ford Global Technologies, Llc | Friction compensation for vehicle system control |
| CN113276944A (zh) * | 2021-05-10 | 2021-08-20 | 武汉乐庭软件技术有限公司 | 一种自动泊车系统方向盘转角平滑处理的方法 |
| CN113276944B (zh) * | 2021-05-10 | 2022-09-13 | 武汉乐庭软件技术有限公司 | 一种自动泊车系统方向盘转角平滑处理的方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111619666B (zh) | 2021-04-30 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111619666B (zh) | 一种汽车主动转向系统的摩擦补偿方法 | |
| CN111717204B (zh) | 自动驾驶车辆的横向控制方法及系统 | |
| CN110979305B (zh) | 车辆异常换道控制方法、装置及系统 | |
| CN108609014B (zh) | 智能车辆的横向控制方法及装置 | |
| CN111717189A (zh) | 车道保持控制方法、装置及系统 | |
| CN110825095B (zh) | 一种自动驾驶车辆横向控制方法 | |
| CN111650929B (zh) | 一种自适应滑模控制方法、系统及移动机器人控制器 | |
| CN108333938B (zh) | 一种多闭环复合陀螺稳定控制方法 | |
| CN109297486B (zh) | 惯性与多里程计信息辅助的车体运动状态判定方法及系统 | |
| Mammar et al. | Two-degree-of-freedom formulation of vehicle handling improvement by active steering | |
| CN112937555A (zh) | 一种基于车辆运动学模型的平行泊车轨迹规划方法 | |
| CN112519882A (zh) | 一种车辆参考轨迹跟踪方法及系统 | |
| CN113232652B (zh) | 一种基于运动学模型的车辆巡航控制方法及系统 | |
| KR20130021985A (ko) | 차량의 곡률 반경 추정 방법 및 그 장치 | |
| CN106168758B (zh) | 四轮独立驱动电动汽车的航向跟踪控制方法 | |
| CN114136310A (zh) | 一种惯性导航系统误差自主抑制系统及方法 | |
| CN112092800A (zh) | 一种自动泊车时的方向盘转角优化方法及系统 | |
| CN114043986B (zh) | 一种考虑质量失配的轮胎路面附着系数多模型融合估计方法 | |
| CN115042818A (zh) | 基于反馈纯跟踪的智能车辆路径跟随控制方法 | |
| CN115534930A (zh) | 车辆横向控制方法、装置和电子设备 | |
| CN114179818A (zh) | 基于自适应预瞄时间和滑模控制的智能汽车横向控制方法 | |
| CN107878456B (zh) | 汽车自动减速的方法和装置 | |
| JP2653196B2 (ja) | 車両のローリング制御装置 | |
| CN112698644A (zh) | 基于pure pursuit算法的纵向速度调整策略 | |
| JPH05270420A (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 | ||
| TR01 | Transfer of patent right |
Effective date of registration: 20220610 Address after: 2398 Muye Avenue, high tech Zone, Xinxiang City, Henan Province Patentee after: YUBEI STEERING SYSTEM (XINXIANG) CO.,LTD. Address before: 2398 Muye Avenue, high tech Zone, Xinxiang City, Henan Province Patentee before: XINXIANG AIDIWEI AUTOMOTIVE TECHNOLOGY CO.,LTD. |
|
| CP01 | Change in the name or title of a patent holder | ||
| CP01 | Change in the name or title of a patent holder |
Address after: 2398 Muye Avenue, high tech Zone, Xinxiang City, Henan Province Patentee after: North Henan Steering System (Xinxiang) Co.,Ltd. Address before: 2398 Muye Avenue, high tech Zone, Xinxiang City, Henan Province Patentee before: YUBEI STEERING SYSTEM (XINXIANG) CO.,LTD. |