液压式农机自动转向控制实验平台及实验方法_2

文档序号:8359447阅读:来源:国知局
利。
[0042]3.采用的自动转向控制单元具备CAN总线通信接口,与常见的农机车载电子系统兼容性好,方便进行替代测试。
[0043]4.平台采用高精度三轴陀螺仪对转向轮的转动角度、角速度和角加速度进行测量和记录,为分析转向控制实验性能提供了详尽、可靠的依据。
【附图说明】
[0044]图1为本发明的实验平台结构及连接示意图;
[0045]图2为本发明的转向阀块结构及连接示意图;
[0046]图3为本发明的自动转向控制单元结构框图;
[0047]图4为本发明的电磁开关阀控制模块结构及连接示意图;
[0048]图5为本发明的比例换向阀控制模块结构及连接示意图;
[0049]图6为本发明的自动转向控制实验典型工作过程流程图。
[0050]其中,1-液压站;2_转向阀块;3_方向盘;4_液压转向器;5-前桥;6_转向轮;7-自动转向控制单元;8_转向角度测量单元;9_液压调控单元;10_高精度三轴陀螺仪;11-数据采集计算机;12-转向油缸;21_电磁开关阀;22_比例换向阀;23_安全阀;24_放大器;31-32位处理器最小系统;32-CAN通信模块;33_电磁开关阀控制模块;34_比例换向阀控制模块;36-达林顿晶体管;37_常开型继电器;38_电压型数模转换芯片;39_数字隔离芯片。
【具体实施方式】
[0051]下面结合附图及实施例对本发明做进一步的详细说明。
[0052]如图1所示,本发明的自动转向控制实验平台包括液压转向系统、转向控制器和实验控制台三大部分。液压转向系统具体包括:液压站1、农机转向前桥、和转向阀块2,其中农机转向前桥由方向盘3、液压转向器4、前桥5、转向油缸12和转向轮6构成;转向驱动系统包括自动转向控制单元7和转向角度测量单元8 ;测试控制系统包括:液压调控单元9和实验测量单元,其中实验测量单元由高精度三轴陀螺仪10、数据采集计算机11及安装支架(未示出)构成。液压站I与方向盘3、液压转向器4、前桥5和转向轮6,构成与实际农机相同的完整手动液压转向系统。转向阀块2并联安装在手动液压转向系统上,用于自动转向模式下的转向轮调节;转向角度测量单元8采用高精度直线电位器式,电位器的活动端与转向油缸12的活塞杆端固定相连、主体与转向油缸12的缸筒固定相连,通过检测转向油缸12的伸缩长度,推算出转向轮6的转动角度;自动转向控制单元7以转向角度测量单元8作为转向控制的传感器,以转向阀块2作为执行器,构成闭环的自动转向控制系统。高精度三轴陀螺仪10安装在转向轮主销轴上,通过数据采集计算机11对高精度三轴陀螺仪10输出的角度、角速度和角加速度数据进行采集和记录,从而实现对自动转向控制实验效果即转向轮转动角度、角速度和角加速度的测量。
[0053]如图2所示,转向阀块2包括电磁开关阀21、比例换向阀22、安全阀23、放大器24、以及集成阀座(未示出)。其中,电磁开关阀21,共三个,用于手动转向/自动转向的工作方式切换;当默认状态,即电磁开关阀21断开时,农机原转向液压通路导通,保持手动转向方式,此时自动转向装置不工作;当电磁开关阀21导通时,液压转向器4的液压通路关闭,自动转向液压通路打开,农机由手动转向切换为电控自动转向的工作方式。比例换向阀22,三位四通,配备两个线圈,通过选择动作的线圈,决定转向油缸12的动作方向,通过线圈中的电流大小,决定转向油缸12的动作速度。安全阀23,用于保护液压油路的压力,保证转向系统在手动转向和自动转向时都能够正常工作;放大器24,连接在比例换向阀22的两个线圈上,用于将自动转向控制单元7中输出的0-5V控制信号转换为对应的比例阀驱动电流。电磁开关阀21、比例换向阀22、安全阀23都为插式阀,集成阀座用于集成上述阀体,并在内部为各插式阀提供连接油路,在外部留出与原液压转向系统进行并联安装的接头。
[0054]如图3所示,自动转向控制单元7由32位处理器最小系统31、CAN通信模块32、电磁开关阀控制模块33、比例换向阀控制模块34构成。其中,32位处理器最小系统31,由32位处理器和晶振、电源等基本外围电路构成,是控制器的核心,完成所有通信、信号处理等相关的逻辑和计算工作;CAN通信模块32,主要由处理器外围设备CAN控制器和CAN隔离收发器构成,与外部CAN总线相连,用于接收转向开始、停止指令和转向角度数据。如图4所示,电磁开关阀控制模块33主要由三组达林顿晶体管36和三个常开型继电器37构成,三组达林顿晶体管36对来自处理器的数字电平输出信号进行反相,并增加驱动能力后输出到三个常开型继电器37的控制线圈上,当继电器37线圈上有控制电压时,继电器37吸合,否则断开;继电器37分别串联在三个电磁开关阀21的供电回路中,当继电器37断开时,则电磁开关阀21断开,转向方式为手动转向;当继电器37闭合时,则电磁开关阀21导通,转向方式为自动转向。如图5所示,比例换向阀控制模块34主要由两片电压型数模转换芯片38、两片数字隔离芯片39构成;两片电压型数模转换芯片38,输入端分别与处理器的两个SPI接口相连,且连线均通过数字隔离芯片39进行数字隔离,输出端分别与安装在比例换向阀22的两个放大器24相连;同一时刻只可以有一个SPI 口工作,处理器通过确定工作的SPI 口,选择比例换向阀22中工作的线圈,实现转向方向的控制;处理器通过SPI 口向电压型数模转换芯片38发送电压设置命令,改变输入到对应放大器24中的控制电压大小,从而实现对比例换向阀22中阀芯开度的控制,达到控制转向速度的目的。
[0055]下面对利用上述液压式农机自动转向控制实验平台进行农机自动转向控制实验的典型工作过程进行详细描述。
[0056]如图6所示,本发明的农机自动转向控制实验典型工作过程包括如下步骤:
[0057]SOl:启动液压站,并通过油压调节阀门调整液压回路的压力至期望值;
[0058]S02:启动实验测量单元中的陀螺仪,并使用数据采集计算机对其输出的角度、角速度和角加速度数据进行持续采集;
[0059]S03:使用待实验的转向角度测量单元,将自动转向控制算法写入自动转向控制单元中,运行自动转向控制单元;
[0060]S04:当自动转向控制单元接收到数据采集计算机发出的开始信号时,首先闭合三个继电器,从而使三个电磁开关阀闭合,转向方式由手动转向切换为自动转向;
[0061]S05:自动转向控制单元接收数据采集计算机发出的转向角度设定值,并与最近一次的车轮转角测量值,一同作为自动转向控制算法的输入,根据算法的运算结果,通过选择电压型数模转换芯片来控制转向方向,并设定电压型数模转换芯片输出电压的大小控制转向角速度;
[0062]S06:自动转向控制单元输出电压信号,通过放大器,控制比例换向阀中液压油的流向和流量,从而驱动转向油缸运动、带动转向车轮转动;
[0063]S07:循环执行步骤S05-S06,实现自动转向控制算法的持续运行;
[0064]S08:当自动转向控制单元接收到数据采集计算机发出的停止信号时,控制三个继电器断开,从而使三个电磁开关阀开路,转向方式由自动转向切换为手动转向,同时停止电压信号的输出,使得比例换向阀停止在中位;
[0065]S09:数据采集计算机停止对陀螺仪输出数据的记录,通过该测量数据,对当前使用的转向角度测量单元或自动转向控制算法的性能进行分析。
[0066]综上所述,本发明的液压式农机自动转向控制实验平台,与实际农机转向系统结构相同,在该平台上能够真实方便地进行农机自动转向控制相关的转向角度测量单元性能、转向算法精度等方面的实验分析,能够对自动转向控制实验过程中转向角度、转向角速度和转向角加速度的响应特性进行测量和记录,为转向角度测量单元、自动转向控制算法的性能分析和改进提供了可靠依据。
【主权项】
1.一种液压式农机自动转向控制实验平台,其
当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1