申请/专利权人：上海联适导航技术股份有限公司

申请日：2023-12-01

公开（公告）日：2024-06-25

公开（公告）号：CN117629221B

主分类号：G01C21/20

分类号：G01C21/20;G06F30/20;G06F111/04

优先权：

专利状态码：有效-授权

法律状态：2024.06.25#授权;2024.03.19#实质审查的生效;2024.03.01#公开

摘要：本发明涉及自动驾驶技术领域，具体为一种对角耙地路径规划方法。为解决现有的耙地路径规划方法对不规则地块适应性较差，以及算法效率过低的问题，本发明提供了一种基于最近邻算法来生成近似最优对角耙地路径的方法。根据对角耙地作业基本规则来计算不同条带间的转弯成本和约束列表，在满足约束的条件下，依次在当前点的给定邻域范围内搜索成本最小的路径，直到所有条带都被加入路径。本发明深度融合了实际对角耙地作业的农艺需求，提高了对不规则地块的适应性，结合最近邻局部搜索的特点提高算法效率，能够在合理时间内生成覆盖率较高、重叠率较低的对角耙地路径。

主权项：1.一种对角耙地路径规划方法，其特征在于，该规划方法包括：S100：空间预处理；S200：对角条带生成；S300：成本矩阵计算；S400：约束列表计算；S500：基于最邻近算法的路径搜索；S600：路径后处理；所述的步骤S100中，定义地块边界，根据地块边界生成安全边界、作业区边界、约束内边界以及约束外边界四个边界；1将地块边界向地块内部等距偏移一个d_s距离，生成安全边界；2将安全边界向地块内部等距偏移一个r·f1距离，生成作业区边界；3将作业区边界向地块内部等距偏移一个r·f2距离，生成约束内边界；4将作业区边界向地块外部等距偏移一个r·f3距离，生成约束外边界；其中d_s为安全距离，r为车辆转弯半径，f1为作业区宽度比例因子，f2为内边界偏移比例因子，f3为外边界偏移比例因子，且f1，f2，f3均大于0；所述的步骤S200中，选择地块边界上的最长边作为参考边，第一组条带的方向为方向一，与参考边的夹角为β1，第二组条带的方向为方向二，方向二与参考边的夹角β2为：β2＝π-2·β1分别沿方向一和方向二以间隔w生成两组覆盖地块的等间隔平行条带，两组条带为交叉网格状，其中，w为作业幅宽，π为圆周率；所述的步骤S300中，在条带生成完成后，获取条带端点，计算每两个端点Pi和Pj之间的转弯成本costij，形成成本矩阵；成本的计算涉及到三层判断，其中第一层为同条带判断，第二层为两点距离判断，第三层包括外边界超出判断以及内边界穿过判断两个部分；首先，判断点Pi和点Pj是否在同一条带上，若在同一条带上，则costij＝0；若不在同一条带上，则进入第二层判断；在第二层判断，计算点Pi和点Pj之间的距离dij，若dijd_m，则costij＝dij·f4，否则进入第三层判断；在第三层判断，计算点Pi到点Pj的杜宾斯曲线及其长度依次进行以下两个判断：若点Pi到点Pj的杜宾斯曲线超出了约束外边界，则costij＝M，否则若点Pi到点Pj的杜宾斯曲线穿过了约束内边界，则否则重复上述判断步骤直到每对端点之间的转弯成本都计算完成，其中，f5为交点距离比例因子，f4，f6，f7为成本权重，f4，f5，f6，f7均大于0，d_m为设定的距离阈值，d_m0，M为正数，作用是使得到达成本足够大，避免超出约束外边界的路径；所述的步骤S400中，约束列表用于存储不可通行的路径，约束列表的计算涉及到以下两个判断条件：若点Pi到点Pj的杜宾斯曲线超出了约束外边界，则点Pi到点Pj的路径不合理，将[Pi,Pj]加入约束列表；若点Pi到点Pj的杜宾斯曲线穿过了约束内边界，则点Pi到点Pj的路径不合理，将[Pi,Pj]加入约束列表；所述的步骤S500中，指定起点为Ps，针对不在以Ps为起点的约束列表中的其他点进行搜索，选择到达成本最小的点作为下一个点，加入路径，不断以当前到达点为起点，寻找符合约束的下一个目标点，直到所有条带端点都被加入路径，若带搜索的点全部属于当前起点的约束列表，则选择约束列表中到达成本最小的点加入路径；所述的S600中，通过路径搜索确定条带连接顺序后，按照顺序用杜宾斯曲线连接各条带，生成转弯路径，依次判断所生成的转弯路径是否在安全边界内，若超出安全边界，需要进行以下路径后处理：将转弯路径起点所在条带从该起点处向地块内部按照步长d_step收缩，判断起点收缩后的转弯路径是否在安全边界内，若在，则停止收缩，用收缩后的新起点代替原起点，否则继续下一步处理；将转弯路径终点所在条带从该终点处向地块内部按照步长d_step收缩，判断终点收缩后的转弯路径是否在安全边界内，若在，则停止收缩，用收缩后的新终点代替原终点，否则继续下一步处理；将转弯路径的起点和终点所在条带分别从该起点、终点处向地块内部按照步长d_step收缩，直到起、终点收缩后的转弯路径处于安全边界内，用新的起、终点代替原起、终点；处理完所有转弯路径后，得到最终的耙地路径点集。

全文数据：

权利要求：

百度查询： 上海联适导航技术股份有限公司 一种对角耙地路径规划方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息，力求客观、公正，但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解，仅供参考使用，不能作为本公司承担任何法律责任的依据或者凭证。

阅读全文 双屏查看 官方信息 专利公告 收藏专利 下载PDF 下载WORD