一种基于机器视觉的油茶果采摘机器人制造技术

本发明专利技术公开了一种基于机器视觉的油茶果采摘机器人，包括运输平台、六自由度机械臂、末端执行器、输送管、收集筐和视觉装置；所述收集筐、六自由度机械臂分别安装在运输平台的前部和中部；所述末端执行器安装在六自由度机械臂的第六轴上，并通过输送管与收集筐相连通；所述末端执行器包括左机械臂杆、连接杆、右机械臂杆、外部齿梳、果实轨道、电机、行星轮机构、大轴承、小轴承。本发明专利技术的机器人能自主在油茶果田间行驶并自主完成油茶果采摘，采摘效率高。采摘效率高。采摘效率高。

【技术实现步骤摘要】
一种基于机器视觉的油茶果采摘机器人


[0001]本专利技术属于农业机械领域，具体涉及一种基于机器视觉的油茶果采摘机器人。

技术介绍

[0002]油茶是世界四大木本油料之一，也是中国特有的油料物种，茶油因具有独特的营养价值，被誉为“油中之王”“东方橄榄油”。市场对油茶果采摘机械的需求很大，专利CN111713259A公开了一种变间距梳刷式油茶果采摘机，包括动力装置和梳刷装置；电机接头、传动轴和采摘杆同轴布置，梳刷装置包括可转动地定位在梳刷指驱动轴末端的采摘头横杆、铰接在采摘头横杆上的若干梳刷指、与各梳刷指滑动配合的变间距横杆以及两端分别铰接在变间距横杆和传动箱外壁上的变间距支撑杆；但是当梳刷指与油茶果的接触点为油茶果的表面时，梳刷指改变间距会对油茶果产生指向油茶果中心的力，从而损伤油茶果，而且该采摘机容易被油茶果的树叶和树枝阻挡，降低采摘的效率。专利CN213662529U公开了一种齿梳回转式油茶果采收末端执行器，驱动旋转架通过主轴设置在机架上且随主轴旋转，驱动旋转架上沿周向均布有多组齿梳，保持旋转架与各组齿梳之间还分别设置有连杆，齿梳的齿梳脊梁一端端部穿过驱动旋转架与相对应连杆的一端过盈配合，连杆的另一端与保持旋转架转动连接；但是该末端执行器所占用的体积较大，而且栅板结构会导致采摘过程中整个末端执行器容易被树枝挡住，栅板结构还会横放着树枝，影响油茶果的收集和采摘效率。因此，急需研制一种采摘效率高且不损伤油茶果的采摘机器人。

技术实现思路

