CN109141338B - 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法 - Google Patents

一种基于贝塞尔曲线拟合路径的农机作业面积计算方法 Download PDF

Info

Publication number
CN109141338B
CN109141338B CN201810792640.9A CN201810792640A CN109141338B CN 109141338 B CN109141338 B CN 109141338B CN 201810792640 A CN201810792640 A CN 201810792640A CN 109141338 B CN109141338 B CN 109141338B
Authority
CN
China
Prior art keywords
points
fitting
bezier curve
point
time
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201810792640.9A
Other languages
English (en)
Other versions
CN109141338A (zh
Inventor
纪郭军
吴琼
张超
周瑾
袁本银
刘合丽
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Shanghai Huace Navigation Technology Ltd
Original Assignee
Shanghai Huace Navigation Technology Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Shanghai Huace Navigation Technology Ltd filed Critical Shanghai Huace Navigation Technology Ltd
Priority to CN201810792640.9A priority Critical patent/CN109141338B/zh
Publication of CN109141338A publication Critical patent/CN109141338A/zh
Application granted granted Critical
Publication of CN109141338B publication Critical patent/CN109141338B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01B—MEASURING LENGTH, THICKNESS OR SIMILAR LINEAR DIMENSIONS; MEASURING ANGLES; MEASURING AREAS; MEASURING IRREGULARITIES OF SURFACES OR CONTOURS
    • G01B21/00—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant
    • G01B21/28—Measuring arrangements or details thereof, where the measuring technique is not covered by the other groups of this subclass, unspecified or not relevant for measuring areas

Landscapes

  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

本发明提供了一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，包括以下步骤：步骤(1)：去除所有非作业状态的点；步骤(2)：在所有作业的坐标点中找出时间间隔不连续的相邻点，根据这些相邻点的方向角及速度拟合中间点；步骤(3)：将时间连续但方向角呈钝角的相邻点找出，根据两点的方向角及速度拟合边界顶点；步骤(4)：将原始作业中的点与拟合点的集合按时间顺序连线，并将连线向外按幅宽以90度角缓冲，去除重叠区域，形成一个缓冲后的不规则图形，然后计算缓冲后的图形面积，本发明解决了的目前农机作业面积计算的不足，结合农机作业实际场景参数，最大程度上提升了面积计算准确度，稳定性，可靠性。

Description

一种基于贝塞尔曲线拟合路径的农机作业面积计算方法
技术领域
本发明涉及智慧农业领域，具体涉及到一种基于贝塞尔曲线拟合路径的农机作业面积计算方法。
背景技术
近年来，随着智慧农业的发展，农机自动化越来越普及，自动计算农机作业面积的需求越来迫切。因为作业场景的复杂性以及农机作业的随机性导致大多数场景无法精确计算作业面积。
现有的农机作业面积算法一般有面积格点覆盖法、幅宽法、线路经法，但是存在着诸多不足的地方。例如：常见的格点覆盖法对农机速度过于理想化，当农机非匀速行驶时很容易出现漏算重算现象；现有的幅宽法都没有考虑坐标点漏传，顶点掉头等问题，计算精确度存在较大误差，线路径法没有综合考虑方向速度因素带来的误差。
发明内容
为了解决上述不足的缺陷，本发明提供了一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，解决了上述的目前农机作业面积计算的不足，结合农机作业实际场景参数，最大程度上提升了面积计算准确度，稳定性，可靠性。
本发明提供了一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，包括以下步骤：
步骤(1)：去除所有非作业状态的点；
步骤(2)：在所有作业的坐标点中找出时间间隔不连续的相邻点，根据这些相邻点的方向角及速度拟合中间点；
步骤(3)：将时间连续但方向角呈钝角的相邻点找出，根据两点的方向角及速度拟合边界顶点；
步骤(4)：将原始作业中的点与拟合点的集合按时间顺序连线，并将连线向外按幅宽以90度角缓冲，去除重叠区域，形成一个缓冲后的不规则图形，然后计算缓冲后的图形面积。
上述的方法，其中，所述步骤(2)和步骤(3)中拟合方式使用三阶贝塞尔曲线拟合方式。
上述的方法，其中，还包括将采集的坐标、速度、方位角、作业状态、时间数据，并将按时间顺序缓存入存储介质内，不间断将存储介质内的数据通过TCP协议有序发送到服务器。
上述的方法，其中，所述步骤(1)包括：服务器接收到数据后，判断为非作业状态则不作处理；作业模块自动将作业状态的点与前一点比较，若时间间隔>＝10s,则基于贝塞尔曲线进行中间点拟合，拟合点数为间隔时间/5取整；若时间间隔<10s且方向角呈钝角，则基于贝塞尔曲线进行边界顶点拟合，拟合点数为时间间隔整数秒。
上述的方法，其中，所述三阶贝塞尔曲线拟合方式具体包括：
贝塞尔曲线采用三次方公式，具体为
B(t)＝P0(1-t)3+3P1t(1-t)2+3P2t2(1-t)+P3t3，t∈[0，1]，
其中P0,P3为已知相邻点，假设P0点速度为V0,P0与P3的时间间隔为T0，P1(x1,y1)，P2(x2,y2)点为P0(x0，y0)与P3(x2,y2)点沿方位角r1，r2以速度V0m/s运行(1/3)T0s所到大的点；
以及x1＝x0+(V0*T0/3)*cos(r1)
y1＝y0+(V0*T0/3)*sin(r1)
x2＝x3-(V0*T0/3)*cos(|r2|)
y2＝y3-(V0*T0/3)*sin(|r2|)；通过上述的公式，P0、P1、P2、P3已知，则可以求出任意时刻贝塞尔曲线上点的位置。
本发明提供了一种基于贝塞尔曲线拟合路径的农机作业面积计算方法具有以下有益效果：1、相比于线路径或幅宽法考虑了时间不连续性带来的误差。2、相比于线路径法考虑了速度、角度变化带来的误差。3、本发明方法通过优化坐标集合，精确计算出农机作业的面积。4、本发明方法可适应各种已知作业类型及不规则田地的计算。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述，本发明及其特征、外形和优点将会变得更明显。在全部附图中相同的标记指示相同的部分。并未刻意按照比例绘制附图，重点在于示出本发明的主旨。
图1为本发明方法的流程图；
图2为本发明方法的不连续点拟合图；
图3为本发明方法的边界顶点拟合图；
图4为三阶贝塞尔曲线中P1、P2控制点的确定示意图；
图5、图6为基于点连线的缓冲示意图。
具体实施方式
在下文的描述中，给出了大量具体的细节以便提供对本发明更为彻底的理解。然而，对于本领域技术人员而言显而易见的是，本发明可以无需一个或多个这些细节而得以实施。在其他的例子中，为了避免与本发明发生混淆，对于本领域公知的一些技术特征未进行描述。
为了彻底理解本发明，将在下列的描述中提出详细的步骤以及详细的结构，以便阐释本发明的技术方案。本发明的较佳实施例详细描述如下，然而除了这些详细描述外，本发明还可以具有其他实施方式。
参照图1-图6所示，本发明提供的一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，包括以下步骤：
步骤(1)：去除所有非作业状态的点；其中还包括将采集的坐标、速度、方位角、作业状态、时间数据，并将按时间顺序缓存入存储介质内，不间断将存储介质内的数据通过TCP协议有序发送到服务器；以及服务器接收到数据后，判断为非作业状态则不作处理；作业模块自动将作业状态的点与前一点比较，若时间间隔>＝10s,则基于贝塞尔曲线进行中间点拟合，拟合点数为间隔时间/5取整；若时间间隔<10s且方向角呈钝角，则基于贝塞尔曲线进行边界顶点拟合，拟合点数为时间间隔整数秒。
步骤(2)：在所有作业的坐标点中找出时间间隔不连续的相邻点，根据这些相邻点的方向角及速度拟合中间点；
步骤(3)：将时间连续但方向角呈钝角的相邻点找出，根据两点的方向角及速度拟合边界顶点；其中步骤(2)和步骤(3)中拟合方式使用三阶贝塞尔曲线拟合方式。其中三阶贝塞尔曲线拟合方式具体包括：
贝塞尔曲线采用三次方公式，具体为
B(t)＝P0(1-t)3+3P1t(1-t)2+3P2t2(1-t)+P3t3，t∈[0，1]，其中P0,P3为已知相邻点，假设P0点速度为V0,P0与P3的时间间隔为T0，P1(x1,y1)，P2(x2,y2)点为P0(x0，y0)与P3(x2,y2)点沿方位角r1，r2以速度V0m/s运行(1/3)T0s所到大的点；
以及x1＝x0+(V0*T0/3)*cos(r1)
y1＝y0+(V0*T0/3)*sin(r1)
x2＝x3-(V0*T0/3)*cos(|r2|)
y2＝y3-(V0*T0/3)*sin(|r2|)；通过上述的公式，P0、P1、P2、P3已知，则可以求出任意时刻贝塞尔曲线上点的位置。
步骤(4)：将原始作业中的点与拟合点的集合按时间顺序连线，并将连线向外按幅宽以90度角缓冲，去除重叠区域，形成一个缓冲后的不规则图形，然后计算缓冲后的图形面积。本发明相比于线路径或幅宽法考虑了时间不连续性带来的误差。相比于线路径法考虑了速度、角度变化带来的误差。本发明方法通过优化坐标集合，精确计算出农机作业的面积。本发明方法可适应各种已知作业类型及不规则田地的计算。
在本发明中，需使用的源数据包括：坐标采集间隔，有序的高精度农机的坐标、时间、作业幅宽、速度、方向角、作业状态等信息。
以下具体本发明的具体应用实施例
实施例1
参照图1-图6所示，本发明提供的一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，本发明使用华测农机导航产品进行数据上传，定位模块使用定位精度为0.5m的华测RTK产品，使用速度方位角传感器进行速度、方位角及作业状态数据采集。导航产品5s采集一次坐标、速度、方位角、作业状态、时间数据，将以上数据按时间顺序缓存入存储介质内，导航产品不间断将存储介质内的数据通过TCP协议有序发送到服务器；
服务器接收到数据后，判断为非作业状态则不作处理。作业模块自动将作业状态的点与前一点比较，若时间间隔>＝10s,则基于贝塞尔曲线进行中间点拟合，拟合点数为间隔时间/5取整。若时间间隔<10s且方向角呈钝角，则基于贝塞尔曲线进行边界顶点拟合，拟合点数为时间间隔整数秒；
将所有点按顺序连线，连线后以幅宽长度呈90°向外缓冲，计算缓冲后的图像面积即为作业面积；
其中，基于贝塞尔曲线的拟合方法：
1)贝塞尔曲线采用三次方公式
B(t)＝P0(1-t)3+3P1t(1-t)2+3P2t2(1-t)+P3t3，t∈[0，1]
2)P0,P3为已知相邻点，假设P0点速度为V0,P0与P3的时间间隔为T0，P1(x1,y1)，P2(x2,y2)点为P0(x0，y0)与P3(x2,y2)点沿方位角r1，r2以速度V0m/s运行(1/3)T0s所到大的点,见附图4
x1＝x0+(V0*T0/3)*cos(r1)
y1＝y0+(V0*T0/3)*sin(r1)
x2＝x3-(V0*T0/3)*cos(|r2|)
y2＝y3-(V0*T0/3)*sin(|r2|)
3)基于1)的公式，P0、P1、P2、P3已知，则可以求出任意时刻贝塞尔曲线上点的位置。
本实施例1相比于线路径或幅宽法考虑了时间不连续性带来的误差。相比于线路径法考虑了速度、角度变化带来的误差。通过优化坐标集合，精确计算出农机作业的面积。可适应各种已知作业类型及不规则田地的计算，解决了目前农机作业面积计算的不足，结合农机作业实际场景参数，最大程度上提升了面积计算准确度，稳定性，可靠性。
以上对本发明的较佳实施例进行了描述。需要理解的是，本发明并不局限于上述特定实施方式，其中未尽详细描述的设备和结构应该理解为用本领域中的普通方式予以实施；任何熟悉本领域的技术人员，在不脱离本发明技术方案范围情况下，都可利用上述揭示的方法和技术内容对本发明技术方案做出许多可能的变动和修饰，或修改为等同变化的等效实施例，这并不影响本发明的实质内容。因此，凡是未脱离本发明技术方案的内容，依据本发明的技术实质对以上实施例所做的任何简单修改、等同变化及修饰，均仍属于本发明技术方案保护的范围内。

