[发明专利]一种基于激光雷达的果园车辆自动导航控制系统

摘要

一种基于激光雷达的果园车辆自动导航控制系统，它采用激光雷达获取树干点云数据并进行预处理；对预处理结果进行树干起止点识别，计算树干中心坐标；结合K‑Means算法和最小二乘法拟合树行直线，根据拟合树行直线的中心线导航路径构建增量式PD控制器作为导航控制器。本发明通过使用的激光雷达获取树干点云数据，从而通过识别树干起止点计算树干中心坐标展开计算和操作，大幅改善果园导航过程中植株缺失、车辆偏航等问题。其次，本发明提供的自动导航控制系统测距精度高、分辨率好以及抗干扰强，能够快速得到树干准确的信息和位置。