摘要
本发明公开了一种基于卫星和视觉导航的水田除草机避苗转向方法。除草机转向过程中会将部分苗压倒从而影响作物的生长。本发明先选择最优转向方式,再获得秧苗在世界坐标系中的位置信息,采用人工势场法,根据会压苗的坐标点建立引力势场,根据秧苗位置建立斥力势场计算得到合力,根据合力规划新路径,用这些新的路径坐标点替换掉原来被判断会压苗的路径坐标点,完成对原路径的局部微调;然后计算水田除草机当前姿态下的预瞄距离,并根据新路径与水田除草机位置和姿态的几何关系,采用改进的纯跟踪算法计算水田除草机的前轮目标转角,实现水田除草机在垄头转向时跟踪新路径行驶。