CN109552408A - 基于三层闭环反馈的矿车自动转向控制系统及方法 - Google Patents

基于三层闭环反馈的矿车自动转向控制系统及方法 Download PDF

Info

Publication number
CN109552408A
CN109552408A CN201811515489.0A CN201811515489A CN109552408A CN 109552408 A CN109552408 A CN 109552408A CN 201811515489 A CN201811515489 A CN 201811515489A CN 109552408 A CN109552408 A CN 109552408A
Authority
CN
China
Prior art keywords
output
auto
steering
stepper motor
motor
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
Application number
CN201811515489.0A
Other languages
English (en)
Other versions
CN109552408B (zh
Inventor
王逢全
杨芙蓉
郭海全
张波
王怡然
张耀斌
孟有平
孙明达
李兆华
段景飞
丁浩然
李泽光
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Inner Mongolia North Hauler JSCL
Original Assignee
Inner Mongolia North Hauler JSCL
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Inner Mongolia North Hauler JSCL filed Critical Inner Mongolia North Hauler JSCL
Priority to CN201811515489.0A priority Critical patent/CN109552408B/zh
Publication of CN109552408A publication Critical patent/CN109552408A/zh
Application granted granted Critical
Publication of CN109552408B publication Critical patent/CN109552408B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D5/00—Power-assisted or power-driven steering
    • B62D5/06—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle
    • B62D5/061—Power-assisted or power-driven steering fluid, i.e. using a pressurised fluid for most or all the force required for steering a vehicle provided with effort, steering lock, or end-of-stroke limiters
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D5/00—Power-assisted or power-driven steering
    • B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0421—Electric motor acting on or near steering gear
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62D—MOTOR VEHICLES; TRAILERS
    • B62D5/00—Power-assisted or power-driven steering
    • B62D5/04—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear
    • B62D5/0457—Power-assisted or power-driven steering electrical, e.g. using an electric servo-motor connected to, or forming part of, the steering gear characterised by control features of the drive means as such
    • B62D5/046—Controlling the motor
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T10/00—Road transport of goods or passengers
    • Y02T10/60—Other road transportation technologies with climate change mitigation effect
    • Y02T10/72—Electric energy management in electromobility

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)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种基于三层闭环反馈的矿车自动转向控制系统，包括：自动驾驶控制器、直流步进电机、液压转向器、流量放大器、转向缸、转向机构、车轮。本发明还公开了一种基于三层闭环反馈的矿车自动转向控制方法。本发明能够用来实现无人驾驶的非公路矿车转向系统控制，通过不同层级的三重闭环反馈控制，响应规划层输入的车辆运行轨迹指令，实现无人驾驶矿车自动转向功能。

Description