Claims (1)

1.一种基于贝塞尔曲线拟合路径的农机作业面积计算方法，其特征在于，包括以下步骤：步骤(1)：去除所有非作业状态的点；
步骤(2)：在所有作业的坐标点中找出时间间隔不连续的相邻点，根据这些相邻点的方向角及速度拟合中间点；
步骤(3)：将时间连续但方向角呈钝角的相邻点找出，根据两点的方向角及速度拟合边界顶点；
步骤(4)：将原始作业中的点与拟合点的集合按时间顺序连线，并将连线向外按幅宽以90度角缓冲，去除重叠区域，形成一个缓冲后的不规则图形，然后计算缓冲后的图形面积；所述步骤(2)和步骤(3)中拟合方式使用三阶贝塞尔曲线拟合方式，还包括将采集的坐标、速度、方位角、作业状态、时间数据，并将按时间顺序缓存入存储介质内，不间断将存储介质内的数据通过TCP协议有序发送到服务器，所述步骤(1)包括：服务器接收到数据后，判断为非作业状态则不作处理；作业模块自动将作业状态的点与前一点比较，若时间间隔>＝10s,则基于贝塞尔曲线进行中间点拟合，拟合点数为间隔时间/5取整；若时间间隔<10s且方向角呈钝角，则基于贝塞尔曲线进行边界顶点拟合，拟合点数为时间间隔整数秒，所述三阶贝塞尔曲线拟合方式具体包括：贝塞尔曲线采用三次方公式，具体为
B(t)＝P0(1-t)3+3P1t(1-t)2+3P2t2(1-t)+P3t3，t∈[0，1]其中P0，P3为已知相邻点，假设P0点速度为V0，P0与P3的时间间隔为T0，P1(x1，y1)，P2(x2，y2)点为P0(x0，y0)与P3(x2，y2)点沿方位角r1，r2以速度V0m/s运行(1/3)T0s所到大的点；
以及x1＝x0+(V0*T0/3)*cos(r1)
y1＝y0+(V0*T0/3)*sin(r1)
x2＝x3-(V0*T0/3)*cos(|r2|)
y2＝y3-(V0*T0/3)*sin(|r2|)；通过上述的公式，P0、P1、P2、P3已知，则可以求出任意时刻贝塞尔曲线上点的位置。
CN201810792640.9A 2018-07-18 2018-07-18 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法 Active CN109141338B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810792640.9A CN109141338B (zh) 2018-07-18 2018-07-18 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810792640.9A CN109141338B (zh) 2018-07-18 2018-07-18 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法

