一种相对水面的水田农业机具作业姿态测量方法

摘要

一种相对水面的水田农业机具作业姿态测量方法包括：a.将水田的水面视作静态并作为测量的基准面，通过固定在作业机具上的二维测距传感器向水田的水面扫描得出水面点集，对水面点集进行拟合得到拟合直线；b.计算二维测距传感器到拟合直线的垂直距离L；计算二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角，即横向倾斜角度β；c.利用三角关系通过垂直距离L得出二维测距传感器的垂直高度，进而得出作业机具相对于水面的垂直高度H；d.将垂直高度H和横向倾斜角度β分别与设定值比较，实现作业机具的姿态控制。无需外加参考基准而获得水田作业机具的姿态信息，可用于水田作业机具姿态控制，属于智能农业机械领域。

主权项

一种相对水面的水田农业机具作业姿态测量方法，其特征在于：包括如下步骤：a.将水田的水面视作静态并作为测量的基准面，通过固定在作业机具上的二维测距传感器向水田的水面扫描得出水面点集，对水面点集进行拟合得到拟合直线；b.计算二维测距传感器到拟合直线的垂直距离L；计算二维测距传感器到拟合直线的垂线与二维测距传感器的中心线的夹角，即横向倾斜角度β；c.利用三角关系通过垂直距离L得出二维测距传感器的垂直高度，进而得出作业机具相对于水面的垂直高度H；d.将垂直高度H和横向倾斜角度β分别与设定值比较，实现作业机具的姿态控制。