基于三层闭环反馈的矿车自动转向控制系统及方法
技术领域
本发明涉及一种非公路矿车，具体是，涉及一种基于三层闭环反馈的矿车自动转向控制系统及方法。
背景技术
智能矿山是新一代采矿业技术竞争的核心，智能矿山技术将给世界矿业的发展带来前所未有的机遇，传统的矿山技术将逐渐退出矿业舞台，智能化、信息化、自动化的矿山技术即将开启一个崭新而充满活力的科技发展领域。露天采矿使用的无人驾驶非公路矿车是矿山自动化运行的主要组成部分，受到采矿行业越来越多的关注，它可以在一定程度上改善安全健康业绩指标，还能降低运行成本和提高生产率等，已成为矿山自动化解决方案中的重要组成部分。
发明内容
本发明所解决的技术问题是提供一种基于三层闭环反馈的矿车自动转向控制系统及方法，能够用来实现无人驾驶的非公路矿车转向系统控制，通过不同层级的三重闭环反馈控制，响应规划层输入的车辆运行轨迹指令，实现无人驾驶矿车自动转向功能。
技术方案如下：
一种基于三层闭环反馈的矿车自动转向控制系统，包括：
自动驾驶控制器，通过电缆与直流步进电机连接，接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机，其输出端通过机械结构与液压转向器相连接，接收自动驾驶控制器的电信号后转动；
液压转向器，其输出端通过液压管路与流量放大器相连接，用于将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器，其输出端通过液压管路与转向缸相连接，用于将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸，其输出端通过机械结构与转向机构相连接，用于将输出液压压力转化为机械运动；
转向机构，其输出端通过机械结构与车轮相连接，与转向缸输出的机械运动随动，用于带动车轮作方向调整。
一种基于三层闭环反馈的矿车自动转向控制方法，包括：
自动驾驶控制器接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机的输出端通过机械结构与液压转向器相连接，直流步进电机接收自动驾驶控制器的电信号后转动；液压转向器将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器的输出端通过液压管路与转向缸相连接，将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸的输出端通过机械结构与转向机构相连接，将输出液压压力转化为机械运动；转向机构的输出端通过机械结构与车轮相连接，转向机构与转向缸输出的机械运动随动，带动车轮作方向调整。
优选的，直流步进电机的内部设置有电机角度传感器，电机角度传感器用于实时测量直流步进电机输出的旋转角度，并将电机输出的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据直流步进电机输出的旋转角度及时对直流步进电机的输出进行调整。
优选的，转向机构主轴上设置有角度传感器，角度传感器实时测量转向机构的主轴的旋转角度，并将主轴的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据主轴的旋转角度及时对直流步进电机的输出进行调整。
优选的，车轮上设置有GPS定位系统，GPS定位系统实时测量车辆实际行驶轨迹，并将行驶轨迹反馈至自动驾驶控制器，自动驾驶控制器根据行驶轨迹及时对直流步进电机的输出进行调整。
本发明技术效果包括：
本发明提供了一种基于三层闭环反馈的矿车自动转向控制系统，可以用来实现无人驾驶的非公路矿车转向系统控制，本系统在不同层级均设置有闭环反馈控制，具有响应速度快，控制精度高，安全性高的特点。
本发明能够用来实现无人驾驶的非公路矿车转向系统控制，通过不同层级的三重闭环反馈控制，响应规划层输入的车辆运行轨迹指令，实现无人驾驶矿车自动转向功能，具有响应速度快，控制精度高，安全性高的特点。
附图说明
图1是本发明中基于三层闭环反馈的矿车自动转向控制系统的控制流程图。
具体实施方式
以下描述充分地示出本发明的具体实施方案，以使本领域的技术人员能够实践和再现。
本发明基于三层闭环反馈的矿车自动转向控制系统，是一种解决无人驾驶矿车自动转向控制系统的解决方案。
如图1所示，是本发明中基于三层闭环反馈的矿车自动转向控制系统的控制流程图。
基于三层闭环反馈的矿车自动转向控制系统，包括：自动驾驶控制器、直流步进电机、液压转向器、流量放大器、转向缸、转向机构、车轮。
自动驾驶控制器，通过电缆与直流步进电机连接，接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机，其输出端通过机械结构与液压转向器相连接，接收自动驾驶控制器的电信号后转动；直流步进电机的内部设置有电机角度传感器，电机角度传感器用于实时测量直流步进电机输出的旋转角度，并将电机输出的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据直流步进电机输出的旋转角度及时对直流步进电机的输出进行调整；
液压转向器，其输出端通过液压管路与流量放大器相连接，用于将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器，其输出端通过液压管路与转向缸相连接，用于将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸，其输出端通过机械结构与转向机构相连接，用于将输出液压压力转化为机械运动；
转向机构，其输出端通过机械结构与车轮相连接，与转向缸输出的机械运动随动，用于带动车轮作方向调整；转向机构主轴上设置有角度传感器，角度传感器实时测量转向机构的主轴的旋转角度，并将主轴的旋转角度传送给自动驾驶控制器。自动驾驶控制器根据转向机构主轴的旋转角度及时对直流步进电机的输出进行调整。
车轮上设置有GPS定位系统，GPS定位系统实时测量车辆实际行驶轨迹，并将行驶轨迹反馈至自动驾驶控制器，自动驾驶控制器根据行驶轨迹及时对直流步进电机的输出进行调整。
基于三层闭环反馈的矿车自动转向控制方法，包括：
自动驾驶控制器通过电缆与直流步进电机连接，接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机的输出端通过机械结构与液压转向器相连接，接收自动驾驶控制器的电信号后转动；电机角度传感器实时测量直流步进电机输出的旋转角度，并将电机输出的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据直流步进电机输出的旋转角度及时对直流步进电机的输出进行调整；
液压转向器的输出端通过液压管路与流量放大器相连接，将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器的输出端通过液压管路与转向缸相连接，将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸的输出端通过机械结构与转向机构相连接，将输出液压压力转化为机械运动；
转向机构的输出端通过机械结构与车轮相连接，转向机构与转向缸输出的机械运动随动，带动车轮作方向调整。角度传感器实时测量转向机构的主轴的旋转角度，并将主轴的旋转角度传送给自动驾驶控制器。自动驾驶控制器根据转向机构主轴的旋转角度及时对直流步进电机的输出进行调整。GPS定位系统实时测量车辆实际行驶轨迹，并将行驶轨迹反馈至自动驾驶控制器，自动驾驶控制器根据行驶轨迹及时对直流步进电机的输出进行调整。通过不同层级的三重闭环反馈控制，响应规划层输入的车辆运行轨迹指令，实现无人驾驶矿车自动转向功能。
应当理解的是，以上所述仅为本发明的具体实施方式，但本发明的保护范围并不局限于此，任何熟悉本技术领域的技术人员在本发明揭露的技术范围内，可轻易想到变化或替换，都应该涵盖在本发明的保护范围之内。因此，本发明的保护范围应以所述权利要求的保护范围为准。