Publications (2)

Publication Number Publication Date
CN109141338A CN109141338A (zh) 2019-01-04
CN109141338B true CN109141338B (zh) 2021-03-26

Family

ID=64800782

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810792640.9A Active CN109141338B (zh) 2018-07-18 2018-07-18 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法

Country Status (1)

Country Link
CN (1) CN109141338B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112330031B (zh) * 2020-11-09 2024-08-06 深圳市华信天线技术有限公司 一种农机作业区域的确定方法、装置、设备及可读介质
CN113405519B (zh) * 2021-01-29 2023-07-18 丰疆智能(深圳)有限公司 农机的作业亩数计算方法和农机的作业亩数计算系统
CN114526669A (zh) * 2022-02-22 2022-05-24 上海联适导航技术股份有限公司 一种农机作业实时整平面积测算方法、装置及设备
CN115876184B (zh) * 2023-02-22 2023-07-14 武汉依迅北斗时空技术股份有限公司 基于轨迹分析的农机作业田地判别方法、装置及电子设备

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3445010B2 (ja) * 1995-02-23 2003-09-08 キヤノン株式会社 ベジェ曲線と２次元図形との交点算出方法及びこれを実現する図形処理装置
CN102998684A (zh) * 2012-11-21 2013-03-27 厦门雅迅网络股份有限公司 一种基于贝塞尔曲线的终端定位轨迹拟合方法
CN103218618A (zh) * 2013-01-09 2013-07-24 重庆交通大学 一种基于遥感数字图像的公路路线自动提取方法
CN106202931A (zh) * 2016-07-08 2016-12-07 浙江联辉智能科技有限公司 一种农机作业面积算法
CN106910219A (zh) * 2017-04-11 2017-06-30 南京嘉谷初成通信科技有限公司 一种基于几何方式统计农机工作面积的方法
CN107036572A (zh) * 2017-04-12 2017-08-11 中国农业大学 一种农机作业面积获取方法及装置

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP3445010B2 (ja) * 1995-02-23 2003-09-08 キヤノン株式会社 ベジェ曲線と２次元図形との交点算出方法及びこれを実現する図形処理装置
CN102998684A (zh) * 2012-11-21 2013-03-27 厦门雅迅网络股份有限公司 一种基于贝塞尔曲线的终端定位轨迹拟合方法
CN103218618A (zh) * 2013-01-09 2013-07-24 重庆交通大学 一种基于遥感数字图像的公路路线自动提取方法
CN106202931A (zh) * 2016-07-08 2016-12-07 浙江联辉智能科技有限公司 一种农机作业面积算法
CN106910219A (zh) * 2017-04-11 2017-06-30 南京嘉谷初成通信科技有限公司 一种基于几何方式统计农机工作面积的方法
CN107036572A (zh) * 2017-04-12 2017-08-11 中国农业大学 一种农机作业面积获取方法及装置

