[发明专利]软壳有核水果去核去壳生产线的位姿调整设备的控制方法

说明书

本发明涉及软壳有核水果去核去壳生产线技术领域，公开了一种软壳有核水果去核去壳生产线的位姿调整设备的控制方法。本发明根据水果及其果蒂的实际形状以及调整过程中的惯性影响设计出近似拟合的控制算法，采用视觉识别计数对果蒂所在位置进行识别，通过多次调整不断逼近理想情况。采用半闭环系统控制，通过限定调整次数来实现尽可能精确的位姿调整，避免了闭环系统中可能存在的长期反复循环的缺陷，更加符合工业应用需求。经过实践证明，本发明的控制方法精度高、调整速度快，可广泛应用于龙眼、荔枝等软壳有核水果去核前的位姿调整，值得推广应用。

技术领域

本发明涉及软壳有核水果去核去壳生产线技术领域，尤其涉及到一种软壳有核水果去核去壳生产线的位姿调整设备的控制方法。

技术背景

龙眼、桂圆等软壳有核水果盛产于中国南部与东南亚地区，而其新鲜状态下储存不易，因此相当一部分新鲜的龙眼、桂圆等软壳有核水果被制成干果。龙眼、桂圆等干果在制作时需要对水果进行去核与去壳。针对其中的去核操作，目前已经有较为成熟的自动化设备进行去核，但该加工设备仅仅在软壳有核水果在设备上处于一定位姿要求，例如，龙眼的核为不规则的椭形，龙眼蒂正朝下时去核效果良好。否则，严重影响去核效果。因此，在现有软壳有核水果去核去壳生产方式下，水果去核前的位姿调整是一个不可省略的环节。

目前，在龙眼果干生产中，调整鲜果位姿主要采用人工方式，即人们通过观察，手动将龙眼放置至设备上并调整至合适位姿。但此方式成本高、效率低，并且人工调整的准确率会随着疲劳等因素大幅下降，其稳定性不能满足日益增长的生产需求。

针对此问题许多人提出了各种各样的解决方案，其中一种解决方案为采用视觉识别方式定位龙眼位置，再通过滚轮旋转带动龙眼旋转从而达到调整龙眼位姿的目的。但此方法在控制上存在许多难点，首先便是如何设计一套快速而又准确的算法，如果采用闭环控制，在设备本身精度不高的情况下很有可能会使设备为了将一个龙眼的位姿调整到指定位置而长期运行，其效率难以保证。开环以及半闭环系统的精度则难以保证。同时还存在另外一个问题，精确的定位与复杂的算法对硬件要求极高，作为一个用于实际生产的设备，其成本也是一个不可避免的问题。

发明内容

本发明提供一种用于软壳有核水果去核去壳生产线的位姿调整设备的控制方法，其简洁有效、准确率高、鲁棒性好，可长期高效运行从而满足生产需求。

本发明提供一种用于软壳有核水果去核去壳生产线的位姿调整设备的控制方法，所述位姿调整设备包括在水平面上均匀分布的三个滚轮，每个滚轮分别连接驱动电机及其驱动控制装置，在加工过程中，软壳有核水果被三个滚轮托住，位于三个滚轮正下方的摄像装置，所述摄像装置连接图像处理装置，驱动控制装置、摄像装置、图像处理装置分别连接中心控制器，所述控制方法包括以下步骤：

步骤a、所述中心控制器向所述摄像装置发出拍摄指令；

步骤b、所述摄像装置收到拍摄指令后拍摄水果图像；

步骤c、所述图像处理装置接收水果图像后，将水果图像的尺寸单位有像素转换为长度单位；

步骤d、图像处理装置识别水果图像，判断该水果图像中是否存在果蒂，如果不存在，则向任一个驱动控制装置发出驱动信号，驱动控制装置控制驱动滚轮转动带动水果沿该驱动滚轮的转动方向旋转180°，然后进入下一步骤；如果存在，则直接进入下一步骤；

步骤e、判断果蒂是否位于图像中心，如果是，则跳转至步骤h；如果否，则进入下一步骤；

步骤f、驱动滚轮旋转角度ω1，其中，r1为滚轮的半径，R为水果的半径，L1＝h/sin 60°，h＝r*sin(θ)，θ＝(α+30°)％60°.x、y分别为果蒂在滚轮坐标系中的x轴、y轴上的坐标值；

步骤g、驱动滚轮旋转角度ω2，其中，然后跳转至步骤a；

步骤h、调整结束。