一种无人车控制方法及无人割草车技术

本发明专利技术涉及无人车及其控制方法设计，特别涉及一种无人车控制方法及无人割草车。无人车控制方法包括如下步骤：获取无人车当前时刻的位置信息和姿态信息；计算当前时刻所述无人车的位置和航向与规划路径之间是距离偏差和角度偏差；在距离偏差不小于距离偏差阈值以及大于距离偏差阈值时，分别获取无人车转向机构的转向角度；将获得的所述无人车转向机构的转向角度以控制指令形式发送至无人车。本发明专利技术的无人车控制方法及无人割草车，能够获得无人割草车精确位置和姿态信息，结合规划路径计算得到的位置偏差和角度偏差更加精确有效；另外，可以根据不同情形采取不同修正转向策略，能够确保更加迅速的回到正确轨迹上。

【技术实现步骤摘要】
一种无人车控制方法及无人割草车
本专利技术涉及无人车及其控制方法设计，特别涉及一种无人车控制方法及无人割草车。
技术介绍
随着科学技术的快速发展，无人车发展越来越受到关注，国内外各大汽车厂商和科技公司都投入大量精力到无人车研发中。无人车是一个集环境感知、路径规划和决策控制等多种功能于一体的综合机器人系统。其中，决策控制相当于无人车的大脑，其主要功能是依据感知系统获得的信息来进行决策判断，进而对下一步的行为进行决策，控制车辆如何行进。因此，决策控制技术是无人车系统中的关键性技术。决策控制系统的行为分为反应式、反射式和综合式。其中，反应式控制是一个反馈控制的过程，是根据车辆当前位置与期望路径的偏差，不断调节方向盘转角和车速，直到到达目的地。但是，仅仅简单通过位置偏差获得轨迹跟踪控制还无法顺畅控制无人车。为了解决上述问题，目前的一些无人车，是通过高清摄像机、激光扫描仪和雷达传感器等来观察周边道路和障碍物信息，从而建立轨迹跟踪控制算法，但此类方法算法复杂，实现难度大，且不是适合在野外场合使用。另外，无人割草车是无人车技术在特定场合的应用实例，其主要应用在大型机场草坪修整作业中。无人割草车通过GPS卫星导航仪采集作业地图边界信息，并规划最优行进路径在区域内进行遍历割草作业。因此，如何控制无人割草车按照规划的路径行进实现区域内全覆盖遍历割草作业的轨迹跟踪控制方法成为重中之重。
技术实现思路
本专利技术的目的是提供了一种无人车控制方法及无人割草车，以解决现有无人车及无人割草车控制方法存在的至少一个问题。本专利技术的技术方案是：一种无人车控制方法，包括如下步骤：步骤一、获取无人车当前时刻的位置信息和姿态信息；步骤二、计算当前时刻所述无人车的位置和航向与规划路径之间是距离偏差和角度偏差；步骤三、通过将所述距离偏差与设置的距离偏差阈值进行比较，并结合所述角度偏差，获取所述无人车转向机构的转向角度，具体包括：当所述距离偏差不小于距离偏差阈值时，通过如下公式(1)获得转向角度θ：其中，a1、b1为系数，θmax为无人车转向机构的最大转向角度，dt为所述距离偏差阈值，d无车中点与规划路径之间的垂直距离，α为当前时刻无人车与规划路径之间的角度偏差；当所述距离偏差大于距离偏差阈值时，通过如下关系式(2)获得转向角度θ：其中，θ为正值表示左转向，为负值表示右转向；步骤四、将获得的所述无人车转向机构的转向角度以控制指令形式发送至无人车的转向电机。可选的，在所述步骤三之后且在所述步骤四之前还包括如下步骤：通过如下阶梯函数(3)对获得的转向角度进行修正：其中，θ，为此步骤修正后的转向角度；另外，所述步骤四是将所述修正后的转向角度以控制指令形式发送至无人车的转向电机。可选的，在所述阶梯函数对获得的转向角度进行修正步骤中还包括：在所述阶梯函数基础上增加回型函数，从而对获得的转向角度进行修正。可选的，在所述步骤三之后且在所述步骤四之前还包括如下步骤：根据无人车当前时刻车速情况对转向角度进行修正，具体是采用如下关系式(4)进行修正：其中，a2、b2为系数，v无人车当前时刻车速。可选的，所述距离偏差阈值等于无人车当前时刻最大车速乘以指令周期。本专利技术还提供了一种无人割草车，采用上述任一项所述的无人车控制方法进行控制，其中，所述无人割草车包括：第一卫星接收天线，固定设置在所述无人割草车后轮轴中心位置；第二卫星接收天线，固定设置在所述无人割草车前轮轴中心位置；GPS-RTK接收机，固定设置在所述无人割草车上，用于根据与其连接的所述第一卫星接收天线和第二卫星接收天线接收到的信息，获取所述无人割草车当前时刻的位置信息和姿态信息；控制器，固定设置在所述无人割草车上，所述控制器用于：根据所述无人割草车当前时刻的位置信息和姿态信息，计算当前时刻所述无人割草车的位置和航向与规划路径之间是距离偏差和角度偏差；通过将所述距离偏差与设置的距离偏差阈值进行比较，并结合所述角度偏差，计算所述无人割草车转向机构的转向角度；将获得的所述无人割草车转向机构的转向角度以控制指令形式发送至所述无人割草车的转向电机。可选的，所述控制器还用于通过阶梯函数对获得的转向角度进行修正，将所述修正后的转向角度以控制指令形式发送至无人割草车的转向电机。可选的，所述控制器还用于在所述阶梯函数基础上增加回型函数，从而对获得的转向角度进行修正。可选的，所述控制器还用于根据无人割草车当前时刻车速情况对转向角度进行修正。可选的，所述无人割草车割台的有效割幅与实际割幅采用如下关系式(5)进行确定：L≤S-2·D(5)；其中，L为有效割幅，S为实际割幅，D为无人割草车轨迹跟踪控制精度偏差。专利技术效果：本专利技术的无人车控制方法及无人割草车，能够获得无人割草车精确位置和姿态信息，结合规划路径计算得到的位置偏差和角度偏差更加精确有效；另外，可以根据不同情形采取不同纠偏转向策略，能够确保更加迅速的回到正确轨迹上。附图说明图1是本专利技术无人割草车小偏差纠偏转向示意图；图2是本专利技术无人割草车大偏差纠偏转向的一个示意图；图3是本专利技术无人割草车大偏差纠偏转向的另一示意图；图4是本专利技术无人割草车转向角度阶梯函数示意图；图5是本专利技术无人割草车转向角度死区设置示意图；图6是本专利技术无人割草车的轨迹跟踪控制仿真效果图。具体实施方式为使本专利技术实施的目的、技术方案和优点更加清楚，下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行更加详细的描述。在附图中，自始至终相同或类似的标号表示相同或类似的元件或具有相同或类似功能的元件。所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。下面通过参考附图描述的实施例是示例性的，旨在用于解释本专利技术，而不能理解为对本专利技术的限制。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。下面结合附图对本专利技术的实施例进行详细说明。在本专利技术的描述中，需要理解的是，术语“中心”、“纵向”、“横向”、“前”、“后”、“左”、“右”、“竖直”、“水平”、“顶”、“底”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系，仅是为了便于描述本专利技术和简化描述，而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作，因此不能理解为对本专利技术保护范围的限制。下面结合附图1至图6对本专利技术无人车控制方法及无人割草车做进一步详细说明。本专利技术提供了一种无人车控制方法(无人车的轨迹跟踪控制方法)，是控制无人车的转向角度及速度使其达到沿规划轨迹运行的过程。采用GPS-RTK卫星导航技术，在无人车上布置卫星接收天线来获取无人车精确位置和姿态信息，结合规划路径计算得到的位置偏差(即距离偏差)和角度偏差。以位置偏差和角度偏差为基础建立无人割草车轨迹跟踪纠偏算法，设定多个位置偏移阈值和角度偏移阈值，在小偏差范围内的转向角度线性连续变化，在超出阈值范围时，采用大转向角度控制无人车尽快返回到正确运行轨迹上。针对不同转向执行机构可以选择性在转向角度控制上增加阶梯函数、回型函数和速度函数来优化转向角度。需要说明的是，本专利技术的无人车控制方法可以根据需要应用到多种适合的无人车上；下面以无人割草车为例进行详细说明。本专利技术的无人割草车采用GPS-RTK技术获取定位导航信本文档来自技高网...