Claims (8)

1.一种基于三层闭环反馈的矿车自动转向控制系统，其特征在于，包括：
自动驾驶控制器，通过电缆与直流步进电机连接，接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机，其输出端通过机械结构与液压转向器相连接，接收自动驾驶控制器的电信号后转动；
液压转向器，其输出端通过液压管路与流量放大器相连接，用于将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器，其输出端通过液压管路与转向缸相连接，用于将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸，其输出端通过机械结构与转向机构相连接，用于将输出液压压力转化为机械运动；
转向机构，其输出端通过机械结构与车轮相连接，与转向缸输出的机械运动随动，用于带动车轮作方向调整。
2.如权利要求1所述基于三层闭环反馈的矿车自动转向控制系统，其特征在于，直流步进电机的内部设置有电机角度传感器，电机角度传感器用于实时测量直流步进电机输出的旋转角度，并将电机输出的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据直流步进电机输出的旋转角度及时对直流步进电机的输出进行调整。
3.如权利要求1所述基于三层闭环反馈的矿车自动转向控制系统，其特征在于，转向机构主轴上设置有角度传感器，角度传感器实时测量转向机构的主轴的旋转角度，并将主轴的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据主轴的旋转角度及时对直流步进电机的输出进行调整。
4.如权利要求1所述基于三层闭环反馈的矿车自动转向控制系统，其特征在于，车轮上设置有GPS定位系统，GPS定位系统实时测量车辆实际行驶轨迹，并将行驶轨迹反馈至自动驾驶控制器，自动驾驶控制器根据行驶轨迹及时对直流步进电机的输出进行调整。
5.一种基于三层闭环反馈的矿车自动转向控制方法，包括：
自动驾驶控制器接收规划层输入的车辆运行轨迹和反馈信号，根据车辆运行轨迹和反馈信号控制直流步进电机的输出；
直流步进电机的输出端通过机械结构与液压转向器相连接，直流步进电机接收自动驾驶控制器的电信号后转动；液压转向器将直流步进电机的旋转运动转化为输出先导液压压力，并将输出先导液压压力通过液压管路中的液压油传递给流量放大器；
流量放大器的输出端通过液压管路与转向缸相连接，将输出先导液压压力转化为输出液压压力，并将输出液压压力通过液压管路中的液压油传递给转向缸；
转向缸的输出端通过机械结构与转向机构相连接，将输出液压压力转化为机械运动；转向机构的输出端通过机械结构与车轮相连接，转向机构与转向缸输出的机械运动随动，带动车轮作方向调整。
6.如权利要求5所述基于三层闭环反馈的矿车自动转向控制方法，其特征在于：直流步进电机的内部设置有电机角度传感器，电机角度传感器实时测量直流步进电机输出的旋转角度，并将电机输出的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据直流步进电机输出的旋转角度及时对直流步进电机的输出进行调整。
7.如权利要求5所述基于三层闭环反馈的矿车自动转向控制方法，其特征在于：转向机构主轴上设置有角度传感器，角度传感器实时测量转向机构的主轴的旋转角度，并将主轴的旋转角度传送给自动驾驶控制器；自动驾驶控制器根据主轴的旋转角度及时对直流步进电机的输出进行调整。
8.如权利要求5所述基于三层闭环反馈的矿车自动转向控制方法，其特征在于：车轮上设置有GPS定位系统，GPS定位系统实时测量车辆实际行驶轨迹，并将行驶轨迹反馈至自动驾驶控制器，自动驾驶控制器根据行驶轨迹及时对直流步进电机的输出进行调整。
CN201811515489.0A 2018-12-12 2018-12-12 基于三层闭环反馈的矿车自动转向控制系统及方法 Active CN109552408B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201811515489.0A CN109552408B (zh) 2018-12-12 2018-12-12 基于三层闭环反馈的矿车自动转向控制系统及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201811515489.0A CN109552408B (zh) 2018-12-12 2018-12-12 基于三层闭环反馈的矿车自动转向控制系统及方法

Publications (2)

Publication Number Publication Date
CN109552408A true CN109552408A (zh) 2019-04-02
CN109552408B CN109552408B (zh) 2023-07-14

Family

ID=65869637

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201811515489.0A Active CN109552408B (zh) 2018-12-12 2018-12-12 基于三层闭环反馈的矿车自动转向控制系统及方法

Country Status (1)

Country Link
CN (1) CN109552408B (zh)