Also Published As

Publication number Publication date
CN109141338A (zh) 2019-01-04

Similar Documents

Publication Publication Date Title
CN109141338B (zh) 一种基于贝塞尔曲线拟合路径的农机作业面积计算方法
Zlot et al. Efficient large‐scale three‐dimensional mobile mapping for underground mines
CN104123746B (zh) 一种三维扫描点云中实时法向量的计算方法
CN109828302B (zh) 一种基于多振动传感器的震源定位方法及装置
CN102998684A (zh) 一种基于贝塞尔曲线的终端定位轨迹拟合方法
CN104035083B (zh) 一种基于量测转换的雷达目标跟踪方法
CN101006359A (zh) 轴偏角推定方法及其装置
CN112327329B (zh) 避障方法、目标设备和存储介质
CN114972631A (zh) 一种输电线路激光点云模型在线重建方法及系统
CN112748421A (zh) 一种基于直行路段自动驾驶的激光雷达校准方法
CN111637877B (zh) 机器人定位方法、装置、电子设备和非易失性存储介质
CN113310505B (zh) 传感器系统的外参标定方法、装置及电子设备
CN109977829A (zh) 基于图像识别分析技术的流速检测方法及装置
CN110930444B (zh) 一种基于双边优化的点云匹配方法、介质、终端和装置
CN111145634B (zh) 一种校正地图的方法及装置
CN118298009A (zh) 一种方向角识别方法、装置及边缘检测设备
CN109781116B (zh) 基于有源传感器均值迭代的误差自校准融合定位方法
CN113376648B (zh) 基于激光雷达探测的高速非合作目标轨迹提取方法
CN115540875B (zh) 一种用于股道内列车车辆高精度检测定位的方法及系统
CN104020468A (zh) 一种基于二次雷达的近距离目标更新周期的计算方法
CN117233784A (zh) 水下机器人隧洞定位方法、系统、计算机设备及存储介质
CN104655007A (zh) 一种创建环境场景全局坐标方法及系统
CN114474065A (zh) 机器人控制方法及其装置、机器人和存储介质
KR101313307B1 (ko) 영상보정방법 및 장치
CN113671527B (zh) 一种提高配网带电作业机器人的精准作业方法及装置

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant