一种农机自动驾驶系统的自动校准方法及系统的制作方法

文档序号:9760931阅读:562来源:国知局
一种农机自动驾驶系统的自动校准方法及系统的制作方法
【技术领域】
[0001 ]本发明涉及一种自动校准方法及系统,特别涉及一种农机自动驾驶系统的自动校准方法及系统。
【背景技术】
[0002]目前,当农机自动驾驶系统在不同场地进行工作前所进行参数校准通常采用人工凑试法,该方法主要是让工程技术人员人工进行实地参数凑试,其主要是通过枚举法将多个控制信号值输入到液压阀,再根据实际运行效果和操作经验判断出转向控制信号死区值、转向模式匹配信息等参数,最后把人工校准出来的参数记录在EClKElectronicControl Unit,电子控制单元)的存储器中应用于实际作业,该方法过程繁琐,费时费力。
[0003 ]其中,控制信号死区值是指当ECU输出给液压阀的转向控制信号较小时,液压阀对应产生的动力不够带动前转向轮进行转向,而当控制信号大于某一个值时,前转向轮在液压阀带动下才开始有明显转向的特性,该值就是控制信号死区值;
[0004]转向模式匹配信息是指在ECU控制前转向轮转向中左转或右转状态与实时角度的递增性或递减性的匹配,例如,在控制中默认左转时前转向轮角度是递增的,匹配地,在实际左转时前转向轮角度也一定要是递增的。

【发明内容】