【技术保护点】
一种无人车控制方法，其特征在于，包括如下步骤：步骤一、获取无人车当前时刻的位置信息和姿态信息；步骤二、计算当前时刻所述无人车的位置和航向与规划路径之间是距离偏差和角度偏差；步骤三、通过将所述距离偏差与设置的距离偏差阈值进行比较，并结合所述角度偏差，获取所述无人车转向机构的转向角度，具体包括：当所述距离偏差不小于距离偏差阈值时，通过如下公式(1)获得转向角度θ：

【技术特征摘要】
1.一种无人车控制方法，其特征在于，包括如下步骤：步骤一、获取无人车当前时刻的位置信息和姿态信息；步骤二、计算当前时刻所述无人车的位置和航向与规划路径之间是距离偏差和角度偏差；步骤三、通过将所述距离偏差与设置的距离偏差阈值进行比较，并结合所述角度偏差，获取所述无人车转向机构的转向角度，具体包括：当所述距离偏差不小于距离偏差阈值时，通过如下公式(1)获得转向角度θ：其中，a1、b1为系数，θmax为无人车转向机构的最大转向角度，dt为所述距离偏差阈值，d无车中点与规划路径之间的垂直距离，α为当前时刻无人车与规划路径之间的角度偏差；当所述距离偏差大于距离偏差阈值时，通过如下关系式(2)获得转向角度θ：其中，θ为正值表示左转向，为负值表示右转向；步骤四、将获得的所述无人车转向机构的转向角度以控制指令形式发送至无人车的转向电机。2.根据权利要求1所述的无人车控制方法，其特征在于，在所述步骤三之后且在所述步骤四之前还包括如下步骤：通过如下阶梯函数(3)对获得的转向角度进行修正：其中，θ，为此步骤修正后的转向角度；另外，所述步骤四是将所述修正后的转向角度以控制指令形式发送至无人车的转向电机。3.根据权利要求2所述的无...

【专利技术属性】
技术研发人员：张孝勇，郑友胜，陈寿辉，齐洪豪，谢训鹏，吴添成，
申请(专利权)人：江西洪都航空工业集团有限责任公司，
类型：发明
国别省市：江西,36