Citations (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20060200291A1 (en) * 2005-03-07 2006-09-07 Wroblewski Anthony J Tactile electronic steering system
EP1809527A1 (de) * 2004-11-11 2007-07-25 Continental Teves AG & Co. oHG Fahrzeuglenkung und verfahren zur regelung einer fahrzeuglenkung
CN102030033A (zh) * 2010-12-15 2011-04-27 吉林大学 转向灵敏度可调的电控工程车辆动力转向系统
CN102941876A (zh) * 2012-11-23 2013-02-27 南京理工大学 无人驾驶车辆转向系统及其控制方法
CN103092120A (zh) * 2011-10-27 2013-05-08 北京航天发射技术研究所 一种高可靠摆杆控制系统及控制方法
CN104635729A (zh) * 2013-11-14 2015-05-20 陕西子竹电子有限公司 一种车辆自动驾驶仪控制系统
CN205087004U (zh) * 2015-11-16 2016-03-16 山西大同大学 一种智能车辆自动驾驶控制系统
CN105511469A (zh) * 2015-12-18 2016-04-20 北京联合大学 一种无人智能巡逻电动车及巡逻系统
US20170203787A1 (en) * 2016-01-15 2017-07-20 Deere & Company Vehicle guidance system with a stepper motor

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
EP1809527A1 (de) * 2004-11-11 2007-07-25 Continental Teves AG & Co. oHG Fahrzeuglenkung und verfahren zur regelung einer fahrzeuglenkung
US20080296084A1 (en) * 2004-11-11 2008-12-04 Continental Teves Ag & Co. Ohg Vehicle Steering System and Method For Controlling a Vehicle Steering System
US20060200291A1 (en) * 2005-03-07 2006-09-07 Wroblewski Anthony J Tactile electronic steering system
CN102030033A (zh) * 2010-12-15 2011-04-27 吉林大学 转向灵敏度可调的电控工程车辆动力转向系统
CN103092120A (zh) * 2011-10-27 2013-05-08 北京航天发射技术研究所 一种高可靠摆杆控制系统及控制方法
CN102941876A (zh) * 2012-11-23 2013-02-27 南京理工大学 无人驾驶车辆转向系统及其控制方法
CN104635729A (zh) * 2013-11-14 2015-05-20 陕西子竹电子有限公司 一种车辆自动驾驶仪控制系统
CN205087004U (zh) * 2015-11-16 2016-03-16 山西大同大学 一种智能车辆自动驾驶控制系统
CN105511469A (zh) * 2015-12-18 2016-04-20 北京联合大学 一种无人智能巡逻电动车及巡逻系统
US20170203787A1 (en) * 2016-01-15 2017-07-20 Deere & Company Vehicle guidance system with a stepper motor

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
王智峰;张朋飞;何克忠;: "智能车辆自动驾驶控制系统方案设计", 车辆与动力技术, no. 01 *

Also Published As

Publication number Publication date
CN109552408B (zh) 2023-07-14

Similar Documents

Publication Publication Date Title
CN102501890B (zh) 检查车转轨控制系统及控制方法
CN109491364B (zh) 一种用于车辆测试的驾驶机器人系统及控制方法
CN204400501U (zh) 一种电驱动主动升沉补偿海洋绞车
CN106598050A (zh) 高集成度驱动转向一体化舵轮系统
CN202560636U (zh) 电控式动叶可调轴流风机
CN102935815B (zh) 一种电动轮车辆的电子差速控制方法
CN104401483B (zh) 一种机电伺服系统
CN102381321A (zh) 一种机车撒砂装置及控制方法
CN104527659A (zh) 用于列车牵引的传动系统
CN105068543A (zh) 一种基于pid控制的背负型agv两轮同步方法
CN103074474B (zh) 对重型装甲车辆的扭力轴进行滚压强化的控制系统
CN105256853A (zh) 一种基于差速器的绞吸船双绞刀头动力分配装置及方法
CN109552408A (zh) 基于三层闭环反馈的矿车自动转向控制系统及方法
CN105620449A (zh) 用于轨道交通车辆的电驱液压制动方法及制动系统
CN203567804U (zh) 方向盘式履带车电液转向机构
CN203463045U (zh) 自动井架工回转机构的控制装置
CN104562877A (zh) 轨道铣磨车传动系统
CN208858818U (zh) 一种电子机械制动系统用制动执行装置
CN109552297A (zh) 电动轮矿车自动制动控制系统及其方法
CN202264802U (zh) 检查车转轨控制系统
CN205059568U (zh) 一种新型基于压力传感器的无人驾驶汽车刹车装置
CN203111498U (zh) 一种直接驱动式飞机电传刹车系统
CN201792896U (zh) 一种电动液压动力传动系统
CN104325983A (zh) 一种用于四轮驱动轨道牵引车的电气控制系统
CN205218748U (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
GR01 Patent grant
GR01 Patent grant