一种无人拖拉机控制系统及其控制方法技术方案

本发明专利技术提供了一种无人拖拉机控制方法，包括以下步骤：S1、环境感知模块获取车辆位置信息和环境信息；S2、决策控制模块根据环境信息和车辆位置信息规划行进路径和目标行进速度；S3、决策控制模块根据目标行进速度进行速度控制，同时决策控制模块根据行进路径和车辆位置信息进行转向控制。这种无人拖拉机控制方法先根据车辆位置信息和环境信息规划行进路线，再基于行进路线和目标行进速度对车辆进行转向控制和速度控制，使无人拖拉机在复杂环境下能够以更加安全的行驶速度和更加精准的行驶路线工作，提高了无人拖拉机在复杂环境下的自主作业能力。作业能力。作业能力。

【技术实现步骤摘要】
一种无人拖拉机控制系统及其控制方法


[0001]本专利技术涉及农业机械
，尤其涉及一种无人拖拉机控制系统及其控制方法。

技术介绍

[0002]拖拉机是一种用于牵引和驱动作业机械完成各项移动式作业的自走式动力机。传统的拖拉机一般需要工人手动控制速度和移动的方向，这就需要增加额外的人力成本，而且拖拉机的工作环境一般比较恶劣，工人很容易出现拖拉机控制不当的情况，这会导致拖拉机的行驶方向和行驶速度出现偏差，影响拖拉机工作的效率和质量。

技术实现思路

[0003]本专利技术要解决的技术问题是：为了解决人工控制拖拉机成本高和效率低的问题，本专利技术提供了一种无人拖拉机控制系统及其控制方法来解决上述问题。
[0004]本专利技术解决其技术问题所采用的技术方案是：一种无人拖拉机控制方法，包括以下步骤：S1、环境感知模块获取车辆位置信息和环境信息；S2、决策控制模块根据环境信息和车辆位置信息规划行进路径，决策控制模块根据行进路径的曲率信息和预设的最高行进速度规划目标行进速度；S3、底层控制模块根据目标行进速度进行速度控制，同时底层控制模块根据行进路径和车辆位置信息按照以下步骤进行转向控制：S301、路径跟踪单元根据车辆位置信息和行进路径计算前轮目标转角；S302、转角传感器获取车辆的前轮实际转角；S303、转向控制器根据前轮目标转角和前轮实际转角计算偏差输出转矩值，转向控制器根据偏差输出转矩值控制转向电机工作；S304、转向电机驱动转向器工作，转向器控制车辆的前桥转动，进入步骤S301。
[0005]作为优选，在步骤S3中，速度控制具体包括以下步骤：S311、速度规划单元将目标行进速度发送至纵向控制器；S312、速度传感器获取车辆的实际行进速度，速度传感器将实际行进速度发送至纵向控制器；S313、纵向控制器根据目标行进速度和实际行进速度计算速度差值，纵向控制器判断速度差值是否为0，若速度差值为0则进入步骤S312，否则纵向控制器判断速度差值是否为正数；若速度差值不为正数则进入步骤S314；否则进入步骤S315；S314、纵向控制器控制行走驱动控制器工作，行走驱动控制器控制行走单元工作，行走单元提高车辆的实际行进速度，进入步骤S312；S315、纵向控制器控制制动执行控制器工作，制动执行控制器控制制动单元工作，制动
单元降低车辆的实际行进速度，进入步骤S312。
[0006]本专利技术还提供了一种无人拖拉机控制系统，包括：环境感知模块，所述环境感知模块被配置为获取车辆位置信息和环境信息；决策控制模块，所述决策控制模块与环境感知模块连接，所述决策控制模块被配置为根据车辆位置信息和环境信息规划行进路径，所述决策控制模块还被配置为根据行进路径规划目标行进速度；底层控制模块，所述底层控制模块与决策控制模块连接，所述底层控制模块被配置为根据进行路径和车辆位置信息进行转向控制，所述底层控制模块还被配置为根据目标行进速度进行速度控制；所述决策控制模块包括路径跟踪单元，所述路径跟踪单元用于根据车辆位置信息和环境信息规划行进路径，所述路径跟踪单元还用于根据车辆位置信息和行进路径计算前轮目标转角；所述底层控制模块包括转向控制器和转向单元，所述转向单元包括转向电机、转向器和转角传感器；所述转角传感器用于获取车辆的前轮实际转角，所述转向控制器用于根据前轮目标转角和前轮实际转角计算偏差输出转矩值，所述转向控制器还用于根据偏差输出转矩值控制转向电机工作，所述转向电机用于驱动转向器工作，所述转向器用于控制车辆的前桥转动；所述决策控制模块还包括速度规划单元，所述速度规划单元用于根据行进路径的曲率信息和预设的最高行进速度规划车辆的目标行进速度；所述底层控制模块还包括纵向控制器、行走驱动控制器、行走单元、制动执行控制器、制动单元和速度传感器；所述速度传感器用于获取车辆的实际行进速度，所述纵向控制器与速度规划单元连接，所述速度规划单元能够将目标行进速度传输至纵向控制器，所述纵向控制器用于根据目标行进速度和实际行进速度计算速度差值，所述纵向控制器还用于根据速度差值控制行走驱动控制器和制动执行控制器工作；所述行走驱动控制器用于在所述速度差值为负时对行走单元进行控制，所述行走单元用于提高车辆的实际行进速度；所述制动执行控制器用于在所述速度差值为正时对制动单元进行控制，所述制动单元用于降低车辆的实际行进速度。
[0007]作为优选，所述环境感知模块包括定位单元和环境监测单元；所述定位单元用于获取车辆位置信息，所述定位单元包括GPS、惯性导航模块和里程计；所述环境监测单元用于获取环境信息，所述环境监测单元包括激光雷达和摄像头。
[0008]作为优选，还包括通信模块，所述通信模块被配置为建立决策控制模块和底层控制模块之间的数据联系，所述纵向控制器通过通信模块与速度规划单元连接；所述通信模块还被配置为建立纵向控制器与行走驱动控制器、制动执行控制器和速度传感器之间的数据联系。
[0009]本专利技术的有益效果是，这种无人拖拉机控制方法先根据车辆位置信息和环境信息规划行进路线，再基于行进路线对车辆进行转向控制和速度控制，使无人拖拉机在复杂环境下能够以更加安全的行驶速度和更加精准的行驶路线工作，提高了无人拖拉机在复杂环
境下的自主作业能力。
附图说明
[0010]下面结合附图和实施例对本专利技术进一步说明。
[0011]图1是本专利技术一种无人拖拉机控制系统的最优实施例的系统结构图。
[0012]图2是本专利技术一种无人拖拉机控制系统的最优实施例的结构示意图。
[0013]图3是本专利技术一种无人拖拉机控制系统的最优实施例的结构示意图。
[0014]图4是本专利技术一种无人拖拉机控制方法的最优实施例的流程图。
具体实施方式
[0015]下面详细描述本专利技术的实施例，所述实施例的示例在附图中示出，其中自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。下面通过参考附图描述的实施例是示例性的，仅用于解释本专利技术，而不能理解为对本专利技术的限制。
[0016]在本专利技术的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“长度”、“宽度”、“厚度”、“上”、“下”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”“内”、“外”、“轴向”、“径向”、“周向”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本专利技术和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本专利技术的限制。
[0017]此外，术语“第一”、“第二”等仅用于描述目的，而不能理解为指示或暗示相对重要性。在本专利技术的描述中，需要说明的是，除非另有明确的规定和限定，术语“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是机械连接，也可以是电连接；可以是直接相连，也可以通过中间媒介间接相连。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本专利技术中的具体含义。此外，在本专利技术的描述中，除非另有说明，“多个本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人拖拉机控制方法，其特征在于，包括以下步骤：S1、环境感知模块获取车辆位置信息和环境信息；S2、决策控制模块根据环境信息和车辆位置信息规划行进路径，决策控制模块根据行进路径的曲率信息和预设的最高行进速度规划目标行进速度；S3、底层控制模块根据目标行进速度进行速度控制，同时底层控制模块根据行进路径和车辆位置信息按照以下步骤进行转向控制：S301、路径跟踪单元根据车辆位置信息和行进路径计算前轮目标转角；S302、转角传感器获取车辆的前轮实际转角；S303、转向控制器根据前轮目标转角和前轮实际转角计算偏差输出转矩值，转向控制器根据偏差输出转矩值控制转向电机工作；S304、转向电机驱动转向器工作，转向器控制车辆的前桥转动，进入步骤S301。2.如权利要求1所述的一种无人拖拉机控制方法，其特征在于：在步骤S3中，速度控制具体包括以下步骤：S311、速度规划单元将目标行进速度发送至纵向控制器；S312、速度传感器获取车辆的实际行进速度，速度传感器将实际行进速度发送至纵向控制器；S313、纵向控制器根据目标行进速度和实际行进速度计算速度差值，纵向控制器判断速度差值是否为0，若速度差值为0则进入步骤S312，否则纵向控制器判断速度差值是否为正数；若速度差值不为正数则进入步骤S314；否则进入步骤S315；S314、纵向控制器控制行走驱动控制器工作，行走驱动控制器控制行走单元工作，行走单元提高车辆的实际行进速度，进入步骤S312；S315、纵向控制器控制制动执行控制器工作，制动执行控制器控制制动单元工作，制动单元降低车辆的实际行进速度，进入步骤S312。3.一种无人拖拉机控制系统，其特征在于，包括：环境感知模块，所述环境感知模块被配置为获取车辆位置信息和环境信息；决策控制模块，所述决策控制模块与环境感知模块连接，所述决策控制模块被配置为根据车辆位置信息和环境信息规划行进路径，所述决策控制模块还被配置为根据行进路径规划目标行进速度；底层控制模块，所述底层控制模块与决策控制模块连接，所述底层控制模块被配置为根据进行路径和车辆位置信息进行转向控制，所述底层控...

【专利技术属性】
技术研发人员：陆凤祥，任海勇，卢晓政，
申请(专利权)人：江苏悦达集团有限公司，
类型：发明
国别省市：