基于三维点云模型的田间农业机器人自主导航系统及方法技术方案

本发明专利技术公开了一种基于三维点云模型的田间农业机器人自主导航系统，包括地面激光雷达，用于对地面进行扫描；控制器，用于对地面激光雷达扫描获得的田间作物数据进行处理，得出导航线路；马达驱动器，通过接收控制器发出的导航线路对马达进行控制；马达，用于控制机器人车轮转动方向和速度。本发明专利技术能够改进现有技术的不足，规划导航路线速度快，准确性高，不受天气和外界光照条件影响。

【技术实现步骤摘要】
基于三维点云模型的田间农业机器人自主导航系统及方法
本专利技术涉及农业机器人导航
，尤其是一种基于三维点云模型的田间农业机器人自主导航系统及方法。
技术介绍
当前农业机器人的导航方式主要有以下几种：1.信标导航。在工作环境内的若干确定位置设置信标，机器人通过自身安装的测距装置测量其与信标之间的距离和角度，并推算出自身的位置，以此为依据进行导航。这种导航方式需要预先在不同的位置设置信标，并预先规划导航路径，不能做到即来即走；2.GPS导航。该种导航方法根据GPS位置信息进行导航，但是也需要预先规划导航路径，而且不能根据现场环境自行动态调整，同时其抗干扰能力较差，在受到树木、房屋遮挡时，信息容易丢失；3.视觉导航。机器人根据摄像机对周围环境进行实时探测，并根据探测到的现场信息实时规划导航路径，这种导航方式无需预先规划导航路径和人工干预。但是当前视觉导航多用2DCCD相机或者双目立体视觉相机进行环境的探测，并通过对相机拍摄到的图片进行图像处理，从而找出导航线。这种方式最大的缺点就是相机所拍照片受外界光照影响较大，太阳光线的强弱对其导航线的提取以及导航准确性具有较大的影响。综上所述，现有的大部分农业机器人导航方法要么需要预先规划导航路径，不能做到即来即走，要么受外界光照影响较大，导航准确性会随天气变化而变化。
技术实现思路
本专利技术要解决的技术问题是提供一种基于三维点云模型的田间农业机器人自主导航系统及方法，能够解决现有技术的不足，规划导航路线速度快，准确性高，不受天气和外界光照条件影响。为解决上述技术问题，本专利技术所采取的技术方案如下。一种基于三维点云模型的田间农业机器人自主导航系统，包括，地面激光雷达，用于对地面进行扫描；控制器，用于对地面激光雷达扫描获得的田间作物数据进行处理，得出导航线路；马达驱动器，通过接收控制器发出的导航线路对马达进行控制；马达，用于控制机器人车轮转动方向和速度。作为优选，所述地面激光雷达安装在机器人前部并向下倾斜。一种上述的基于三维点云模型的田间农业机器人自主导航系统的方法，包括以下步骤：A、系统初始化，设置地面激光雷达的扫描角度和分辨率，扫描角度影响扫描的宽度，分辨率影响每条线的扫描点数及扫描的速度，扫描速度决定了机器人的最大移动速度，根据具体地形地貌以及作物生长情况进行设置；B、启动地面激光雷达进行扫描，并将扫描到的数据从极坐标系转换到笛卡尔坐标系；C、将扫描数据分别在笛卡尔坐标系的X、Y、Z轴进行投影，地面激光雷达所在位置即为笛卡尔坐标系的原点，X轴代表扫描宽度，Y轴代表机器人前进的方向，Z轴代表扫描高度；D、根据笛卡尔坐标系的扫描数据生成地面及作物冠层形态的三维点云模型；E、采用最小二乘法，根据每一条沿X轴方向的扫描线的数据对点云模型构造出的作物冠层进行逐条线的曲线拟合；F、对扫描线得到拟合多项式函数求1个极大值和2个极小值，极大值代表作物冠层的1个最高点，极小值代表作物冠层的左右2个最低点，根据冠层的轮廓特征，冠层的左右两个最低点就是冠层投影与地面的左右交界点；G、对所有得到的极值点求其算术平均值和标准差，将符合要求的极大值和所有的极小值沿Y轴方向连接，连接线即为导航标定线；H、根据导航线的方向和角度控制马达驱动器；I、马达驱动器控制机器人轮子的速度和转向，最终实现机器人的运动状态控制。作为优选，步骤E中，对作物冠层进行曲线拟合包括以下步骤，E1、设每一条作物冠层扫描曲线为公式(1)，y＝a0+a1x+a2x2+a3x3+a4x4+a5x5(1)上述公式中，a0、a1、…、a5为设定的拟合曲线的系数；E2、利用公式(2)计算该条线上每一个扫描点xi到这条曲线的距离之和，并计算与实际扫描点yi的偏差之和，上述公式中R代表偏差；E3、对公式(2)右边分别求a0、a1、…、a5的偏导数，如公式(3)所示，E4、将公式(3)转化为公式(4)所示矩阵，E5、将公式(4)所示矩阵转化为公式(5)所示矩阵，E6、公式(5)等价为公式(6)，公式(6)转化为公式(7)，由公式(7)可以求出系数矩阵A，即a0、a1、…、a5，由此得到确定的拟合曲线；X*A＝Y(6)A＝X-1*Y(7)公式(6)中的X,A,Y分别对应公式(5)中的三个矩阵，其中A为系数矩阵，系数矩阵中的各元素即为拟合曲线的各个系数，公式(7)中X-1代表矩阵X的逆矩阵。作为优选，步骤F中极值的求解包括以下步骤，F1、根据公式(8)求每条扫描线拟合曲线的一阶导数的驻点y′＝a1+2a2x+3a3x2+4a4x3+5a5x4＝0(8)根据公式(8)得到驻点x1，x2，…xn；F2、根据公式(9)求每条扫描线拟合曲线的二阶导数y″＝2a2+6a3x+12a4x2+20a5x3(9)然后求二阶导数在所有驻点x1，x2，…xn的值，并根据公式(10)判定其为极大值或极小值上式中maximum代表极大值，minimum代表极小值；若极大值多于1个，则取最大值；若极小值多于2个，则将极小值按照驻点xi的大小顺序排序，取最大的xi和最小的xi所对应的极小值；得到1个极大值和2个极小值，极大值代表作物冠层的1个最高点，极小值代表作物冠层的左右2个最低点，根据冠层的轮廓特征，冠层的左右两个最低点就是冠层投影与地面的左右交界点。作为优选，步骤G中，确定导航标定线包括以下步骤，对所有得到的极值点根据公式(11)和公式(12)求其算术平均值和标准差，公式(1)中n代表极值点个数，x代表极值点的值，i代表极值点的序号，xi代表第i个极值点，代表所有极值点的算术平均值；公式(2)中，n代表极值点个数，di代表每一个极值点和平均值的偏差，σ代表标准差；根据公式(13)选择所有满足条件的极值点，然后将所有的极大值和所有的极小值沿Y轴方向连接，连接线即为3条导航标定线，每条线包括1个极大值和2个极小值。采用上述技术方案所带来的有益效果在于：本专利技术利用地面激光雷达代替CCD相机，并且根据地面激光雷达采集的数据，生成现场三维点云模型，在此模型基础上提取导航线，并实现自主导航。本专利技术提出的方法不用预先规划导航路径，不受天气和外界光照条件影响，直接得到距离信息，速度快，准确性高，可以做到即来即走、无需人工干预。附图说明图1是本专利技术一个具体实施方式的结构图。图2是本专利技术一个具体实施方式的导航流程图。具体实施方式参照图1-2，本专利技术一个具体实施方式包括，地面激光雷达1，用于对地面进行扫描；控制器2，用于对地面激光雷达1扫描获得的田间作物数据进行处理，得出导航线路；马达驱动器3，通过接收控制器2发出的导航线路对马达4进行控制；马达4，用于控制机器人车轮转动方向和速度。地面激光雷达1安装在机器人前部并向下倾斜。一种上述的基于三维点云模型的田间农业机器人自主导航系统的方法，包括以下步骤：A、系统初始化，设置地面激光雷达的扫描角度和分辨率，扫描角度影响扫描的宽度，分辨率影响每条线的扫描点数及扫描的速度，扫描速度决定了机器人的最大移动速度，根据具体地形地貌以及作物生长情况进行设置；B、启动地面激光雷达进行扫描，并将扫描到的数据从极坐标系转换到笛卡尔坐标系；C、将扫描数据分别在笛卡尔坐标系的X、Y、Z轴进行投影，地面激光雷达所在位置即为笛卡尔坐标系的原点，X轴代表扫描宽度本文档来自技高网...

