[发明专利]一种收获机器人的植株行跟随方法

摘要

本发明公布了一种收获机器人的植株行跟随方法，包括在收获机器人本体正前方两侧分别设有至少两个激光雷达，并在机器人本体后端设有至少一个视觉传感器，使用激光雷达实现准确的植株识别与定位，以及植株行的方向预测，使用视觉传感器实现本体的航向角估计，从而在无需地图和定位标志物辅助的情况下，实现机器人本体对植株行的实时跟随，同时，对激光数据的聚类和曲线拟合，可以有效提升机器人环境感知的抗噪能力和自主行走的可靠性。

主权项

1.一种收获机器人的植株行跟随方法，其特征在于，在收获机器人本体正前方两侧分别设有至少两个激光雷达，并在机器人本体后端设有至少一个视觉传感器，具体通过以下步骤实现：S1：所述激光雷达至少包括第一激光雷达和第二激光雷达，由第一激光雷达和第二激光雷达对标定物同时进行扫描并分别采集多个激光数据点，将获得的激光数据点通过标定策略分别计算出第二激光雷达相对于第一激光雷达的偏移参数，所述偏移参数包括L、H和A，其中L和H分别代表第二激光雷达的中心相对于第一激光雷达中心在x轴和y轴上的距离，A代表第二激光雷达扫描线零度位置相对于第一激光雷达扫描线零度位置的夹角；S2：第一激光雷达所采集的激光数据点为第一点集D01，第二激光雷达所采集的激光数据点为第二点集D02，根据S1中计算得到的偏移参数对第二点集进行数据修正；S3：对第一点集D01和第二点集D02分别进行聚类，分别得到备选点集G1和备选点集G2；S4：将备选点集G1和备选点集G2合并为表征一个植株的点集G；S5：将表征植株的点集G拟合成一个圆C，并得到表征植株中心的当前圆心坐标O(O_x,O_y)；S6：通过获得的当前圆心坐标O(O_x,O_y)对植株行方向进行预测估算，得到植株行的当前方向估计Dir；S7：通过视觉传感器获得的图像帧，计算得到机器人的当前实际航向角估计值Raw和位移估计；S8：通过航向角估计Raw、位移估计与方向预测Dir，得到机器人本体当前轨迹控制输入参数，并对航向进行调整以保证机器人沿当前植株轨迹方向动作。