发明内容
针对现有技术的不足,本发明提出了一种青饲料收获机自动跟车抛送填装方法,该方法能显著提高青饲料收获机自动抛送到料车车斗时的均匀性,料车车斗承载的物料重量及料车车斗空间利用率。
本发明的目的通过如下技术方案来实现:一种青饲料收获机自动跟车抛送填装方法,其特征在于,具体包括以下步骤:
S1、利用双目相机识别料车车斗位置,以车斗建立坐标系,并把车斗区域划分为若干个网格,设立坐标点
通过安装在青饲料收获机抛筒臂上的双目相机识别料车车斗位置,得到料车车斗位置图像,以车斗上边沿与左边沿为坐标X、Y轴建立坐标系,并把车斗区域以网格形式进行划分,所有网格交点设为坐标点。
S2、规划车斗内物料填装点位置及整体填装轨迹
沿料车车斗长边方向,在宽度方向二分之一线处,按一定距离均布七个填装点,在宽度方向四分之一线处,按一定距离均布六个填装点,在宽度方向四分之三线处,按一定距离均布六个填装点。四分之一线处与四分之三线处的填装点与二分之一线处的填装点交错排列。整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。
S3、进行物料填装,计算填装点的填装因子,判断是否换点填装
控制抛筒位置,根据整体填装轨迹对料车车斗进行物料填装,同时依据深度相机获得的料车车斗内的深度点云图,计算填装点处的填装因子,当某一填装点的填装因子大于1.3时,判断该填装点已经达到填装要求,进行换点,否则,继续对该点进行填装。
S4、按照既定填装轨迹装满料车车斗
整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。沿二分之一线位置从车头向车尾方向进行填装,沿四分之一线位置从车尾向车头方向进行填装,沿四分之三线位置从车头向车尾方向进行填装,直至各填装点的填装因子均大于1.3。
S5、计算料车车斗总体坐标点的填装因子,确定待补充区域
通过深度相机获得料车车斗总体深度点云图,计算料车车斗所有坐标点的填装因子,判断坐标点的填装状态,依据各点的填装状态,确定对应的网格区域填装状态,包括未满区域、临界区域与已完成区域,其中定义未满区域与临界区域为待补充区域。
S6、确定补充填装点,依据补充填装点位置设置补充填装轨迹,并进行补充填装。
根据待补充区域,确定待补充区域内网格的坐标点为补充填装点。采用路径规划算法找出遍访每个补充填装点恰好一次的一条回路并使其路径长度为最短,确定此回路为补充填装轨迹,控制抛筒沿距离抛筒出料口最近的补充填装点开始补充填装,直至历经所有补充填装点,料车车斗填装状态为已完成,结束填装。
进一步地,上述步骤S1中还包括以下子步骤:
S11、通过安装在青饲料收获机抛筒臂上的双目相机识别料车车斗位置,得到料车车斗位置图像;
S12、以车斗上边沿与左边沿为坐标X、Y轴建立坐标系,上边沿与左边沿交点为坐标系原点O,并把车斗区域以网格形式进行划分,所有网格交点设为坐标点。
S13、考虑到青贮饲料的堆积特性及装置整体的计算速度,划分网格大小为30cm×30cm。
进一步地,上述步骤S2中还包括以下子步骤:
S21、以4.2m×1.8m×1.8m货车车斗为例,沿料车车斗长边方向,在宽度方向二分之一线处设置七个填装点,七个填装点均匀分布。第一填装点设置在距离左边线0.3m处,第二填装点至第七填装点均与前一填装点距离0.6m;
S22、沿料车车斗宽度方向四分之一线处设置六个填装点,六个填装点均匀分布。第一填装点设置在距离右边线0.6m处,第二填装点至第六填装点均与前一填装点距离0.6m;
S23、沿料车车斗宽度方向四分之三线处设置六个填装点,六个填装点均匀分布。第一填装点设置在距离左边线0.6m处,第二填装点至第六填装点均与前一填装点距离0.6m;
S24、料车车斗宽度方向四分之一线与四分之三线处的填装点与料车车斗宽度方向二分之一线处的填装点交错排列;
S25、整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。
进一步地,上述步骤S3中还包括以下子步骤:
S31、控制抛筒位置,根据整体填装轨迹对料车车斗进行物料填装,同时依据深度相机获得的料车车斗内的深度点云图,计算填装点处的填装因子;
S32、当填装点的填装因子大于1.3时,判断该填装点已经达到填装要求,进行换点,否则,继续对该点进行填装;
S33、填装因子计算方法:
其中物料高度由深度点云图换算得出。
进一步地,上述步骤S4中还包括以下子步骤:
S41、整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装;
S42、沿二分之一线位置从车头向车尾方向进行填装,沿四分之一线位置从车尾向车头方向进行填装,沿四分之三线位置从车头向车尾方向进行填装,直至各填装点的填装因子均大于1.3。
进一步地,上述步骤S5中还包括以下子步骤:
S51、完成初步填装后,仍存在一些未满区域,需要进行进一步的补充填装,通过深度相机获得料车车斗总体深度点云图,计算料车车斗所有坐标点的填装因子,判断坐标点对应的网格区域的填装状态;
S52、设定填装因子小于0.9的点为未满点,对应的网格区域的填装状态为未满区域,填装因子大于等于0.9小于1.1的点为临界点,对应的网格区域的填装状态为临界区域,填装因子大于等于1.1的点为已完成点,对应的网格区域的填装状态为已完成区域;
S53、为了更加清晰看出各区域的分布,设置检测出未满区域标记为红色,检测出临界区域标记为黄色,检测出已完成区域标记为绿色。为了便于表达,附图中用三角形替代红色,正方形替代黄色,灰色替代绿色。
进一步地,上述步骤S6中还包括以下子步骤:
S61、根据待补充区域,确定待补充区域内网格的坐标点为补充填装点;
S62、采用路径规划算法找出遍访每个补充填装点恰好一次的一条回路并使其路径长度为最短,确定此回路为补充填装轨迹,控制抛筒沿距离抛筒出料口最近的补充填装点开始补充填装,直至历经所有补充填装点,料车车斗填装状态为已完成,结束装填;
算法的设计:假设抛送筒从一个补充填装点出发,经过所有的补充填装点一次且仅一次,最后回到起始补充填装点的最短路径长度,即求最优解。
1)设置迭代的总代数;
2)根据所有的补充填装点随机生成一个补充填装轨迹,并计算此时的路径长度,预设为最短路径长度;
3)若当前迭代次数小于总次数,随机交换两个补充填装点的顺序,计算总长度,否则,输出当前的最短路径长度与补充填装点轨迹;
4)若当前的总路径距离小于预设的最短路径长度,更新最短路径长度,否则继续进行迭代,进行第3)步;
5)输出当前的最短路径长度与补充填装点轨迹。
本发明的有益效果如下:
本发明所提供的一种青饲料收获机自动跟车抛送填装方法,针对我国青饲料收获机存在无法实现自动抛送,且料车车斗内物料填装不均匀,填装质量小,料车车斗空间利用率低等问题,提供一种青饲料收获机自动跟车抛送填装方法,通过设置填装轨迹与补充填装轨迹,提高了青饲料收获机自动抛送到料车车斗时的均匀性,料车车斗承载的物料重量及料车车斗的空间利用率。
具体实施方式
下面根据附图和优选实施例详细描述本发明,本发明的目的和效果将变得更加明白,应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定发明。
请参阅图1-6本发明提供一种技术方案:一种青饲料收获机自动跟车抛送填装方法,具体包括以下步骤:
S1、利用双目相机识别料车车斗位置,以车斗建立坐标系,并把车斗区域划分为若干个网格,设立坐标点;
S2、规划车斗内物料填装点位置及整体填装轨迹;
S3、进行物料填装,计算填装点的填装因子,判断是否换点填装;
S4、按照既定填装轨迹装满料车车斗;
S5、计算料车车斗总体坐标点的填装因子,确定待补充区域;
S6、确定补充填装点,依据补充填装点位置设置补充填装轨迹,并进行补充填装。
如图2所示,所述的一种青饲料收获机自动跟车抛送填装方法,利用双目相机识别料车车斗位置,控制抛筒进行物料的填装,填装点的填装因子大于1.3时,按照设置的填装轨迹更换填装点,按照填装轨迹依次进行对各填装点的填装,直至所有填装点填装完毕。对所有坐标点的填装因子进行计算,判断填装因子小于等于1.1的坐标点为补充填装点,根据补充填装点的位置,依据路径规划算法,确定补充填装轨迹,控制抛筒按照补充填装轨迹进行补充填装,补充填装点的填装因子大于1.1时,按照设置的补充填装轨迹更换补充填装点,按照补充填装轨迹依次进行对各补充填装点的填装,直至所有补充填装点填装完毕,结束填装过程。
如图3所示,以4.2m×1.8m×1.8m货车车斗为例,沿料车车斗长边方向,在宽度方向二分之一线处设置七个填装点,七个填装点均匀分布,分别为P1、P2、P3、P4、P5、P6、P7;第一填装点P1设置在距离左边线0.3m处,第二填装点P2至第七填装点P7均与前一填装点距离0.6m;沿料车车斗宽度方向四分之一线处设置六个填装点,六个填装点均匀分布,分别为P'1、P'2、P'3、P'4、P'5、P'6;第一填装点P'1设置在距离右边线0.6m处,第二填装点P'2至第六填装点P'6均与前一填装点距离0.6m;沿料车车斗宽度方向四分之三线处设置六个填装点,六个填装点均匀分布,分别为P”1、P”2、P”3、P”4、P”5、P”6;第一填装点P”1设置在距离左边线0.6m处,第二填装点P”2至第六填装点P”6均与前一填装点距离0.6m;依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。其中,每个网格的交点为料车车斗的坐标点。
如图4所示,完成初步填装后,仍存在一些未满区域,需要进行进一步的补充填装,通过深度相机获得料车车斗总体深度点云图,计算料车车斗所有坐标点的填装因子,设定填装因子小于0.9的点为未满点,对应的网格区域的填装状态为未满区域,标记为红色;填装因子大于等于0.9小于1.1的点为临界点,对应的网格区域的填装状态为临界区域,标记为黄色;填装因子大于等于1.1的点为已完成点,对应的网格区域的填装状态为已完成区域,标记为绿色;其中未满区域与临界区域设置为待补充区域。为了便于表达,附图中用三角形替代红色,正方形替代黄色,灰色替代绿色。
如图5所示,根据待补充区域,确定待补充区域内网格的坐标点为补充填装点。采用路径规划算法找出遍访每个补充填装点恰好一次的一条回路并使其路径长度为最短,确定此回路为补充填装轨迹,控制抛筒沿距离抛筒出料口最近的补充填装点开始补充填装,直至历经所有补充填装点,料车车斗填装状态为已完成,结束装填。
如图6所示,按照不同的网格大小进行划分,会得到不同数量的坐标点,坐标点的数量直接影响后续的计算速度及响应速度,需要综合考虑后,确定网格大小,这里不做过多解释。
以下为本发明工作流程的具体步骤:
S1、利用双目相机识别料车车斗位置,以车斗建立坐标系,并把车斗区域划分为若干个网格,设立坐标点
通过安装在青饲料收获机抛筒臂上的双目相机识别料车车斗位置,得到料车车斗位置图像,以车斗上边沿与左边沿为坐标X、Y轴建立坐标系,并把车斗区域以网格形式进行划分,所有网格的交点设为坐标点。
S2、规划车斗内物料填装点位置及整体填装轨迹
沿料车车斗长边方向,在宽度方向二分之一线处,按一定距离均布七个填装点,在宽度方向四分之一线处,按一定距离均布六个填装点,在宽度方向四分之三线处,按一定距离均布六个填装点。四分之一线处与四分之三线处的填装点与二分之一线处的填装点交错排列。整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。
S3、进行物料填装,计算填装点的填装因子,判断是否换点填装
控制抛筒位置,根据整体填装轨迹对料车车斗进行物料填装,同时依据深度相机获得的料车车斗内的深度点云图,计算填装点处的填装因子,当某一填装点的填装因子大于1.3时,判断该填装点已经达到填装要求,进行换点,否则,继续对该点进行填装。
S4、按照既定填装轨迹装满料车车斗
整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。沿二分之一线位置从车头向车尾方向进行填装,沿四分之一线位置从车尾向车头方向进行填装,沿四分之三线位置从车头向车尾方向进行填装,直至各填装点的填装因子均大于1.3。
S5、计算料车车斗总体坐标点的填装因子,确定待补充区域
通过深度相机获得料车车斗总体深度点云图,计算料车车斗所有坐标点的填装因子,判断坐标点的填装状态,依据各点的填装状态,确定对应的网格区域填装状态,包括未满区域、临界区域与已完成区域,其中定义未满区域与临界区域为待补充区域。
S6、确定补充填装点,依据补充填装点位置设置补充填装轨迹,并进行补充填装。
根据待补充区域,确定待补充区域内网格的坐标点为补充填装点。采用路径规划算法找出遍访每个补充填装点恰好一次的一条回路并使其路径长度为最短,确定此回路为补充填装轨迹,控制抛筒沿距离抛筒出料口最近的补充填装点开始补充填装,直至历经所有补充填装点,料车车斗填装状态为已完成,结束填装。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,所述S1中,利用双目相机识别料车车斗位置,以车斗建立坐标系,并把车斗区域划分为若干个网格,设立坐标点,所述S1中还包括以下子步骤:
S11、通过安装在青饲料收获机抛筒臂上的双目相机识别料车车斗位置,得到料车车斗位置图像;
S12、以车斗上边沿与左边沿为坐标X、Y轴建立坐标系,上边沿与左边沿交点为坐标系原点O,并把车斗区域以网格形式进行划分,所有网格交点设为坐标点。
S13、考虑到青贮饲料的堆积特性及整体的计算速度,划分网格大小为30cm×30cm。按照不同的网格大小进行划分,会影响后续的计算速度及响应速度,需要综合考虑后,确定网格大小,这里不做过多解释。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,如图3所示,所述S2中还包括以下子步骤:
S21、以4.2m×1.8m×1.8m货车车斗为例,沿料车车斗长边方向,在宽度方向二分之一线处设置七个填装点,七个填装点均匀分布,分别为P1、P2、P3、P4、P5、P6、P7;第一填装点P1设置在距离左边线0.3m处,第二填装点P2至第七填装点P7均与前一填装点距离0.6m;
S22、沿料车车斗宽度方向四分之一线处设置六个填装点,六个填装点均匀分布,分别为P′1、P′2、P′3、P′4、P′5、P′6;第一填装点P′1设置在距离右边线0.6m处,第二填装点P′2至第六填装点P′6均与前一填装点距离0.6m;
S23、沿料车车斗宽度方向四分之三线处设置六个填装点,六个填装点均匀分布,分别为P″1、P″2、P″3、P″4、P″5、P″6;第一填装点P″1设置在距离左边线0.6m处,第二填装点P″2至第六填装点P″6均与前一填装点距离0.6m;
S24、料车车斗宽度方向四分之一线与四分之三线处的填装点与料车车斗宽度方向二分之一线处的填装点交错排列;
S25、整体填装方法如图3所示,依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,所述S3中还包括以下子步骤:
S31、控制抛筒位置,根据整体填装轨迹对料车车斗进行物料填装,同时依据深度相机获得的料车车斗内的深度点云图,计算填装点处的填装因子;
S32、当填装点的填装因子大于1.3时,判断该填装点已经达到填装要求,进行换点,否则,继续对该点进行填装;
S33、填装因子计算方法:
其中物料高度由深度点云图换算得出。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,所述S4中还包括以下子步骤:
S41、整体填装轨迹为依次沿宽度方向二分之一线处的填装点,四分之一线处的填装点,四分之三线处的填装点进行填装;
S42、沿二分之一线位置从车头向车尾方向进行填装,沿四分之一线位置从车尾向车头方向进行填装,沿四分之三线位置从车头向车尾方向进行填装,直至各填装点的填装因子均大于1.3。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,所述S5中还包括以下子步骤:
S51、完成初步填装后,仍存在一些未满区域,需要进行进一步的补充填装,通过深度相机获得料车车斗总体深度点云图,计算料车车斗所有坐标点的填装因子,判断坐标点对应的网格区域的填装状态;
S52、设定填装因子小于0.9的点为未满点,对应的网格区域的填装状态为未满区域,填装因子大于等于0.9小于1.1的点为临界点,对应的网格区域的填装状态为临界区域,填装因子大于等于1.1的点为已完成点,对应的网格区域的填装状态为已完成区域;
S53、为了更加清晰看出各区域的分布,设置检测出未满区域标记为红色,检测出临界区域标记为黄色,检测出已完成区域标记为绿色。为了便于表达,附图中用三角形替代红色,正方形替代黄色,灰色替代绿色。
进一步地,所述的一种青饲料收获机自动跟车抛送填装方法,其特征在于,所述S6中还包括以下子步骤:
S61、根据待补充区域,确定待补充区域内网格的坐标点为补充填装点。
S62、采用路径规划算法找出遍访每个补充填装点恰好一次的一条回路并使其路径长度为最短,确定此回路为补充填装轨迹,控制抛筒沿距离抛筒出料口最近的补充填装点开始补充填装,直至历经所有补充填装点,料车车斗填装状态为已完成,结束装填。
所述的路径规划算法的设计包括:
假设抛送筒从一个补充填装点出发,经过所有的补充填装点一次且仅一次,最后回到起始补充填装点的最短路径长度,即求最优解;
1)设置迭代的总代数;
2)根据所有的补充填装点随机生成一个补充填装轨迹,并计算此时的路径长度,设置为最短路径长度;
3)若当前迭代次数小于总次数,随机交换两个补充填装点的顺序,计算总长度,否则,输出当前的最短路径长度与补充填装点轨迹;
4)若当前的总路径距离小于预设的最短路径长度,更新最短路径长度,否则继续进行迭代,进行第3)步;
5)输出当前的最短路径长度与补充填装点轨迹。
本领域普通技术人员可以理解,以上所述仅为发明的优选实例而已,并不用于限制发明,尽管参照前述实例对发明进行了详细的说明,对于本领域的技术人员来说,其依然可以对前述各实例记载的技术方案进行修改,或者对其中部分技术特征进行等同替换。凡在发明的精神和原则之内,所做的修改、等同替换等均应包含在发明的保护范围之内。