【技术保护点】
1.一种基于三维点云模型的田间农业机器人自主导航系统，其特征在于：包括，地面激光雷达(1)，用于对地面进行扫描；控制器(2)，用于对地面激光雷达(1)扫描获得的田间作物数据进行处理，得出导航线路；马达驱动器(3)，通过接收控制器(2)发出的导航线路对马达(4)进行控制；马达(4)，用于控制机器人车轮转动方向和速度。

【技术特征摘要】
1.一种基于三维点云模型的田间农业机器人自主导航系统，其特征在于：包括，地面激光雷达(1)，用于对地面进行扫描；控制器(2)，用于对地面激光雷达(1)扫描获得的田间作物数据进行处理，得出导航线路；马达驱动器(3)，通过接收控制器(2)发出的导航线路对马达(4)进行控制；马达(4)，用于控制机器人车轮转动方向和速度。2.根据权利要求1所述的基于三维点云模型的田间农业机器人自主导航系统，其特征在于：所述地面激光雷达(1)安装在机器人前部并向下倾斜。3.一种权利要求1或2所述的基于三维点云模型的田间农业机器人自主导航系统的方法，其特征在于包括以下步骤：A、系统初始化，设置地面激光雷达的扫描角度和分辨率，扫描角度影响扫描的宽度，分辨率影响每条线的扫描点数及扫描的速度，扫描速度决定了机器人的最大移动速度，根据具体地形地貌以及作物生长情况进行设置；B、启动地面激光雷达进行扫描，并将扫描到的数据从极坐标系转换到笛卡尔坐标系；C、将扫描数据分别在笛卡尔坐标系的X、Y、Z轴进行投影，地面激光雷达所在位置即为笛卡尔坐标系的原点，X轴代表扫描宽度，Y轴代表机器人前进的方向，Z轴代表扫描高度；D、根据笛卡尔坐标系的扫描数据生成地面及作物冠层形态的三维点云模型；E、采用最小二乘法，根据每一条沿X轴方向的扫描线的数据对点云模型构造出的作物冠层进行逐条线的曲线拟合；F、对扫描线得到拟合多项式函数求1个极大值和2个极小值，极大值代表作物冠层的1个最高点，极小值代表作物冠层的左右2个最低点，根据冠层的轮廓特征，冠层的左右两个最低点就是冠层投影与地面的左右交界点；G、对所有得到的极值点求其算术平均值和标准差，将符合要求的极大值和所有的极小值沿Y轴方向连接，连接线即为导航标定线；H、根据导航线的方向和角度控制马达驱动器；I、马达驱动器控制机器人轮子的速度和转向，最终实现机器人的运动状态控制。4.根据权利要求3所述的基于三维点云模型的田间农业机器人自主导航系统的方法，其特征在于：步骤E中，对作物冠层进行曲线拟合包括以下步骤，E1、设每一条作物冠层扫描曲线为公式(1)，y＝a0+a1x+a2x2+a3x3+a4x4+a5x5(1)上述公式中，a0、a1、…、a5为设定的拟合曲线的系数；E2、利用公式(2)计算该条线上每一个扫描点xi到这条曲线的距离之...

【专利技术属性】
技术研发人员：袁洪波，程曼，蔡振江，
申请(专利权)人：河北农业大学，
类型：发明
国别省市：河北,13