1.一种柑橘采摘机器人系统,其特征在于:包括采摘机器人和控制系统;采摘机器人包括履带式移动平台和固定设置在履带式移动平台上方的壳体;壳体上方固定设置有机械臂安装平台,机械臂安装平台上安装有机械臂;壳体上还设置有用于识别定位果实的双目镜头和用于识别导航路径的单目镜头;机械臂的采摘端设置有采摘机构,采摘机构包括剪切机构和夹持机构;壳体内设置有果篮放置腔;
控制系统包括用于处理双目镜头和单目镜头拍摄图像的图像处理模块、用于控制履带式移动平台的移动平台控制模块、用于控制机械臂各关节的机械臂驱动控制模块、用于控制机械臂采摘机构的采摘机构驱动控制模块和中央处理器,中央处理器分别与图像处理模块、移动平台控制模块、机械臂驱动控制模块和采摘机构驱动控制模块控制连接。
2.如权利要求1所述柑橘采摘机器人系统的控制方法,其特征在于,包括以下步骤:S1:制作果园的导航地图,根据果园内果树栽种分布在导航地图内预设导航路径,在导航路径上设置连续的若干采摘点;
S2:启动采摘机器人,中央处理器将控制信号传输到移动平台控制模块,移动平台控制模块控制履带式移动平台开始移动;采摘机器人进入导航路径,并进入采摘点;
S3:采摘机器人到达该采摘点后,通过双目镜头实时拍摄采摘点附近的待采摘图像信息,由图像处理模块对待采摘图像进行处理,并根据处理后的待采摘图像分析果实的位置,判断并统计处于采摘范围内的果实;
S4:中央处理器针对处于采摘范围内的果实建立采摘任务表,并根据果实的位置规划执行每一个采摘任务时机械臂的采摘轨迹;
S5:在该采摘点,根据逆运动学算法,通过规划的采摘轨迹反推导出机械臂的运动轨迹;中央处理器将控制信号传输到机械臂驱动控制模块,机械臂驱动控制模块驱动机械臂按照推导的运动轨迹进行运动并完成果实的采摘;
S6:采摘该采摘点范围内的果实;中央处理器根据双目镜头的实时拍摄信息判断该采摘点的采摘任务是否完成,若该采摘点的采摘任务完成,执行步骤S7;若该采摘点的采摘任务未完成,则返回执行步骤S5;
S7:通过单目镜头拍摄该采摘点的路径信息,中央处理器根据路径信息和采摘机器人的定位信息确定采摘机器人在导航地图中的位置;将采摘机器人在导航地图中的位置与预设导航路径分析对比,判断采摘机器人是否走完导航路径;若采摘机器人还未走完导航路径,则执行步骤S8;若采摘机器人走完导航路径,则执行步骤S9;
S8:中央处理器控制采摘机器人进入下一个采摘点,返回执行步骤S3;
S9:控制采摘机器人返回停靠基地。
3.根据权利要求2所述的柑橘采摘机器人系统的控制方法,其特征在于,步骤S1中,导航路径的预设步骤如下:S11:根据果园内果树栽种位置和导航地图确定可规划路径;
S12:根据可规划路径的道路宽度、道路长度、道路坡度和道路转角确定导航路径;
S13:根据采摘机器人机械臂的运动范围确定采摘范围,并依据采摘范围在导航路径上设置若干连续的采摘点。
4.根据权利要求2所述的柑橘采摘机器人系统的控制方法,其特征在于,所述步骤S3中,果实位置判断步骤如下:S31:通过双目镜头实时拍摄采摘点附近的待采摘图像信息,并将待采摘图像信息传输到图像处理模块;
S32:图像处理模块对待采摘图像信息进行处理,图像处理包括对图像滤波、增强、去噪、边缘处理;
S33:中央处理器对处理后的待采摘图像信息进行分析,通过采摘机器人的拍摄位置、图像中果实的大小、图像中果实与树叶的位置关系来确定果实的位置,并判断果实是否处于该采摘点的采摘范围内;建立该采摘点的果实采摘任务表。
5.根据权利要求2所述的柑橘采摘机器人系统的控制方法,其特征在于,所述步骤S5中,果实的采摘步骤如下:S51:中央处理器根据规划的果实采摘轨迹,用逆运动学算法反推导出机械臂的运动轨迹;
S52:中央处理器将控制信号传输到机械臂驱动控制模块,机械臂驱动控制模块驱动机械臂按照推导的运动轨迹进行运动,并判断采摘机构是否到达采摘位置,若采摘机构已到达采摘位置,则执行步骤S53;若采摘机构未到达采摘位置,则继续执行步骤S52完成修正;
S53:中央处理器将控制信号传输到采摘机构驱动控制模块,采摘机构驱动控制模块驱动剪切机构执行剪切动作完成果实剪切,并控制夹持机构将果实放至果篮中。