CN108693769A - 一种基于电动方向盘的农业机械自动驾驶控制方法 - Google Patents
一种基于电动方向盘的农业机械自动驾驶控制方法 Download PDFInfo
- Publication number
- CN108693769A CN108693769A CN201810295711.4A CN201810295711A CN108693769A CN 108693769 A CN108693769 A CN 108693769A CN 201810295711 A CN201810295711 A CN 201810295711A CN 108693769 A CN108693769 A CN 108693769A
- Authority
- CN
- China
- Prior art keywords
- steering
- control
- steering wheel
- agricultural machinery
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 230000007246 mechanism Effects 0.000 claims description 3
- 230000004044 response Effects 0.000 abstract description 8
- 230000008859 change Effects 0.000 description 3
- 238000012986 modification Methods 0.000 description 3
- 230000004048 modification Effects 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 230000005611 electricity Effects 0.000 description 2
- 230000007423 decrease Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000006073 displacement reaction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000000630 rising effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B11/00—Automatic controllers
- G05B11/01—Automatic controllers electric
- G05B11/36—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential
- G05B11/42—Automatic controllers electric with provision for obtaining particular characteristics, e.g. proportional, integral, differential for obtaining a characteristic which is both proportional and time-dependent, e.g. P. I., P. I. D.
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D15/00—Steering not otherwise provided for
- B62D15/02—Steering position indicators ; Steering position determination; Steering aids
- B62D15/025—Active steering aids, e.g. helping the driver by actively influencing the steering system after environment evaluation
-
- 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
-
- 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/008—Control of feed-back to the steering input member, e.g. simulating road feel in steer-by-wire applications
-
- 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
- B60W50/00—Details of control systems for road vehicle drive control not related to the control of a particular sub-unit, e.g. process diagnostic or vehicle driver interfaces
- B60W2050/0001—Details of the control system
- B60W2050/0002—Automatic control, details of type of controller or control system architecture
- B60W2050/0008—Feedback, closed loop systems or details of feedback error signal
- B60W2050/0009—Proportional differential [PD] controller
-
- 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
- B60W2710/00—Output or target parameters relating to a particular sub-units
- B60W2710/20—Steering systems
- B60W2710/207—Steering angle of wheels
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B60—VEHICLES IN GENERAL
- B60Y—INDEXING SCHEME RELATING TO ASPECTS CROSS-CUTTING VEHICLE TECHNOLOGY
- B60Y2200/00—Type of vehicle
- B60Y2200/20—Off-Road Vehicles
- B60Y2200/22—Agricultural vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Steering Control In Accordance With Driving Conditions (AREA)
- Guiding Agricultural Machines (AREA)
Abstract
本发明提供了一种基于电动方向盘的农业机械自动驾驶控制方法,包括以下步骤:步骤(1):通过导航控制器输出转向角指令;步骤(2):第一转向控制器通过前轮转角反馈,进行PD控制,并输出控制指令到第二转向控制器;步骤(3):第二转向控制器通过方向盘转速反馈,进行PD控制,输出控制指令到电动方向盘,本发明内环采用基于方向盘转动速度反馈的PD控制,外环采用基于车轮转动角度反馈的PD控制,在提高转向控制系统响应速度的同时,也具有较高的精度和鲁棒性。
Description
技术领域
本发明涉及自动驾驶控制算法领域,具体涉及到一种基于电动方向盘的农业机械自动驾驶控制方法。
背景技术
农机自动导航产品已经成为国外农机产业中发展最为迅速的部分,但国内对自动导航技术的研究起步较晚,相关的方法研究还在不断改进优化中。
目前的农机自动驾驶控制方法主要有:(1)PID算法,针对自动转向系统中液压阀的非线性特性,可带有死区、饱和等非线性补偿;(2)自适应PID算法,根据行驶速度、转向角偏差等在线调节PID参数,使用多组参数实现较多工况下的高精度控制;模糊控制算法,以转向角、转向角速度、转向角偏差、航向角偏差等的组合作为模糊控制器的输入量,对自动转向系统模型的非线性、时变等特性具有较好的适应性。
对于PID算法和自适应PID算法,当农机转向系统随着轮胎-地面状况等发生较大改变时,控制精度会随着下降;模糊控制方法的鲁棒性较强,但难以同时达到较高的响应速度和控制精度。
发明内容
为了解决上述的缺陷,本发明提供了一种基于电动方向盘的农业机械自动驾驶控制方法,内环采用基于方向盘转动速度反馈的PD控制,外环采用基于车轮转动角度反馈的PD控制,在提高转向控制系统响应速度的同时,也具有较高的精度和鲁棒性。
本发明提供了一种基于电动方向盘的农业机械自动驾驶控制方法,包括以下步骤:
步骤(1):通过导航控制器输出转向角指令;
步骤(2):第一转向控制器通过前轮转角反馈,进行PD控制,并输出控制指令到第二转向控制器;
步骤(3):第二转向控制器通过方向盘转速反馈,进行PD控制,输出控制指令到电动方向盘。
上述的农业机械自动驾驶控制方法,其中,所述步骤(1)中:
所述转向角指令为前轮期望转速。
上述的农业机械自动驾驶控制方法,其中,所述步骤(3)中:所述电动方向盘驱动农机转向机构,从而带动农机转向。
本发明具有以下有益效果:
(1)本发明内环采用基于方向盘转动速度反馈的PD控制,外环采用基于车轮转动角度反馈的PD控制,在提高转向控制系统响应速度的同时,也具有较高的精度和鲁棒性。
(2)本发明多引入了一个控制器,可以对方向盘转动速度进行优化调节,在转向角调节精度较高的同时,能够具有较快的响应速度,使得转向控制系统的整体性能更佳。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明及其特征、外形和优点将会变得更明显。在全部附图中相同的标记指示相同的部分。并未刻意按照比例绘制附图,重点在于示出本发明的主旨。
图1为本发明提供的农机转向系统动态响应曲线;
图2为本发明提供的转向角速度单位阶跃响应曲线。
图3为本发明提供的控制流程示意图。
具体实施方式
在下文的描述中,给出了大量具体的细节以便提供对本发明更为彻底的理解。然而,对于本领域技术人员而言显而易见的是,本发明可以无需一个或多个这些细节而得以实施。在其他的例子中,为了避免与本发明发生混淆,对于本领域公知的一些技术特征未进行描述。
为了彻底理解本发明,将在下列的描述中提出详细的步骤以及详细的结构,以便阐释本发明的技术方案。本发明的较佳实施例详细描述如下,然而除了这些详细描述外,本发明还可以具有其他实施方式。
参照图1-图3所示,本发明提供了一种基于电动方向盘的农业机械自动驾驶控制方法,包括以下步骤:
步骤(1):首先由导航控制器输出转向角指令,其中:转向角指令为前轮期望转速;
步骤(2):第一转向控制器通过前轮转角反馈,进行PD控制,并输出控制指令到第二转向控制器;
步骤(3):第二转向控制器通过方向盘转速反馈,进行PD控制,输出控制指令到电动方向盘,然后电动方向盘驱动农机转向机构,从而带动农机转向。
参照图3所示,在本发明中,多引入了一个控制器,可以对方向盘转动速度进行优化调节,在转向角调节精度较高的同时,能够具有较快的响应速度,使得转向控制系统的整体性能更佳。
参照图1、图2所示,利用Matlab进行转向角速度控制仿真,在单位阶跃转向角速度给定情况下,PD控制器的控制量变化情况和转向角速度跟踪效果。由仿真结果可知,上升时间约0.35s,超调量约10%,响应速度较快,超调量在可接受范围内。
以上对本发明的较佳实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,其中未尽详细描述的设备和结构应该理解为用本领域中的普通方式予以实施;任何熟悉本领域的技术人员,在不脱离本发明技术方案范围情况下,都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰,或修改为等同变化的等效实施例,这并不影响本发明的实质内容。因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化及修饰,均仍属于本发明技术方案保护的范围内。
Claims (3)
1.一种基于电动方向盘的农业机械自动驾驶控制方法,其特征在于,包括以下步骤:
步骤(1):通过导航控制器输出转向角指令;
步骤(2):第一转向控制器通过前轮转角反馈,进行PD控制,并输出控制指令到第二转向控制器;
步骤(3):第二转向控制器通过方向盘转速反馈,进行PD控制,输出控制指令到电动方向盘。
2.如权利要求1所述的一种基于电动方向盘的农业机械自动驾驶控制方法,其特征在于,所述步骤(1)中:
所述转向角指令为前轮期望转速。
3.如权利要求2所述的一种基于电动方向盘的农业机械自动驾驶控制方法,其特征在于,所述步骤(3)中:
所述电动方向盘驱动农机转向机构,从而带动农机转向。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810295711.4A CN108693769A (zh) | 2018-04-04 | 2018-04-04 | 一种基于电动方向盘的农业机械自动驾驶控制方法 |
PCT/CN2018/099873 WO2019192117A1 (zh) | 2018-04-04 | 2018-08-10 | 一种基于电动方向盘的农业机械自动驾驶控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810295711.4A CN108693769A (zh) | 2018-04-04 | 2018-04-04 | 一种基于电动方向盘的农业机械自动驾驶控制方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108693769A true CN108693769A (zh) | 2018-10-23 |
Family
ID=63845376
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810295711.4A Pending CN108693769A (zh) | 2018-04-04 | 2018-04-04 | 一种基于电动方向盘的农业机械自动驾驶控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN108693769A (zh) |
WO (1) | WO2019192117A1 (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110243372A (zh) * | 2019-06-18 | 2019-09-17 | 北京中科原动力科技有限公司 | 基于机器视觉的智能农机导航系统及方法 |
CN111208832A (zh) * | 2020-02-25 | 2020-05-29 | 深圳冰河导航科技有限公司 | 通过速度系数优化自动驾驶仪控制效果的实现方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113401217B (zh) * | 2021-01-06 | 2022-09-13 | 丰疆智能(深圳)有限公司 | 自动驾驶的转向控制方法和方向盘转向单元 |
CN114488779B (zh) * | 2022-02-08 | 2023-05-05 | 中国科学院赣江创新研究院 | 一种汽油发电系统的动力链串级前馈控制方法及系统装置 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6895318B1 (en) * | 2001-03-20 | 2005-05-17 | Trw Limited | Oversteer steering assistance controller |
CN102320326B (zh) * | 2011-07-08 | 2012-09-26 | 吉林大学 | 用于汽车线控转向系统的控制方法 |
CN103085858A (zh) * | 2011-10-28 | 2013-05-08 | 中国科学院沈阳自动化研究所 | 一种方向盘式农业机械自动驾驶转向控制装置 |
CN104477231A (zh) * | 2014-08-19 | 2015-04-01 | 广东技术师范学院 | 集成电动助力转向和主动转向的组合控制系统 |
-
2018
- 2018-04-04 CN CN201810295711.4A patent/CN108693769A/zh active Pending
- 2018-08-10 WO PCT/CN2018/099873 patent/WO2019192117A1/zh active Application Filing
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110243372A (zh) * | 2019-06-18 | 2019-09-17 | 北京中科原动力科技有限公司 | 基于机器视觉的智能农机导航系统及方法 |
CN111208832A (zh) * | 2020-02-25 | 2020-05-29 | 深圳冰河导航科技有限公司 | 通过速度系数优化自动驾驶仪控制效果的实现方法 |
Also Published As
Publication number | Publication date |
---|---|
WO2019192117A1 (zh) | 2019-10-10 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108693769A (zh) | 一种基于电动方向盘的农业机械自动驾驶控制方法 | |
CN103701368B (zh) | 双电机节能消隙控制方法 | |
Falcone et al. | Linear time‐varying model predictive control and its application to active steering systems: Stability analysis and experimental validation | |
CN103984234A (zh) | 一种电液伺服系统自修正模糊pid控制的方法 | |
CN105022269B (zh) | 仿生机器鱼关节的控制方法及装置 | |
CN105182741A (zh) | 一种无超调的分数阶时变滑模控制方法 | |
CN106374801B (zh) | 一种根据偏差自适应调整的电动伺服控制系统及方法 | |
JP2015525711A (ja) | 自動車のための電動パワーアシストステアリングシステムの操作のための方法 | |
CN106873380A (zh) | 基于pi模型的压电陶瓷模糊pid控制方法 | |
CN103197542A (zh) | 基于数据驱动的时滞系统pid控制器镇定方法 | |
CN108415435B (zh) | 一种农业机械圆曲线自动驾驶控制方法 | |
CN107807522A (zh) | 水下机器人轨迹跟踪反步控制方法 | |
CN106597838A (zh) | 一种控制舵机的装置及方法 | |
CN103995463B (zh) | 一种基于混合控制的电液比例阀位置伺服驱动方法 | |
CN103869748A (zh) | 非圆曲面xy直驱加工廓形误差交叉耦合控制系统及方法 | |
CN102664569A (zh) | 一种基于滑模变结构的永磁同步直线电机控制方法及装置 | |
Saruchi et al. | Active front steering for steer-by-wire vehicle via composite nonlinear feedback control | |
CN108062024A (zh) | 一种考虑阻力的移动机器人反演滑模控制方法 | |
CN102269971A (zh) | 基于模型跟踪的自适应伺服控制器 | |
CN104270046A (zh) | 一种基于转速-电流二维模糊模型自学习的电机控制方法 | |
CN105172194A (zh) | 模糊pid速度控制的液压机电气系统 | |
CN104950666A (zh) | 一种可提高pid控制速度和精度的方法 | |
CN102541098A (zh) | 一种电液线位移伺服系统 | |
CN109884890B (zh) | 一种电驱动机械臂伺服系统的时变约束反演控制方法 | |
CN102087531A (zh) | 液体泵的流量控制方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20181023 |
|
RJ01 | Rejection of invention patent application after publication |