CN105606049B - 一种相对水面的水田农业机具作业姿态测量方法 - Google Patents
一种相对水面的水田农业机具作业姿态测量方法 Download PDFInfo
- Publication number
- CN105606049B CN105606049B CN201510579291.9A CN201510579291A CN105606049B CN 105606049 B CN105606049 B CN 105606049B CN 201510579291 A CN201510579291 A CN 201510579291A CN 105606049 B CN105606049 B CN 105606049B
- Authority
- CN
- China
- Prior art keywords
- water surface
- angle
- distance measuring
- measuring sensor
- work tool
- 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
Links
Landscapes
- Lifting Devices For Agricultural Implements (AREA)
- Length Measuring Devices With Unspecified Measuring Means (AREA)
Abstract
一种相对水面的水田农业机具作业姿态测量方法包括:a.将水田的水面视作静态并作为测量的基准面,通过固定在作业机具上的二维测距传感器向水田的水面扫描得出水面点集,对水面点集进行拟合得到拟合直线;b.计算二维测距传感器到拟合直线的垂直距离L;计算二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角,即横向倾斜角度β;c.利用三角关系通过垂直距离L得出二维测距传感器的垂直高度,进而得出作业机具相对于水面的垂直高度H;d.将垂直高度H和横向倾斜角度β分别与设定值比较,实现作业机具的姿态控制。无需外加参考基准而获得水田作业机具的姿态信息,可用于水田作业机具姿态控制,属于智能农业机械领域。
Description
技术领域
本发明涉及智能农业机械领域,特别涉及一种相对水面的水田农业机具作业姿态测量方法。
背景技术
平整的水田可以保证农田水层深浅一致,节省农业用水;可以减少农药、化肥和除草剂的使用量,提高农药、化肥和除草剂的使用效率,进而减少生产成本和对环境的污染;可以增加农作物产量,促进农业可持续发展。
传统的水田平整方法都是仿形平整,劳动强度大且效率低,同时平整精度低,难以达到精细平整的要求(刘效勇等,2010)。
在水田的常规平整中采用的简易平地设备一般由拖拉机后拖一根木棒或木板作为机具,平地精度主要取决于机具的重量及泥面的软硬程度。由于泥面的软硬和高低的变化,机具也会随其上下起伏。随着现代农业装备发展与应用,要求作业机具保持与作业对象面平行。
目前市场上的大多数农业机械仍为传统的仿形作业方式,只有少量农业装备可实现作业机具具有高度方向的控制而不受农田不平整影响,农田精细平整主要采用激光平地技术和GPS平地技术。激光平地技术能够大幅度地提高田间土地平整精度,成本相对较低,效率较高,节水增产。不过,激光平地技术易受外界因素影响,在强光和大风下工作会使平地精度产生较大误差(李鑫磊,2011),同时,由于激光接收器的垂直接收范围有限,在大面积坡面平整时,会出现激光信号丢失现象,难以满足农田坡面平整要求(王泷等,2013)。此外,激光平地***的工作半径有限,一般为200~450米(Trimble Inc.,2003;2007)。全球定位***(global positioning system,GPS)技术能够获得地表任何位置的定位信息,且工作不受天气影响,具有测量速度快、工作效率高的突出特点,而RTK-GPS技术的动态定位精度更可达到厘米级水平,为高效、大规模实施土地平整提供了重要的支撑条件(Aziz,etal.,2006;李益农等,2005)。基于GPS的土地平整技术作为新兴科技,在美国等发达国家已得到较好地应用。目前,我国水田田块面积增大,成片耕种,田埂窄小;不论平原地区水田还是丘陵地区水田都会有遮挡物,如防护林等,此外,我国大部分区域尚未建立CORS(Continuous Operational Reference System),要获得高精度GPS定位信息需自主架设差分基准站。农田精细平整技术中现有激光平地技术和GPS平地技术,激光平地技术受距离限制,而GPS平地技术的成本高、且信号受遮挡物影响测量精度。
因此,有必要提供一种基于水田特性的水田精细平整方法、技术以及相关装备,以满足市场需求。
发明内容
针对现有技术中存在的技术问题,本发明的目的是:提供一种区别于传统水田平整方法的相对水面的水田农业机具作业姿态测量方法。
为了达到上述目的,本发明采用如下技术方案:
一种相对水面的水田农业机具作业姿态测量方法,其特征在于:包括如下步骤:a.将水田的水面视作静态并作为测量的基准面,通过固定在作业机具上的二维测距传感器向水田的水面扫描得出水面点集,对水面点集进行拟合得到拟合直线;b.计算二维测距传感器到拟合直线的垂直距离L;计算二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角,即横向倾斜角度β;c.利用三角关系通过垂直距离L得出二维测距传感器的垂直高度,进而得出作业机具相对于水面的垂直高度H;d.将垂直高度H和横向倾斜角度β分别与设定值比较,实现作业机具的姿态控制。其中,步骤b中,二维测距传感器的中心线为传感器已知参数,计算中心线和二维测距传感器到拟合直线垂线的夹角,得到作业机具相对水面的横向倾斜角度β。
作为一种优选,所述步骤a中,通过二维测距传感器的旋转测距部件形成二维的扫描面,二维测距传感器向下以一个扫描角度向水面扫描,水面和扫描面相交处形成垂直于作业机具前进方向的扫描线,由扫描线得到拟合直线;水面和扫描面的夹角为角α,其与安装角相关(与安装角互补),步骤c中,通过垂直距离L和角α得出垂直高度H。
作为一种优选,扫描线包括水面点集和非水面点集,通过滤波算法排除非水面点集,选出水面点集。滤波算法为现有的算法,其作用为:减少非水面扫描点的干扰,提高水面扫描直线的准确度。
作为一种优选,扫描角度(即二维测距传感器旋转角度)为60-120度。
作为一种优选,非水面点集对应水面凸出物和田埂信息。水面凸出物包括凸出于水面的土壤、凸出于水面的杂草等。
作为一种优选,步骤d中,通过固定在作业机具上的姿态传感器对作业机具的运动姿态进行校正,精确控制作业机具的姿态;此处所说的作业机具的姿态,包括作业机具的垂直高度H和横向倾斜角度β,其中垂直高度H对应作业机具的作业深度。
作为一种优选,姿态传感器用于测量作业机具的空间姿态角度,至少包括俯仰角度和横滚角度;其中俯仰角度用于校正牵拉作业机具的拖拉机前后倾斜变化对角α的影响,进而用来校正垂直高度H,横滚角度用于校正拖拉机左右倾斜变化对横向倾斜角度β测量的影响。
作为一种优选,姿态传感器安装在二维测距传感器上,二维测距传感器安装在作业机具上。
作为一种优选,作业机具为平地铲,由水田拖拉机牵引;平地铲由高程油缸和调平油缸控制,保持平地铲的垂直高度H和横向倾斜角度β与设定值一致。
总的说来,本发明具有如下优点:
(1)本发明通过固定在水田作业机具上的二维测距传感器扫描测量水田的水面,滤除干扰信息后提取水田的水面点集拟合成拟合直线,计算二维测距传感器与拟合直线的垂直距离L和横向倾斜角度β,再通过三角关系转换得到作业机具相对于水田的水面的垂直高度H。无需外加参考基准而获得水田作业机具的姿态信息,可用于水田作业机具姿态控制。
(2)本发明的测量方法采用姿态传感器对拖拉机/水田平地机的运动姿态产生的影响进行了校正,保证了测量准确性。
(3)本发明结构简单、操作方便,可对作业机具的姿态相对于水面进行精确控制,实现水面以下水田的平整。
附图说明
图1为作业机具的垂直高度H的测量示意图,为作业机具的侧视图。
图2为作业机具作业横向倾斜角β测量的示意图,为作业机具的后视图。
图3为本发明在水田平地机上应用示意图。
其中,1.二维测距传感器、2.姿态传感器、3.二维测距传感器的扫描面,由一个扫描周期内的所有测量线路形成、4.水田平地机、5.平地铲。xL,yL,zL为二维测距传感器的空间直角坐标系,xA,yA,zA为姿态传感器的空间直角坐标系,两空间直角坐标系相互平行;角α为测距传感器扫描面平面与水平面的夹角;横向倾斜角β为二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角。
具体实施方式
下面来对本发明做进一步详细的说明。
本实施例是本发明应用于水田平地机的平地铲作业姿态测量与控制,包括水田平地机、平地铲(即本实施例中的作业机具)、二维测距传感器、姿态传感器和控制***。
平地铲与水田平地机连接,可通过高程油缸实现平地铲的上下调节(高程调节),通过调平油缸实现平地铲的左右调节(自动调平)。二维测距传感器和姿态传感器均安装在平地铲上,二维测距传感器和姿态传感器对应的直角坐标系相互平行。
二维测距传感器倾斜向平地铲后方扫描测量水田的水面,通过滤波算法滤除干扰信息后提取水田的水面点集,并将水面点集拟合成拟合直线,计算二维测距传感器在扫描面上到拟合直线的垂直距离L(通过二维测距传感器读取)和横向倾斜角度β(实时测量线路中二维测距传感器到拟合之间之间的距离和垂直距离L,两者构成直角三角形,可算出夹角,该数值经由控制***配合二维测距传感器横滚角度计算校正),夹角α(与安装角互补,由安装角算出,安装角在二维测距传感器安装时即可确定,夹角α经由控制***配合姿态传感器的俯仰角度计算校正),再利用三角关系转换得到平地铲相对于水田的水面的垂直高度H(H=L·sinα)。
水田平地机受水田的硬底层高低起伏影响使平地铲离水面的高度和倾斜角度时刻变化,再通过测量到的垂直高度H和横向倾斜角度β与设定在控制***中的高度和倾斜角度比较,控制平地铲的高程油缸和调平油缸,保持平地铲的垂直高度H和平地铲横向倾斜角度β接近设定的平地铲高度和倾斜角度,实现平地铲的姿态测量与控制,达到水田精准平整目的。采用姿态传感器对水田平地机的运动姿态产生的影响进行了校正,保证了测量准确性。
上述实施例为本发明较佳的实施方式,但本发明的实施方式并不受上述实施例的限制,其他的任何未背离本发明的精神实质与原理下所作的改变、修饰、替代、组合、简化,均应为等效的置换方式,都包含在本发明的保护范围之内。
Claims (8)
1.一种相对水面的水田农业机具作业姿态测量方法,其特征在于:包括如下步骤:
a.将水田的水面视作静态并作为测量的基准面,通过固定在作业机具上的二维测距传感器向水田的水面扫描得出水面点集,对水面点集进行拟合得到拟合直线;
b.计算二维测距传感器到拟合直线的垂直距离L;计算二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角,即横向倾斜角度β;
c.利用三角关系通过垂直距离L得出二维测距传感器的垂直高度,进而得出作业机具相对于水面的垂直高度H;
d.将垂直高度H和横向倾斜角度β分别与设定值比较,实现作业机具的姿态控制;
所述步骤a中,通过二维测距传感器的旋转测距部件形成二维的扫描面,二维测距传感器向下以一个扫描角度向水面扫描,水面和扫描面相交处形成垂直于作业机具前进方向的扫描线,由扫描线得到拟合直线;水面和扫描面的夹角为角α,步骤c中,通过垂直距离L和角α得出垂直高度H;
所述扫描线包括水面点集和非水面点集,通过滤波算法排除非水面点集,选出水面点集。
2.按照权利要求1所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述扫描角度为60-120度。
3.按照权利要求1所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述非水面点集对应水面凸出物和田埂信息。
4.按照权利要求1所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述步骤d中,通过固定在作业机具上的姿态传感器对作业机具的运动姿态进行校正,精确控制作业机具的姿态。
5.按照权利要求4所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述姿态传感器用于测量作业机具的空间姿态角度,至少包括俯仰角度和横滚角度;其中俯仰角度用于校正牵拉作业机具的拖拉机前后倾斜变化对角α的影响,进而用来校正垂直高度H;其中横滚角度用于校正拖拉机左右倾斜变化对横向倾斜角度β测量的影响。
6.按照权利要求4所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述姿态传感器安装在二维测距传感器上,二维测距传感器安装在作业机具上。
7.按照权利要求1所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述作业机具为平地铲,由水田平地机牵引;平地铲由高程油缸和调平油缸控制,保持平地铲的垂直高度H和横向倾斜角度β均与设定值一致。
8.按照权利要求1所述的一种相对水面的水田农业机具作业姿态测量方法,其特征在于:所述角α和二维测距传感器的安装角互补,由二维测距传感器的安装角求出,该安装角在安装时确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510579291.9A CN105606049B (zh) | 2015-09-11 | 2015-09-11 | 一种相对水面的水田农业机具作业姿态测量方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510579291.9A CN105606049B (zh) | 2015-09-11 | 2015-09-11 | 一种相对水面的水田农业机具作业姿态测量方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105606049A CN105606049A (zh) | 2016-05-25 |
CN105606049B true CN105606049B (zh) | 2018-09-21 |
Family
ID=55986185
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510579291.9A Active CN105606049B (zh) | 2015-09-11 | 2015-09-11 | 一种相对水面的水田农业机具作业姿态测量方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105606049B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110836655B (zh) * | 2019-11-13 | 2020-09-08 | 长沙桑铼特农业机械设备有限公司 | 机具作业姿态检测装置、农业作业机械及贴地作业方法 |
CN111077284A (zh) * | 2019-12-23 | 2020-04-28 | 华南农业大学 | 一种水田犁底层信息连续感知装置和方法 |
CN111708275B (zh) * | 2020-06-24 | 2023-05-23 | 中国人民解放军63653部队 | 一种提高作业深度***控制精度的方法及装置 |
CN112987069B (zh) * | 2021-02-18 | 2021-11-26 | 华南农业大学 | 一种基于车***姿的作业部件末端位姿测量方法 |
CN113412707B (zh) * | 2021-05-25 | 2022-05-24 | 山东交通学院 | 基于北斗的水稻直播机组自适应方法及变行距实现方法 |
CN113959393A (zh) * | 2021-10-13 | 2022-01-21 | 福建省布谷信田农业科技有限公司 | 一种检测农用拖拉机工作部作业情况的传感器*** |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1163726C (zh) * | 2000-01-27 | 2004-08-25 | 中国科学院长春光学精密机械研究所 | 高精度便携式海基激光测深方法及装置 |
CN101223841B (zh) * | 2008-01-31 | 2012-05-30 | 华南农业大学 | 一种水田激光平地机 |
CN101280570B (zh) * | 2008-05-27 | 2010-11-10 | 华南农业大学 | 平地机的水平控制***及其控制方法 |
CN101644023B (zh) * | 2009-08-21 | 2011-01-26 | 赵怀志 | 一种路面平整度检测方法 |
US8422034B2 (en) * | 2010-04-21 | 2013-04-16 | Faro Technologies, Inc. | Method and apparatus for using gestures to control a laser tracker |
CN102818557B (zh) * | 2012-08-07 | 2014-08-27 | 三一重型装备有限公司 | 位姿自动测量装置和工程机械 |
CN104296695B (zh) * | 2014-10-11 | 2017-03-15 | 国家电网公司 | 一种获取摄像机空间姿态的方法 |
-
2015
- 2015-09-11 CN CN201510579291.9A patent/CN105606049B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105606049A (zh) | 2016-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105606049B (zh) | 一种相对水面的水田农业机具作业姿态测量方法 | |
Eltner et al. | Accuracy constraints of terrestrial Lidar data for soil erosion measurement: Application to a Mediterranean field plot | |
Schmidt et al. | Comparison of DEM data capture and topographic wetness indices | |
Betts et al. | Digital elevation models as a tool for monitoring and measuring gully erosion | |
Aucelli et al. | Multi‐temporal digital photogrammetric analysis for quantitative assessment of soil erosion rates in the Landola catchment of the Upper Orcia Valley (Tuscany, Italy) | |
CN204362509U (zh) | Gnss平地机 | |
CN103196403B (zh) | 一种基于gps控制平地***的土方量测量方法 | |
CN103853898B (zh) | 一种农田土地平整任意坡度基准面设计方法 | |
Vasiliev et al. | Method for controlling meliorative technologies on sloping cultivated lands using large scale profilometer | |
CN109325311A (zh) | 多年冻土地区大尺度路基的变形评价方法 | |
CN102607499A (zh) | 一种车载农田三维地形测量装置 | |
Tang et al. | Method and experiment for height measurement of scraper with water surface as benchmark in paddy field | |
Eltner et al. | Integrated processing of high resolution topographic data for soil erosion assessment considering data acquisition schemes and surface properties | |
CN107255446B (zh) | 一种矮化密植果树冠层三维地图构建***和方法 | |
Yermolaev et al. | Evaluation of erosion intensity and dynamics using terrestrial laser scanning | |
CN113031034B (zh) | 一种适用于复杂目标曲面的平地方法及*** | |
CN110470275A (zh) | 一种基于uav航测地形数据测量干枯河床沙波形态参数的方法 | |
CN108332719A (zh) | 坡耕地土壤耕作侵蚀速率快速估算方法 | |
CN102661741B (zh) | 一种小型冲沟沟头形态及侵蚀量的监测方法 | |
CN117073625A (zh) | 一种3d变量摊铺控制***及控制方法 | |
CN102999706B (zh) | 一种用于gps控制平地***的作业路线生成方法及作业路线 | |
CN110174682B (zh) | 一种农田三维地形实时测量装置和方法 | |
Gonçalves et al. | Digital aerial photography to monitor changes in coastal areas based on direct georeferencing | |
CN104677346A (zh) | 一种编码测量杆及其使用方法 | |
CN108180897A (zh) | 坡耕地土壤水力侵蚀速率快速估算方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |