一种农业机械自动导航路径规划方法及系统

摘要

本发明公开了一种农业机械自动导航路径规划方法及系统。所述农业机械自动导航路径规划方法包括：由每行作业的起点、每行作业的终点和作业幅宽确定多条作业路径；获取农业机械的当前作业方向和当前位置；计算农业机械的当前位置与当前作业路径的偏移量；由偏移量判断农业机械在当前位置是否偏离当前作业路径，并调整农业机械的行进方向；由当前作业路径、当前距离和当前夹角对行进方向调整后的农业机械进行地头检测，得到地头检测结果；由地头检测结果确定下一时刻的作业路径，返回获取农业机械的当前作业方向和当前位置的步骤，直至作业完成。本发明能够有效地实现农业智能化机械在田间自动作业时的自动路径规划，从而提高工作效率。