CN110249785B - 一种多机械手串番茄采摘机器人及其采摘方法 - Google Patents

一种多机械手串番茄采摘机器人及其采摘方法 Download PDF

Info

Publication number
CN110249785B
CN110249785B CN201910665111.7A CN201910665111A CN110249785B CN 110249785 B CN110249785 B CN 110249785B CN 201910665111 A CN201910665111 A CN 201910665111A CN 110249785 B CN110249785 B CN 110249785B
Authority
CN
China
Prior art keywords
tomato
linear module
mechanical arm
picking
fruit
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201910665111.7A
Other languages
English (en)
Other versions
CN110249785A (zh
Inventor
袁挺
张帅辉
张帆
吕琳
张俊雄
李伟
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
SUZHOU BOTIAN AUTOMATION TECHNOLOGY CO LTD
Original Assignee
China Agricultural University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by China Agricultural University filed Critical China Agricultural University
Priority to CN201910665111.7A priority Critical patent/CN110249785B/zh
Publication of CN110249785A publication Critical patent/CN110249785A/zh
Application granted granted Critical
Publication of CN110249785B publication Critical patent/CN110249785B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • AHUMAN NECESSITIES
    • A01AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
    • A01DHARVESTING; MOWING
    • A01D45/00Harvesting of standing crops
    • A01D45/006Harvesting of standing crops of tomatoes
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J11/00Manipulators not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/02Sensing devices
    • B25J19/04Viewing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Environmental Sciences (AREA)
  • Harvesting Machines For Specific Crops (AREA)
  • Manipulator (AREA)

Abstract

本发明涉及一种多机械手串番茄采摘机器人及其采摘方法。该串番茄采摘机器人包括移动平台车、机械臂、末端执行器、视觉识别装置和控制模块;多个沿移动平台车的行进方向等间距布置的机械臂竖直地固接在升降机构的顶部平面上;所述末端执行器包括电动夹爪、摇杆、第一连杆、主夹持体、第二连杆、刀片和辅助夹持体;两个摇杆、第一连杆、第二连杆和电动夹爪内部的两个相互啮合的齿轮共同构成五连杆机构,实现对串番茄的包络。本发明结构简单、操作方便、成本低廉,采摘效率和成功率高,实现了对串番茄的整串采收,不损伤串番茄,降低了串番茄和主茎的损坏率。

Description

一种多机械手串番茄采摘机器人及其采摘方法
技术领域
本发明属于智能农业机械技术领域,更具体地,涉及一种多机械手串番茄采摘机器人及其采摘方法。
背景技术
中国是鲜食番茄的生产和消费大国,种植面积达732600hm2,人均年消费量约21kg,其中串番茄因其营养丰富、食用方便、品种多样,在鲜食番茄消费总量中占重要地位。我国种植的串番茄在收获时基本上还是依靠手工来完成,其采摘作业量大,机械化水平低。目前国内外已经研究出了一些番茄采摘机器人,多是针对普通番茄进行采摘,对串番茄的采摘较少,主要原因是:1、串番茄成穗状生长,一串上有多个果实,采摘过程中容易造成果实脱落;2、串番茄生长姿态多样,现有的末端执行器适应性不强,采摘成功率低。
现有的采摘机器人行走机构多是轮式和履带式,而真实的地面环境非常复杂,容易造成车体摇晃,影响采摘成功率。
现有的视觉识别装置安装在平台车上,多是采用双目立体相机进行视觉识别,使得机械臂的移动空间变小,降低采摘效率。
现有的机械臂多是关节式的,成本高。
现有的采摘机器人多是单臂采摘,采摘效率低。
因此,研究一种多机械手串番茄采摘机器人,有助于提高串番茄的采摘效率和采摘成功率,对于保障未来鲜食番茄的安全供应和高效生产具有重要意义。
发明内容
针对上述问题,本发明的一个目的是提供一种多机械手串番茄采摘机器人,能够实现对被采摘串番茄的位置和果实个数进行精确判断,进而实现对串番茄进行精确采摘。若采摘过程中发生未采摘成功或漏采果实的情况,机械臂会进行二次采摘,提高采摘成功率。采摘时不损伤周围水果,能够很好地适应不同串番茄姿态进行采摘。
温室中串番茄生长环境复杂、空间狭小、果实数量多;相邻串番茄种植行之间的过道会铺设导轨,根据温室串番茄种植的这一特点,本发明的另一个目的是提供一种基于所述多机械手串番茄采摘机器人的采摘方法。
为了实现上述目的,本发明提供了如下技术方案:
一种多机械手串番茄采摘机器人包括移动平台车1、机械臂2、末端执行器3、视觉识别装置4和控制模块。
所述移动平台车1包括底部行走机构1-1、升降机构1-2和导航装置1-4;所述升降机构1-2固接在底部行走机构1-1的顶部平面上,所述导航装置1-4固接在底部行走机构1-1的前端。
多个沿移动平台车1的行进方向等间距布置的机械臂2竖直地固接在升降机构1-2的顶部平面上。
所述机械臂2包括滑块连接件2-3、同步带直线模组2-4、水平旋转台2-8和滚珠丝杠直线模组2-10。
其中,所述水平旋转台2-8固接在底部行走机构1-1的顶部平面上,所述水平旋转台2-8上具有一水平的圆盘2-7,所述滚珠丝杠直线模组2-10通过机械臂连接件2-9垂直地固接在水平旋转台2-8的圆盘2-7上。
所述同步带直线模组2-4通过滑块连接件2-3与滚珠丝杠直线模组2-10垂直接连;所述滑块连接件2-3能够在滚珠丝杠直线模组2-10上沿竖直方向滑动;同步带直线模组2-4能够在滑块连接件2-3上沿水平方向滑动。
所述末端执行器3包括电动夹爪3-2、摇杆3-4、第一连杆3-5、主夹持体3-7、第二连杆3-9、刀片3-10和辅助夹持体3-11。
所述电动夹爪3-2通过末端执行器连接件3-1安装在机械臂2的同步带直线模组2-4的朝向串番茄植株的一端;所述电动夹爪3-2包括两个分别与电动夹爪3-2本体内部的两个相互啮合的齿轮连接的夹爪,两个夹爪分别通过夹爪连接件3-8与摇杆3-4的后端固接,两个摇杆3-4的前端分别与第一连杆3-5的后端和第二连杆3-9的后端通过销轴连接,所述第一连杆3-5的前端与第二连杆3-9的前端通过销轴连接;两个摇杆3-4、第一连杆3-5、第二连杆3-9和电动夹爪3-2内部的两个相互啮合的齿轮共同构成五连杆机构,实现对串番茄的包络。
所述主夹持体3-7固接在第一连杆3-5的前部,所述刀片3-10和辅助夹持体3-11与主夹持体3-7相对应地分别固接在第二连杆3-9的前部的上侧和下侧。
所述第一连杆3-5和第二连杆3-9的上端面分别设有第一压力传感器3-6和第二压力传感器3-12。
所述主夹持体3-7与番茄果梗的接触面设有第三压力传感器3-13。
所述视觉识别装置4包括深度相机4-1和相机连接件4-2,所述深度相机4-1通过相机连接件4-2安装在机械臂2的同步带直线模组2-4的朝向串番茄的一端。
所述控制模块与移动平台车1、机械臂2的水平旋转台2-8、滚珠丝杠直线模组2-10和同步带直线模组2-4、末端执行器3的电动夹爪3-2、第一压力传感器3-6、第二压力传感器3-12和第三压力传感器3-13以及视觉识别装置4连接。
所述水平旋转台2-8内置有零点开关;所述滚珠丝杠直线模组2-10设有用于设定初始位置的垂直轴零点开关2-2;所述同步带直线模组2-4设有用于设定初始位置的水平轴零点开关2-1。
所述滑块连接件2-3通过设置在滚珠丝杠直线模组2-10上部和下部的两个垂直轴限位开关2-6限制竖直方向的位移;同步带直线模组2通过设置在同步带直线模组2-4前部和后部的两个水平轴限位开关2-5限制水平方向的位移。
所述主夹持体3-7上设有与刀片3-10相对应的切断槽。
所述主夹持体3-7和辅助夹持体3-11的与番茄果梗的接触部分设有软垫层。
所述电动夹爪3-2上设置有限位块3-3,用于限制电动夹爪3-2的两个夹爪的张开角度。
所述升降机构1-2的顶部平面上沿移动平台车1的行进方向安装四个机械臂2,且机械臂2连接的末端执行器3左右交替地分别朝向左右两侧的串番茄植株。
所述底部行走机构1-1为导轨式行走机构,进一步包括果框支撑架1-3,所述果框支撑架1-3设置在升降机构1-2的左右两侧,用于悬挂果实收集装置5;所述果实收集装置5位于机械臂2的正下方。
一种利用所述的多机械手串番茄采摘机器人的串番茄采摘方法,该方法包括如下步骤:
采摘作业开始前,控制模块控制多个机械臂2定位于初始位姿;移动平台车1通过导航装置1-4沿非导轨路面铺设的导航线自主行走,到达相邻串番茄种植排之间的导轨上;
采摘作业开始,移动平台车1沿着导轨向前行走,并通过视觉识别装置4判断视野内是否有可采摘的串番茄,当发现有串番茄可以采摘时,移动平台车1停止前进;控制模块通过视觉识别装置4得到串番茄的位姿,并驱动机械臂2将末端执行器3运动到串番茄的底部,同时末端执行器3的电动夹爪3-2带动五连杆机构张开至最大状态,确保五连杆机构可以顺利包络串番茄果实,机械臂2的滚珠丝杠直线模组2-10上的滑块连接件2-3向上运动带动末端执行器3向上包络串番茄,当第一连杆3-5的第一压力传感器3-6和/或第二连杆3-9上的第二压力传感器3-12碰到果梗时,机械臂2的滚珠丝杠直线模组2-10上的滑块连接件2-3停止运动,机械臂2的同步带直线模组2-4向后移动一定距离,使果梗进入第一连杆3-5和第二连杆3-9前部的夹持和剪切区域;此时电动夹爪3-2带动五连杆机构闭合,刀片3-10和辅助夹持体3-11与主夹持体3-7相互靠近,刀片3-10和切断槽配合切断果梗,根据主夹持体3-7设置的第三压力传感器3-13反馈的信号确定果梗是否被夹持:若未接收到反馈的信号,说明果实未被夹持,此时,五连杆机构张开,机械臂2按原路返回;若接收到反馈的信号,说明果实已被夹持;此时,机械臂2带动末端执行器3将果实放入果实收集装置中,一次采摘结束,机械臂2回到初始位姿。
一个机械臂2将采摘动作做完后,若发生未成功采到或者漏采的果实,同侧的另一个机械臂2会继续对该目标果实进行采摘,确保目标果实被成功采摘,通过移动平台车1底部的行走机构1-1移动一定距离继续采摘,直到将全部水果采摘完成。
与现有技术相比,本发明的有益效果在于:
本发明结构简单、操作方便、成本低廉。
本发明利用导轨式移动平台车,保证采摘过程车体的稳定性,不会出现大幅度的抖动,提高采摘的成功率。
本发明设计了圆柱型坐标式机械臂,降低机械臂的成本。
本发明根据串番茄的生长环境,提出多个机械臂联合进行采收,可以同时实现对两侧串番茄的采摘,提高采摘效率及成功率。
本发明将视觉识别装置安装在机械臂末端,采用深度相机获得串番茄的三维坐标信息和姿态信息,提高识别的准确性并增大机械臂的作业空间。
本发明通过末端执行器,实现对串番茄的整串采收,不损伤串番茄,降低了串番茄和主茎的损坏率。
附图说明
图1为本发明的多机械手串番茄采摘机器人的结构示意图;
图2为本发明的移动平台车1的结构示意图;
图3为本发明的机械臂2的结构示意图;
图4为本发明的末端执行器3的结构示意图;
图5为本发明的视觉识别装置4的结构示意图;
图6为本发明的采摘方法流程图。
其中的附图标记为:
1移动平台车 1-1行走机构
1-2升降机构 1-3果框支撑架
1-4导航装置 2机械臂
2-1水平轴零点开关 2-2垂直轴零点开关
2-3滑块连接件 2-4同步带直线模组
2-5水平轴限位开关 2-6垂直轴限位开关
2-7圆盘 2-8水平旋转平台
2-9机械臂连接件 2-10滚珠丝杠直线模组
3末端执行器 3-1末端执行器连接件
3-2电动夹爪 3-3限位块
3-4摇杆 3-5第一连杆
3-6第一压力传感器 3-7主夹持体
3-8夹爪连接件 3-9第二连杆
3-10刀片 3-11辅助夹持体
3-12第二压力传感器 3-13第三压力传感器
4视觉识别装置 4-1深度相机
4-2相机连接件 5果实收集装置
具体实施方式
下面结合附图和实施例对本发明进行进一步说明。
如图1所示,一种多机械手串番茄采摘机器人,包括移动平台车1、机械臂2、末端执行器3、视觉识别装置4、果实收集装置5和控制模块,其中:
如图2所示,所述移动平台车1包括底部行走机构1-1、升降机构1-2、果框支撑架1-3和导航装置1-4。所述升降机构1-2固接在底部行走机构1-1的顶部平面上,所述导航装置1-4固接在底部行走机构1-1的前端。所述底部行走机构1-1为导轨式行走机构,通过行走机构的车轮与相邻串番茄种植排之间的过道上铺设的导轨的紧密接触,使采摘机器人可以平稳地运行在导轨上。所述升降机构1-2的作用是通过升降调整机械臂2的高度,实现不同高度的采摘。所述果框支撑架1-3设置在升降机构1-2的左右两侧,用于悬挂果实收集装置5;所述导航装置1-4的作用是当串番茄采摘机器人在非导轨路面时,可以通过铺设在路面的导航线自主行走,将移动平台车1移动到导轨上。
多个沿移动平台车1的行进方向等间距布置的机械臂2竖直地固接在升降机构1-2的顶部平面上。如图3所示,所述机械臂2包括滑块连接件2-3、同步带直线模组2-4、水平旋转台2-8和滚珠丝杠直线模组2-10。
其中,内置有零点开关的水平旋转台2-8固接在底部行走机构1-1的顶部平面上,所述水平旋转台2-8上具有一水平的圆盘2-7,所述滚珠丝杠直线模组2-10通过机械臂连接件2-9垂直地固接在水平旋转台2-8的圆盘2-7上。
所述同步带直线模组2-4通过滑块连接件2-3与滚珠丝杠直线模组2-10垂直接连,其中,所述滑块连接件2-3能够在滚珠丝杠直线模组2-10上沿竖直方向滑动,并通过设置在滚珠丝杠直线模组2-10上部和下部的两个垂直轴限位开关2-6限制竖直方向的位移;同步带直线模组2-4能够在滑块连接件2-3上沿水平方向滑动,并通过设置在同步带直线模组2-4前部和后部的两个水平轴限位开关2-5限制水平方向的位移。
所述滚珠丝杠直线模组2-10设有用于设定初始位置的垂直轴零点开关2-2;所述同步带直线模组2-4设有用于设定初始位置的水平轴零点开关2-1。
如图4所示,所述末端执行器3包括电动夹爪3-2、限位块3-3、摇杆3-4、第一连杆3-5、主夹持体3-7、第二连杆3-9、刀片3-10和辅助夹持体3-11。
所述电动夹爪3-2通过末端执行器连接件3-1安装在机械臂2的同步带直线模组2-4的朝向串番茄植株的一端;所述电动夹爪3-2包括两个分别与电动夹爪3-2本体内部的两个相互啮合的齿轮连接的夹爪,两个夹爪分别通过夹爪连接件3-8与摇杆3-4的后端固接,两个摇杆3-4的前端分别与第一连杆3-5的后端和第二连杆3-9的后端通过销轴连接,所述第一连杆3-5的前端与第二连杆3-9的前端通过销轴连接;两个摇杆3-4、第一连杆3-5、第二连杆3-9和电动夹爪3-2内部的两个相互啮合的齿轮共同构成五连杆机构,实现对串番茄的包络。
所述主夹持体3-7通过螺栓固接在第一连杆3-5的前部,所述刀片3-10和辅助夹持体3-11与主夹持体3-7相对应地分别通过螺栓固接在第二连杆3-9的前部的上侧和下侧,当电动夹爪3-2的两个夹爪相互靠近时,刀片3-10和辅助夹持体3-11与主夹持体3-7相互靠近。
所述第一连杆3-5和第二连杆3-9的上端面分别设有第一压力传感器3-6和第二压力传感器3-12,用于在末端执行器3上升过程中感应番茄果梗的位置,以便使机械臂2停止运行,准备采摘。
所述主夹持体3-7与番茄果梗的接触面设有第三压力传感器3-13,用来判断番茄果梗是否被夹持住。
优选地,所述主夹持体3-7上设有与刀片3-10相对应的切断槽,便于刀片3-10切断果梗。
优选地,所述主夹持体3-7和辅助夹持体3-11的与番茄果梗的接触部分设有软垫层,增加夹持果梗的摩檫力。
所述限位块3-3设置在电动夹爪3-2上,用于限制电动夹爪3-2的两个夹爪的张开角度,进而使刀片3-10和辅助夹持体3-11与主夹持体3-7每次以固定角度张开。未装限位块3-3时,电动夹爪3-2的两个夹爪可以张开180度,加上限位块3-3后,两个夹爪可以张开的角度为60度。
如图5所示,所述视觉识别装置4包括深度相机4-1和相机连接件4-2,所述深度相机4-1通过相机连接件4-2安装在机械臂2的同步带直线模组2-4的朝向串番茄的一端,用于识别和定位串番茄。
所述果实收集装置5设置在移动平台车1的支撑架1-3上、机械臂2的正下方,用于收集果实。
所述控制模块与移动平台车1、机械臂2的水平旋转台2-8、滚珠丝杠直线模组2-10和同步带直线模组2-4、末端执行器3的电动夹爪3-2、第一压力传感器3-6、第二压力传感器3-12和第三压力传感器3-13,以及视觉识别装置4连接。
优选地,所述升降机构1-2的顶部平面上沿移动平台车1的行进方向安装四个机械臂2,且机械臂2连接的末端执行器3左右交替地分别朝向左右两侧的串番茄植株,通过四个机械臂2的协同工作,实现对两侧串番茄的高效采摘。
一种基于所述多机械手串番茄采摘机器人的串番茄采摘方法,包括如下步骤:
采摘作业开始前,控制模块控制多个机械臂2通过水平轴限位开关2-5、垂直轴限位开关2-6和水平旋转台2-8的内置零点开关定位于初始位姿;移动平台车1通过导航装置1-4沿非导轨路面铺设的导航线自主行走,到达相邻串番茄种植排之间的导轨上;
采摘作业开始,移动平台车1沿着导轨向前行走,并通过视觉识别装置4判断视野内是否有可采摘的串番茄,当发现有串番茄可以采摘时,移动平台车1停止前进;控制模块通过视觉识别装置4得到串番茄的位姿,并驱动机械臂2将末端执行器3运动到串番茄的底部,同时末端执行器3的电动夹爪3-2带动五连杆机构张开至最大状态,确保五连杆机构可以顺利包络串番茄果实,机械臂2的滚珠丝杠直线模组2-10上的滑块连接件2-3向上运动带动末端执行器3向上包络串番茄,当第一连杆3-5的第一压力传感器3-6和/或第二连杆3-9上的第二压力传感器3-12碰到果梗时,机械臂2的滚珠丝杠直线模组2-10上的滑块连接件2-3停止运动,机械臂2的同步带直线模组2-4向后移动一定距离,使果梗进入第一连杆3-5和第二连杆3-9前部的夹持和剪切区域;此时电动夹爪3-2带动五连杆机构闭合,刀片3-10和辅助夹持体3-11与主夹持体3-7相互靠近,刀片3-10和切断槽配合切断果梗,根据主夹持体3-7设置的第三压力传感器3-13反馈的信号确定果梗是否被夹持:若未接收到反馈的信号,说明果实未被夹持,此时,五连杆机构张开,机械臂2按原路返回,这样可以保证不会伤到串番茄的主茎和果实;若接收到反馈的信号,说明果实已被夹持。此时,机械臂2带动末端执行器3将果实放入果实收集装置5中,一次采摘结束,机械臂2回到初始位姿。
实际的采摘作业时,左右两侧机械臂2同时工作,对两侧的串番茄果实同时进行采摘。
一个机械臂2将采摘动作做完后,若发生未成功采到或者漏采的果实,同侧的另一个机械臂2会继续对该目标果实进行采摘,确保目标果实被成功采摘,通过移动平台车1底部的行走机构1-1移动一定距离继续采摘,直到将全部水果采摘完成。

Claims (10)

1.一种多机械手串番茄采摘机器人,其特征在于:该串番茄采摘机器人包括移动平台车(1)、机械臂(2)、末端执行器(3)、视觉识别装置(4)和控制模块;
所述移动平台车(1)包括底部行走机构(1-1)、升降机构(1-2)和导航装置(1-4);所述升降机构(1-2)固接在底部行走机构(1-1)的顶部平面上,所述导航装置(1-4)固接在底部行走机构(1-1)的前端;
多个沿移动平台车(1)的行进方向等间距布置的机械臂(2)竖直地固接在升降机构(1-2)的顶部平面上;
所述机械臂(2)包括滑块连接件(2-3)、同步带直线模组(2-4)、水平旋转台(2-8)和滚珠丝杠直线模组(2-10);
其中,所述水平旋转台(2-8)固接在底部行走机构(1-1)的顶部平面上,所述水平旋转台(2-8)上具有一水平的圆盘(2-7),所述滚珠丝杠直线模组(2-10)通过机械臂连接件(2-9)垂直地固接在水平旋转台(2-8)的圆盘(2-7)上;
所述同步带直线模组(2-4)通过滑块连接件(2-3)与滚珠丝杠直线模组(2-10)垂直接连;所述滑块连接件(2-3)能够在滚珠丝杠直线模组(2-10)上沿竖直方向滑动;同步带直线模组(2-4)能够在滑块连接件(2-3)上沿水平方向滑动;
所述末端执行器(3)包括电动夹爪(3-2)、摇杆(3-4)、第一连杆(3-5)、主夹持体(3-7)、第二连杆(3-9)、刀片(3-10)和辅助夹持体(3-11);
所述电动夹爪(3-2)通过末端执行器连接件(3-1)安装在机械臂(2)的同步带直线模组(2-4)的朝向串番茄植株的一端;所述电动夹爪(3-2)包括两个分别与电动夹爪(3-2)本体内部的两个相互啮合的齿轮连接的夹爪,两个夹爪分别通过夹爪连接件(3-8)与摇杆(3-4)的后端固接,两个摇杆(3-4)的前端分别与第一连杆(3-5)的后端和第二连杆(3-9)的后端通过销轴连接,所述第一连杆(3-5)的前端与第二连杆(3-9)的前端通过销轴连接;两个摇杆(3-4)、第一连杆(3-5)、第二连杆(3-9)和电动夹爪(3-2)内部的两个相互啮合的齿轮共同构成五连杆机构,实现对串番茄的包络;
所述主夹持体(3-7)固接在第一连杆(3-5)的前部,所述刀片(3-10)和辅助夹持体(3-11)与主夹持体(3-7)相对应地分别固接在第二连杆(3-9)的前部的上侧和下侧;
所述第一连杆(3-5)和第二连杆(3-9)的上端面分别设有第一压力传感器(3-6)和第二压力传感器(3-12);
所述主夹持体(3-7)与番茄果梗的接触面设有第三压力传感器(3-13);
所述视觉识别装置(4)包括深度相机(4-1)和相机连接件(4-2),所述深度相机(4-1)通过相机连接件(4-2)安装在机械臂(2)的同步带直线模组(2-4)的朝向串番茄的一端;
所述控制模块与移动平台车(1)、机械臂(2)的水平旋转台(2-8)、滚珠丝杠直线模组(2-10)和同步带直线模组(2-4)、末端执行器(3)的电动夹爪(3-2)、第一压力传感器(3-6)、第二压力传感器(3-12)和第三压力传感器(3-13)以及视觉识别装置(4)连接。
2.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述水平旋转台(2-8)内置有零点开关;所述滚珠丝杠直线模组(2-10)设有用于设定初始位置的垂直轴零点开关(2-2);所述同步带直线模组(2-4)设有用于设定初始位置的水平轴零点开关(2-1)。
3.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述滑块连接件(2-3)通过设置在滚珠丝杠直线模组(2-10)上部和下部的两个垂直轴限位开关(2-6)限制竖直方向的位移;同步带直线模组(2)通过设置在同步带直线模组(2-4)前部和后部的两个水平轴限位开关(2-5)限制水平方向的位移。
4.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述主夹持体(3-7)上设有与刀片(3-10)相对应的切断槽。
5.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述主夹持体(3-7)和辅助夹持体(3-11)的与番茄果梗的接触部分设有软垫层。
6.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述电动夹爪(3-2)上设置有限位块(3-3),用于限制电动夹爪(3-2)的两个夹爪的张开角度。
7.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述升降机构(1-2)的顶部平面上沿移动平台车(1)的行进方向安装四个机械臂(2),且机械臂(2)连接的末端执行器(3)左右交替地分别朝向左右两侧的串番茄植株。
8.根据权利要求1所述的多机械手串番茄采摘机器人,其特征在于:所述底部行走机构(1-1)为导轨式行走机构,进一步包括果框支撑架(1-3),所述果框支撑架(1-3)设置在升降机构(1-2)的左右两侧,用于悬挂果实收集装置(5);所述果实收集装置(5)位于机械臂(2)的正下方。
9.一种利用如权利要求1-8任一项所述的多机械手串番茄采摘机器人的串番茄采摘方法,其特征在于:该方法包括如下步骤:
采摘作业开始前,控制模块控制多个机械臂(2)定位于初始位姿;移动平台车(1)通过导航装置(1-4)沿非导轨路面铺设的导航线自主行走,到达相邻串番茄种植排之间的导轨上;
采摘作业开始,移动平台车(1)沿着导轨向前行走,并通过视觉识别装置(4)判断视野内是否有可采摘的串番茄,当发现有串番茄可以采摘时,移动平台车(1)停止前进;控制模块通过视觉识别装置(4)得到串番茄的位姿,并驱动机械臂(2)将末端执行器(3)运动到串番茄的底部,同时末端执行器(3)的电动夹爪(3-2)带动五连杆机构张开至最大状态,确保五连杆机构可以顺利包络串番茄果实,机械臂(2)的滚珠丝杠直线模组(2-10)上的滑块连接件(2-3)向上运动带动末端执行器(3)向上包络串番茄,当第一连杆(3-5)的第一压力传感器(3-6)和/或第二连杆(3-9)上的第二压力传感器(3-12)碰到果梗时,机械臂(2)的滚珠丝杠直线模组(2-10)上的滑块连接件(2-3)停止运动,机械臂(2)的同步带直线模组(2-4)向后移动一定距离,使果梗进入第一连杆(3-5)和第二连杆(3-9)前部的夹持和剪切区域;此时电动夹爪(3-2)带动五连杆机构闭合,刀片(3-10)和辅助夹持体(3-11)与主夹持体(3-7)相互靠近,刀片(3-10)和切断槽配合切断果梗,根据主夹持体(3-7)设置的第三压力传感器(3-13)反馈的信号确定果梗是否被夹持:若未接收到反馈的信号,说明果实未被夹持,此时,五连杆机构张开,机械臂(2)按原路返回;若接收到反馈的信号,说明果实已被夹持;此时,机械臂(2)带动末端执行器(3)将果实放入果实收集装置中,一次采摘结束,机械臂(2)回到初始位姿。
10.根据权利要求9所述的方法,其特征在于:一个机械臂(2)将采摘动作做完后,若发生未成功采到或者漏采的果实,同侧的另一个机械臂(2)会继续对目标果实进行采摘,确保目标果实被成功采摘,通过移动平台车(1)底部的行走机构(1-1)移动一定距离继续采摘,直到将全部水果采摘完成。
CN201910665111.7A 2019-07-23 2019-07-23 一种多机械手串番茄采摘机器人及其采摘方法 Active CN110249785B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910665111.7A CN110249785B (zh) 2019-07-23 2019-07-23 一种多机械手串番茄采摘机器人及其采摘方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910665111.7A CN110249785B (zh) 2019-07-23 2019-07-23 一种多机械手串番茄采摘机器人及其采摘方法

Publications (2)

Publication Number Publication Date
CN110249785A CN110249785A (zh) 2019-09-20
CN110249785B true CN110249785B (zh) 2020-07-14

Family

ID=67927784

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910665111.7A Active CN110249785B (zh) 2019-07-23 2019-07-23 一种多机械手串番茄采摘机器人及其采摘方法

Country Status (1)

Country Link
CN (1) CN110249785B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110603958B (zh) * 2019-10-27 2021-06-04 南京林业大学 一种局部激励的振动控制方法
CN112166824A (zh) * 2020-10-15 2021-01-05 四川农业大学 一种基于直角坐标式机械臂的水果采摘机器人
CN113196946A (zh) * 2021-06-22 2021-08-03 华南农业大学 一种自走式智能果蔬采摘收集机器人及其实现方法
CN113575108B (zh) * 2021-07-19 2022-05-13 杭州电子科技大学 一种蒜苔采收机及其蒜苔采收方法
CN113618746B (zh) * 2021-10-13 2022-01-18 季华实验室 机器人导航控制方法、装置、电子设备及存储介质
CN113924861A (zh) * 2021-11-05 2022-01-14 广东省农业科学院蔬菜研究所 一种用于温室大棚栽培蔬菜的自动采收系统
CN114175923A (zh) * 2021-11-24 2022-03-15 新疆钵施然智能农机股份有限公司 一种无人驾驶的果实采摘车
CN114402806B (zh) * 2022-02-18 2023-05-23 湖北汽车工业学院 一种球形果采摘机器人及采摘方法
CN114793612B (zh) * 2022-04-11 2023-02-03 河南科技大学 一种抓取力自平衡适应的番茄采摘机械手
CN115380831A (zh) * 2022-10-11 2022-11-25 甘肃鼎丰马铃薯种业有限公司 马铃薯组培苗全自动高通量组培快繁装置及其使用方法
CN116034732B (zh) * 2023-02-13 2024-05-07 华南理工大学 一种串番茄模糊采摘方法
CN116766136A (zh) * 2023-08-22 2023-09-19 成都工业职业技术学院 一种机械零件设计桌
CN117256314B (zh) * 2023-11-20 2024-04-12 山东寿光蔬菜种业集团有限公司 一种串番茄自动集果装置及方法

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2228421A1 (en) * 1973-05-11 1974-12-06 Hipolito Alberto Tractor mounted olive harvesting machine - has large envelope in two halves connected to two fans driven from tractor
CN103503637A (zh) * 2013-10-14 2014-01-15 青岛农业大学 智能辨识采摘机器人及采摘方法
CN106233938A (zh) * 2016-09-22 2016-12-21 天津职业技术师范大学 串型水果采摘机器人的末端执行器
CN106363618A (zh) * 2016-08-29 2017-02-01 河海大学常州校区 一种采摘机械手
CN107743768A (zh) * 2017-10-24 2018-03-02 江苏大学 一种新型草莓采摘移动机器人
CN109197160A (zh) * 2018-09-12 2019-01-15 华南农业大学 一种番石榴采摘机器人及其实现方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
FR2228421A1 (en) * 1973-05-11 1974-12-06 Hipolito Alberto Tractor mounted olive harvesting machine - has large envelope in two halves connected to two fans driven from tractor
CN103503637A (zh) * 2013-10-14 2014-01-15 青岛农业大学 智能辨识采摘机器人及采摘方法
CN106363618A (zh) * 2016-08-29 2017-02-01 河海大学常州校区 一种采摘机械手
CN106233938A (zh) * 2016-09-22 2016-12-21 天津职业技术师范大学 串型水果采摘机器人的末端执行器
CN107743768A (zh) * 2017-10-24 2018-03-02 江苏大学 一种新型草莓采摘移动机器人
CN109197160A (zh) * 2018-09-12 2019-01-15 华南农业大学 一种番石榴采摘机器人及其实现方法

Also Published As

Publication number Publication date
CN110249785A (zh) 2019-09-20

Similar Documents

Publication Publication Date Title
CN110249785B (zh) 一种多机械手串番茄采摘机器人及其采摘方法
CN113508686B (zh) 一种串番茄采摘末端执行器、机器人及其采摘方法
CN108575320B (zh) 草莓采摘机器人
CN107214716B (zh) 番茄果实串采摘末端执行器及其采摘方法
CN111742709B (zh) 基于深度视觉的香蕉采摘装置及采摘方法
CN203646089U (zh) 一种猕猴桃果实采摘机器人
KR100784830B1 (ko) 벤치 재배형 딸기 수확 로봇 시스템
CN111955165B (zh) 自走式全覆盖多目标红花花丝采摘机器人
CN112715163A (zh) 一种水果采摘机器人
CN111758397A (zh) 一种基于视觉识别的花椒智能采摘装置
CN109937694B (zh) 一种果实采摘收获机
CN113575108B (zh) 一种蒜苔采收机及其蒜苔采收方法
CN115024093A (zh) 一种轨道悬挂式果园机械装置及其高枝果实采摘方法
CN115529938A (zh) 一种西瓜智能采摘机器人
CN108834556B (zh) 一种草莓自动识别采摘机
JP2024144177A (ja) 遮蔽環境下での温室キュウリの効率的インテリジェントな収穫に適した装置
CN216146910U (zh) 双孢菇工厂化生产的采摘机器人
CN108323325B (zh) 一种模仿人手型的草莓采摘机器及采摘方法
CN113228939B (zh) 一种智能化的立式玉米收割台及玉米联合收割机
CN208079863U (zh) 一种模仿人手型的草莓采摘机器
CN209314338U (zh) 采摘黄花菜的机器人
CN116076243A (zh) 一种基于视觉感知与CoreXY结构的猕猴桃采摘机
CN114365624A (zh) 一种基于delta并联机械臂的高效农业采摘装置
Liu et al. History and present situations of robotic harvesting technology: a review
CN113728798A (zh) 多关节精准定位红花采收机械臂及采收方法

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
TR01 Transfer of patent right

Effective date of registration: 20221121

Address after: No. 158, Jinfeng Road, High tech Zone, Suzhou City, Jiangsu Province, 215011

Patentee after: Suzhou Botian Automation Technology Co.,Ltd.

Address before: 100083 No. 17 Qinghua East Road, Beijing, Haidian District

Patentee before: CHINA AGRICULTURAL University

TR01 Transfer of patent right