[0003]本专利技术的目的在于克服现有技术中存在的缺点，提供一种采摘效率高、不损伤油茶果的基于机器视觉的油茶果采摘机器人。
[0004]本专利技术的目的通过下述技术方案实现：
[0005]一种基于机器视觉的油茶果采摘机器人，包括运输平台1、六自由度机械臂2、末端执行器3、输送管4、收集筐5和视觉装置；所述收集筐5、六自由度机械臂2分别安装在运输平台1的前部和中部；所述视觉装置包括工控机71、双目立体相机72和相机架73，工控机71安装在运输平台上，双目立体相机72通过相机架73安装在六自由度机械臂2上；所述末端执行器3安装在六自由度机械臂2的第六轴上，并通过输送管4与收集筐5相连通。
[0006]所述末端执行器3包括左机械臂杆31、连接杆32、右机械臂杆33、外部齿梳34、果实轨道35、电机36、行星轮机构37、大轴承38、小轴承39；所述行星轮机构37包括太阳轮371、行星轮372和齿轮圈373，所述电机36安装在左机械臂杆31内并与行星轮机构37的太阳轮371相连接，太阳轮371与行星轮372相啮合，齿轮圈373套在太阳轮371和行星轮372的外圈，齿轮圈373与外部齿梳34相连接；外部齿梳34包括连接环和仿手指钩子，外部齿梳的连接环与左机械臂杆31、右机械臂杆33之间均设有大轴承38，以防止外部齿梳34转动时与机械臂杆摩擦；所述外部齿梳34内有果实轨道35，果实轨道35与右机械臂杆33之间装有小轴承39，以减小回转时零件间的摩檫力，果实轨道35为圆柱形斜坡状，即圆柱的径向进行切割，从而使
得其轴向形成一个斜坡，因此掉落在果实轨道上的油茶果可以沿着斜坡滚出果实轨道，斜坡的低端与输送管4相连，进入果实轨道35的油茶果会通过输送管4掉入收集筐5内。
[0007]优选的，所述外部齿梳34的仿手指钩子安装在连接环的圆周上，整个圆周上有三行仿手指钩子，即每一行相差60
°
，且一行中每两个仿手指钩子之间的距离根据成熟油茶果的大小进行设计，保证成熟的油茶果可以被顺利采摘下来；所述仿手指钩子的外形为类似人的手指，其安装的一端为垂直于圆周的圆柱，另一端是带有弧度的圆柱，其作用是能够钩住油茶果，保证采摘有效性；所述连接环由两个圆环和三条弧形板组成，两个圆环用于连接两端的轴承，三条弧形板夹在两个圆环之间，弧形板彼此间相差60
°
，而弧形板之间的距离可以让油茶果顺利掉落到果实轨道上。
[0008]所述末端执行器的工作原理是：末端执行器的外部齿梳在旋转过程中，外部齿梳上的仿手指钩子会从下至上的钩住油茶果与树枝相接的地方，因为外部齿梳会连续旋转，由于钩子的作用力，油茶果会与树枝分离；同时仿手指钩子会托住油茶果并将其由下往上运送，当仿手指钩子运动到外部齿梳运动轨迹的顶端时，由于重力的作用，油茶果会顺着仿手指钩子掉落到果实轨道上，由于果实轨道的结构特点，在重力的作用下，油茶果会沿着果实轨道滚入输送管中。而且，由于末端执行器对油茶果的作用点在油茶果与树枝的连接处，末端执行器的外部齿梳由下至上的方向进行转动，因此不会对油茶果造成损伤；同时，本专利技术以束为单位进行油茶果采摘，在完成油茶果识别与运动轨迹规划后，末端执行器移动到一束油茶果的位置，然后对这束油茶果进行采摘，因此采摘效率很高。
[0009]所述末端执行器的工作步骤是：工控机完成运动轨迹的规划后，六自由度机械臂将末端执行器带到油茶果前，电机启动，与电机36相连的太阳轮371转动以带动行星轮372转动，从而带动齿轮圈373转动，与齿轮圈373相固定连接的外部齿梳34便可进行回转运动，进而带动仿手指钩子转动；仿手指钩子在转动过程中就会把油茶果从树上采摘下来，并在仿手指钩子运动到圆周轨迹的最高点时，油茶果掉落到果实轨道。
[0010]本专利技术专利与现有技术相比具有如下优点和效果：
[0011](1)本专利技术的机器人能自主在油茶果田间行驶并自主完成油茶果采摘，采摘效率高。
[0012](2)本专利技术的末端执行器为新型的梳式结构，通过与机械臂的配合能精确采摘油茶果，采用回转梳刮的方式将油茶果从树枝上采摘下来，再通过末端执行器内的果实轨道使采摘后的油茶果能直接进入收集筐完成收集。
[0013](3)本专利技术采用机器视觉，使机器人实现完全自主的采摘，摘效率和精确性大幅提升。
[0014](4)本专利技术末端执行器的采摘方式以一束油茶果为单位进行采摘，有较高的采摘效率；而且本专利技术末端执行器的仿手指钩子在采摘过程中作用于油茶果与树枝的连接处，对油茶果的损伤较少。
附图说明
[0015]图1为油茶果采摘机器人的整体结构示意图。
[0016]图2为末端执行器的结构示意图。
[0017]图3为末端执行器的部分结构示意图。
[0018]图4为末端执行器的部分结构的左视图。
[0019]图5为末端执行器的部分结构的右视图。
[0020]图6为果实轨道的结构示意图。
[0021]图7为油茶果采摘机器人的工作流程图。
[0022]图8为六自由度机械臂的控制流程图。
[0023]图9为油茶果采摘机器人的视觉流程图。
[0024]图中：1、运输平台；2、六自由度机械臂；3、末端执行器；31、左机械臂杆；32、连接杆；33、右机械臂杆；34、外部齿梳；35、果实轨道；36、电机；37、行星轮机构；371、太阳轮；372、行星轮；373、齿轮圈；38、大轴承；39、小轴承；4、输送管；5、收集筐；6、履带装置；71、工控机本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于机器视觉的油茶果采摘机器人，其特征在于：包括运输平台、六自由度机械臂、末端执行器、输送管、收集筐和视觉装置；所述收集筐、六自由度机械臂分别安装在运输平台的前部和中部；所述末端执行器安装在六自由度机械臂的第六轴上，并通过输送管与收集筐相连通。2.根据权利要求1所述的油茶果采摘机器人，其特征在于：所述末端执行器包括左机械臂杆、连接杆、右机械臂杆、外部齿梳、果实轨道、电机、行星轮机构、大轴承、小轴承；所述行星轮机构包括太阳轮、行星轮和齿轮圈，所述电机安装在左机械臂杆内并与行星轮机构的太阳轮相连接，太阳轮与行星轮相啮合，齿轮圈套在太阳轮和行星轮的外圈，齿轮圈与外部齿梳相连接；外部齿梳包括连接环和仿手指钩子，外部齿梳的连接环与左机械臂杆、右机械臂杆之间均设有大轴承；所述外部齿梳内有果实轨道，果实轨道与右机械臂杆之间装有小轴承39。3.根据权利要求2所述的油茶果采摘机器人，其特征在于：所述外部齿梳的仿手指钩子安装在连接环的圆周上，整个圆周上有三行仿手指钩子，每两个仿手指钩子之间的距离根据成熟油茶果的大小进行设计；所述仿手指钩子的外形为类似人的手指，其安装的一端为垂直于圆周的圆柱，另一端是带有弧度的圆柱；所述外部齿梳的连接环由两个圆环和三条弧形板组成，两个圆环用于连接两端的轴承，三条弧形板夹在两个圆环之间，弧形板彼此间相差60
°
。4.根据权利要求2所述的油茶果采摘机器人，其特征在于：果实轨道为圆柱形斜坡状，即圆柱的径向进行切割，从而使得其轴向形成一个斜坡，斜坡的低端与输送管相连。5.根据权利要求1所述的油茶果采摘机器人，其特征在于：所述视觉装置包括工控机、双目立体相机和相机架，工控机安装在运输平台上，双目立体相机通过相机架安装在六自由度机械臂上。6.根据权利要求1所述的油茶果采摘机器人，其特征在于：所述六自由度机械臂包括一轴底座、二轴机械臂、三轴机械臂、四轴机械臂、五轴机械臂关节、六轴末端执行器，且依次相连接；一轴底座固定在运输平台上方的中部位置，在一轴底座下方的运输平台中装有机械臂控制电路板，在机械臂连接的关节处有舵机、减速器和电位计；进行油茶果采摘的末端执行器安装在第六轴上。7.根据权利要求1所述的油茶果采摘机器人，其特征在于：所述运输平台的四周装有距离传感器、红外线传感器，内部装有速度传感器、加速度传感器、位置传感器和GPS定位器；距离传感器和红外线传感器用于收集机器人周围的环境信息并反馈传输给机器人的控制系统；速度传感器、加速度传感器和位置传感器用于收集机器人当前的移动速度和位置信息并反馈传输给机器人的控制系统；GPS定位器用于收发机器人的位置和方向信息；控制系统根据接收到的传感器数据控制机器人移动。8.一种权利要求1～7中任一项所述的油茶果采摘机器人的应用，其特征在于包括下述步骤：(1)前期准备：根据农场的实际种植情况对农场进行建模，并根据建模后的地图进行路径规划，将规划好的路径信息导入机器人的控制系统内，使机器人能自主的按照规定好的路径行进和停留作业；(2)在田地中工作时，油茶果采摘机器人从指定位置开始，工控机中的控制系统根据规
划好的路径信息发出控制信号给运输平台，从而控制机器人的整体移动，在移动过程中红外线传感器和距离传感器负责感应前进方向上的障碍物信息，速度、加速度和位置传感器负责实时检测机器人当时的速度、加速度和位置信息，GPS定位器将实时收发机器人当前的定位和姿态，所有传感器信息在机器人工作过程中都实时反馈到机器人的控制系统中，机器人控制系统将实时监控机器人的状态，若传感器遇到障碍物时，机器人能自主偏离预定轨迹，并根据红外线传感器和接近传感器所获得的环境信息进行自主的避障，若检测到没有足够空间进行避障时，机器人会对远程监控的工作人员进行提醒，前方障碍物移除后便可继续按照规定路线进行；(3)当机器人到达设定好的油茶果树附近时，机器人将转动面向油茶果树，双目立...

【专利技术属性】
技术研发人员：赵新芳，付西西，宋振华，黎敏，杨昊，何卓超，
申请(专利权)人：中以新创广州机器人有限公司，
类型：发明
国别省市：