[0005]为了克服现有技术农机自动驾驶系统的校准方法及系统费时费力的不足,本发明的目的在于提供一种省时省力的农机自动驾驶系统的自动校准方法及系统。
[0006]为解决上述问题,本发明所采用的技术方案如下:提供一种农机自动驾驶系统的自动校准方法,其特征在于,包括以下步骤:
[0007]SlOl:获取前转向轮的初始角度;
[0008]S102:获取转向控制信号调整前转向轮时的调整实时角度;
[0009]S103:根据调整实时角度和初始角度获取转向控制信号的死区值以及转向模式匹配信息;
[0010]S104:将转向控制信号的死区值以及转向模式匹配信息加载至电子控制单元。
[0011]优选地,步骤S102包括以下步骤:
[0012]通过角度传感器获取前转向轮的调整实时角度模拟信号;
[0013]将所述调整时角度模拟信号通过模数转换模块转换为调整实时角度数字信号;
[0014]读取所述调整实时角度数字信号获取调整实时角度。
[0015]优选地,步骤S102包括以下步骤:
[0016]PlOl:产生转向控制信号;
[0017]P102:将上述产生的转向控制信号输出到液压阀,液压阀在转向控制信号控制下带动前转向轮转向,同时,重复步骤S102获取前转向轮的调整实时角度;
[0018]P103:将获取的前转向轮的调整实时角度与初始角度做差,判断所述差的绝对值是否为1-5°,若是,记录转向控制信号的死区值;
[0019]P104:根据所述差以及转向控制信号获取转向模式匹配信息。
[0020]优选地,所述差的绝对值为2°。
[0021]优选地,所述转向控制信号为占空比随时间不断增大的PffM信号。
[0022]优选地,步骤S104包括以下步骤:
[0023 ] 通过步骤S11、步骤S102以及步骤S103获取前转向轮的左转向模式的左转向控制信号的死区值以及左转向模式匹配信息;
[0024]通过步骤SlOl、步骤S102以及步骤S103获取前转向轮的右转向模式的右转向控制信号的死区值以及右转向模式匹配信息;
[0025]判断左转向模式匹配信息和右转向模式匹配信息是否互补,如是,将左转向控制信号的死区值、左转向模式匹配信息、右转向控制信号的死区值、右转向模式匹配信息加载至电子控制单元。
[0026]相比现有技术,本发明的有益效果在于:
[0027]本发明一种农机自动驾驶系统的自动校准方法在调整初始角度的过程中通过电子控制单元记录转向控制信号的死区值以及转向模式匹配信息,解决了人工校准的费时费力问题,同时,也降低了对工程技术人员实地校准经验的依赖,在一定程度上提高了农机机械化水平。
[0028]提供一种农机自动驾驶系统的自动校准系统,包括前转向轮、初始获取模块、调整获取模块、用于控制前转向轮的液压阀、电子控制单元以及加载输入模块,所述初始获取模块、调整获取模块、液压阀、加载输入模块分别连接电子控制单元;
[0029]所述初始获取模块用于获取前转向轮的初始角度;
[0030]所述调整获取模块用于获取转向控制信号调整前转向轮时的调整实时角度;
[0031]所述电子控制单元用于根据调整实时角度和初始角度获取转向控制信号的死区值以及转向模式匹配信息;
[0032]所述加载输入模块用于将转向控制信号的死区值以及转向模式匹配信息加载至电子控制单元。
[0033]优选地,电子控制单元包括控制信号单元、存储单元以及反馈单元,所述存储单元用于记录转向控制信号的死区值以及转向模式匹配信息,所述电子控制单元通过控制信号单元与液压阀连接,所述电子控制单元通过反馈单元与调整获取模块连接。
[0034]优选地,所述调整获取模块包括用于获取前转向轮调整实时角度的角度传感器、与角度传感器电性连接模数转换器,所述调整获取模块通过模数转换器与电子控制单元连接。
[0035]相比现有技术,本发明的有益效果在于:
[0036]本发明一种农机自动驾驶系统的自动校准系统通过初始获取模块、调整获取模块、电子控制单元以及加载输入模块的设置,在调整初始角度的过程中通过电子控制单元记录转向控制信号的死区值以及转向模式匹配信息,解决了人工校准的费时费力问题,同时,也降低了对工程技术人员实地校准经验的依赖,在一定程度上提高了农机机械化水平。
【附图说明】
[0037]图1是本发明一种农机自动驾驶系统的自动校准方法的流程图;
[0038]图2是本发明一种农机自动驾驶系统的自动校准方法的步骤S103的流程图;
[0039]图3是本发明一种农机自动驾驶系统的自动校准系统的模块结构示意图。
[0040]图中标识说明:
[0041 ] 1、农机自动驾驶系统的自动校准系统;11、前转向轮;1 3、初始获取模块;1 5、调整获取模块;107、液压阀;108、加载输入模块;1091、控制信号单元;1093、存储单元;1095、反馈单元;1051、角度传感器;1053、模数转换器。
【具体实施方式】
[0042]下面结合附图和【具体实施方式】对本发明作进一步详细说明。
[0043]请参阅图1-图2,图1示出了本发明一种农机自动驾驶系统的自动校准方法的流程示意图,本发明一种农机自动驾驶系统的自动校准方法主要应用于农机自动驾驶系统领域,其包括以下步骤:
[0044]SlOl:获取前转向轮的初始角度;
[0045]S102:获取转向控制信号调整前转向轮时的调整实时角度;
[0046]具体地,步骤S102包括以下步骤:
[0047]通过角度传感器获取前转向轮的调整实时角度模拟信号;
[0048]将所述调整时角度模拟信号通过模数转换模块转换为调整实时角度数字信号;
[0049]读取所述调整实时角度数字信号获取调整实时角度。
[0050]值得一提的是,前转向轮初始角度也可以通过步骤S102获取,同时,前转向轮通常包括左转向以及右转向两种转向模式。独立地,左转向模式和右转向模式的实时角度都需要获取。
[0051]S103:根据调整实时角度和初始角度获取转向控制信号的死区值以及转向模式匹配信息;
[0052]具体地,步骤S103可以包括:
[0053]PlOl:产生转向控制信号;
[0054]P102:将上述产生的转向控制信号输出到液压阀,液压阀在转向控制信号控制下带动前转向轮转向,同时,重复步骤S102获取前转向轮的调整实时角度;
[0055]P103:将获取的前转向轮的调整实时角度与初始角度做差,判断所述差的绝对值是否为1-5°,若是,记录转向控制信号的死区值;
[0056]P104:根据所述差以及转向控制信号获取转向模式匹配信息。
[0057]可选地,为了便于获得控制信号死区值以及角度增减情况,步骤S103的转向控制信号可设定为占空比随时间不断增大的PWM信号,其间隔时间优选为一秒。同时,所述差的绝对值优选为2°。
[0058]值得一提的是,对于具体的左转向模式和右转向模式,优选采用先后次序依次独立进行,即分别对左转向模式和右转向模式分别实施该农机自动驾驶系统的自动校准方法,分别获取左右转控制信号死区值以及左
当前第1页1 2 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1