The present invention provides agricultural unmanned control of obstacle avoidance and path planning and control method for agricultural technology in the field of unmanned driving, the specific steps for agricultural automatic obstacle avoidance, step 1: through the sensor to obtain agricultural environmental information make obstacle avoidance decision; step 2: the shortest tangent method off-line using improved calculation a theory of obstacle avoidance path; step 3: using the theory of path optimization method optimization step 2 Bezier curve of obstacle avoidance and path to get the actual path of obstacle avoidance based on the use of preview and PI controller combined control of front wheel rotating angle of the agricultural practice along the obstacle avoidance path walking around the obstacle avoidance path in the invention; avoid planning easy to control and walking a short distance, high precision control.
【技术实现步骤摘要】
用于农机无人驾驶的避障路径规划及其控制方法
本专利技术涉及一种自动掉头路径规划及其控制方法,特别涉及一种用于农机无人驾驶的避障路径规划及其控制方法。
技术介绍
农机在自动导航作业时多在环境部分未知的情况下运行,实现对人进行安全保护和对农作物的伤害程度减到最低,同时又能最大的发挥自主导航农业车辆的生产效率,将是一个重要的研究问题,同时农机可能会遇到电线杆、小石块等相对比较小的障碍物,需要农机能自动绕过这些障碍物并迅速回到作业的路线。现有技术中,针对比较小的障碍物,采用最短切线法设置避障路径,最短切线法形成的避障路径由两段直线段和一段圆弧段组成,直线段分别与圆弧段相切,这种避障路径虽然简单快捷,对于具有最小转弯半径的拖拉机很难按照折角进行转弯且很难控制,若控制农机按照这种避障路径行走,农机的控制精度很低;另外,控制农机按照设定好的避障路径行走的控制方法有多种,如BUG算法、人工势场法、VFH算法、模糊逻辑算法、模糊神经网络算法等,这些算法的应用场景均是复杂的作业环境,算法的逻辑复杂,应用于农机作业不复杂的作业环境下,反应速度较慢,反而降低其控制精度;总而言之,无论是路径规划还是避障路径的控制方法,控制农机按照设定好的路径行走的精度很低,偏离设定的避障路径,导致农机绕过障碍物行走的路程远,从开始进入避障路径至回到农机原始直线行走路径的时间长。
技术实现思路
针对现有技术中的缺陷,本专利技术的目的在于克服上述现有技术中的不足之处,解决现有技术中避障路径难控制且控制精度低的技术问题,提供一种用于农机无人驾驶的避障路径规划及其控制方法,本专利技术中的避障路径容易控制且行走 ...
【技术保护点】
一种用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,农机自动绕开障碍物的具体步骤为,步骤1:通过传感器获取农机环境信息做出避障决策;步骤2:使用改进的最短切线法离线计算出一条理论避障路径;步骤3:利用基于Bezier曲线的路径优化方法优化步骤2中的理论避障路径得到实际避障路径,使用预瞄和PI控制器组合起来控制农机的前轮转角使农机沿着实际避障路径行走绕开障碍物。
【技术特征摘要】
2017.01.22 CN 20171004631001.一种用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,农机自动绕开障碍物的具体步骤为,步骤1:通过传感器获取农机环境信息做出避障决策;步骤2:使用改进的最短切线法离线计算出一条理论避障路径;步骤3:利用基于Bezier曲线的路径优化方法优化步骤2中的理论避障路径得到实际避障路径,使用预瞄和PI控制器组合起来控制农机的前轮转角使农机沿着实际避障路径行走绕开障碍物。2.根据权利要求1所述的用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,步骤2中,计算理论避障路径具体地为,计算农机前方障碍物的特征圆的大小、农机与障碍物的距离,根据特征圆的大小设定安全距离,根据农机的犁具宽度和农机最小转弯半径,设定一条理论避障路径。3.根据权利要求2所述的用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,步骤2中,最短切线法具体的为,以障碍物的中心为圆心做特征圆,特征圆的半径为rmin+w/2,理论避障路径由圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三组成,圆弧段一的一端与农机原始的直线路径相切,圆弧段一的另一端与直线段一的一端相切,直线段一的另一端和直线段二的一端分别与圆弧段二相切,直线段二的另一端与圆弧段三相切,圆弧段二为特征圆上的一段,圆弧段一和圆弧段三关于圆弧段二的中心线对称设置,农机依次经过圆弧段一、直线段一、圆弧段二、直线段二和圆弧段三绕过障碍物,其中,rmin为农机的最小转弯半径,w为农机的作业宽度,障碍物的外接圆半径小于最小转弯半径。4.根据权利要求3所述的用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,所述圆弧段一的半径为rmin,所述圆弧段三的半径为rmin,圆弧段一的起点记为H点,圆弧段一的圆心记为O1点,直线段一与农机原始的直线路径的相交点记为J,直线段一与圆弧段二的相切点记为D,农机原始路径与特征圆的相交点分别记为K和K’,JK=w/2,圆弧段二的圆心记为O点,O的坐标设为(a,b),圆弧段二的中心点记为B点,J点的坐标记为(x1,y1),JD的方程可以写成:(1-1);特征圆的方程可以写成:(1-2)通过(1-1)和(1-2)可以求出k,D点为JD和特征圆的相交点,以此解出D点坐标;设点O1的坐标为(x2,y2),则点O1到直线JD的距离为:根据公式(1-3)和(1-4)求出O1的坐标;则H点的坐标为(x2,y1),B点的坐标为(a,b+r)。5.根据权利要求4所述的用于农机无人驾驶的避障路径规划及其控制方法,其特征在于,步骤3中,利用基于Bezier曲线的路径优化方法优化步骤2中的理论避障路径,具体的为,建立Bezier方程,(1)给定空间n+1个点的位置矢量,则参数曲线上各点坐标的插值公式为:(2-1)其中构成该曲线的特征点,是n次Bernstein基函数:(2-2)由上述公式...
【专利技术属性】
技术研发人员:程方,林德相,袁洪良,王烁,徐涛,王浩,吴飞,
申请(专利权)人:无锡卡尔曼导航技术有限公司,
类型:发明
国别省市:江苏,32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。