买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：北京博创联动科技有限公司

摘要：本申请实施例提供一种田埂避障控制方法、装置和农用自动驾驶设备，该方法包括：实时采集行进方向上的图像；利用田埂识别模型检测图像中是否存在田埂，并对存在田埂的图像进行图像二值化处理，得到前方田埂的点云数据；将该点云数据映射到当前全局的田埂栅格地图中进行匹配，得到与前方田埂匹配的全局田埂地图和该农用自动驾驶设备的当前位姿；根据全局田埂地图和局部路径规划的损失函数，计算农用自动驾驶设备从当前位姿到达指定目标点的田埂避障最佳运动轨迹，以进行田埂避障。该方法可以实现在适合时机进行田埂精准避障，既提高了农业作业的效率，还减少了人力成本等。

主权项：1.一种田埂避障控制方法，其特征在于，应用于农用自动驾驶设备，所述方法包括：实时采集行进方向上的图像；利用田埂识别模型检测所述图像中是否存在田埂，并对存在田埂的图像进行图像二值化处理，得到前方田埂的点云数据；将所述点云数据映射到当前全局的田埂栅格地图中进行匹配，得到与前方田埂匹配的全局田埂地图和所述农用自动驾驶设备的当前位姿，具体包括：从所述点云数据中提取前方田埂的轮廓信息，并基于所述点云数据构建对应的田埂概率地图；对所述田埂概率地图进行方向旋转，以使当前田埂的方向与当前全局的田埂栅格地图的方向匹配，然后利用当前田埂的轮廓宽度与所述全局的田埂栅格地图中的田埂进行宽度粗略匹配，再利用轮廓点云按照单位像素移动和或单位角度旋转进行距离最近匹配，以使所述田埂概率地图的像素坐标值映射到所述全局的田埂栅格地图的坐标值，得到与前方田埂匹配的全局田埂地图，所述全局田埂地图作为下一时刻全局的田埂栅格地图；将与前方田埂匹配时的所述点云数据的拍摄位姿作为所述农用自动驾驶设备的当前位姿；根据所述全局田埂地图和用于局部路径规划的损失函数，计算从所述当前位姿到达指定目标点的田埂避障最佳运动轨迹；根据所述最佳运动轨迹控制所述农用自动驾驶设备进行田埂避障；其中，所述局部路径规划的损失函数的表达式如下：Fx＝w1*Ox+w2*1Rx；其中，式中，Fx表示损失函数，取Fx最小时的运动轨迹作为田埂避障最佳运动轨迹；Ox表示所述农用自动驾驶设备转弯后经过指定目标点的第x条运动轨迹，Max为预设最大值，dis为第x条运动轨迹与前方田埂的最小距离；Rx表示第x条运动轨迹的转弯半径；w1和w2分别为预设的权重，且w1与w2之和等于1。

全文数据：

权利要求：

百度查询： 北京博创联动科技有限公司 田埂避障控制方法、装置和农用自动驾驶设备