CN107743768A - 一种新型草莓采摘移动机器人 - Google Patents
一种新型草莓采摘移动机器人 Download PDFInfo
- Publication number
- CN107743768A CN107743768A CN201711001360.3A CN201711001360A CN107743768A CN 107743768 A CN107743768 A CN 107743768A CN 201711001360 A CN201711001360 A CN 201711001360A CN 107743768 A CN107743768 A CN 107743768A
- Authority
- CN
- China
- Prior art keywords
- motor
- strawberry
- magnetic valve
- limit switch
- sensor
- 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.)
- Pending
Links
Classifications
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D46/00—Picking of fruits, vegetables, hops, or the like; Devices for shaking trees or shrubs
- A01D46/30—Robotic devices for individually picking crops
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种新型草莓采摘移动机器人,包括底板、机械手、传感器组件、限位开关组件、行走机构、动力机构、控制***、电磁阀、打气装置和储气罐,机械手包括手臂组件、手爪组件和电气动剪柄组件,手臂组件安装于底板上,手爪组件安装于所述手臂组件上,控制***与所述传感器组件、限位开关组件和动力机构电连接,控制方法采用多线程编程,通过USB串口下载到“1+2”模式耦合的ROBO控制器,控制***控制动力机构以控制机械手和传感器组件的动作和位置。本发明能够实现对草莓自动进行感知和识别分析,精确采摘成熟草莓。
Description
技术领域
本发明涉及农业机器人,尤其涉及一种草莓采摘移动机器人。
背景技术
随着科学技术的发展,采摘机器人在农业领域的应用已经越来越广泛,采摘机器人的使用不仅能够减轻农民的劳动强度,更能提高作业效率,因此,越来越多的研究者对采摘机器人进行研究。如美国Harvest CROO Robotics公司研发的草莓采摘机器人,通过六个硅爪采摘的草莓被旋转到皮策轮的顶端放在采集杯中,输送到设备的中心位置进行1秒检测,合格的草莓被包装。中国专利申请号:201320440171.7,名称为“一种草莓采摘机器人”,公开了一种双目视觉相机实现草莓分辨,上海交通大学和中国农业大学的草莓采摘机器人的视觉***是基于CCD摄像机采集的彩色图像进行果实检测,上述机器人需建有一个采摘支持数据库,包括成熟果实、未成熟果实、花等数据信息,***复杂。然而农业机器人的使用者多数主体是农民,因此要求农业机器人具有较高的智能型、可靠性并且操作简单。
发明内容
针对现有技术中存在不足,本发明提供了一种新型草莓采摘移动机器人,能够实现对草莓自动进行感知和识别分析,精确采摘成熟草莓。
本发明是通过以下技术手段实现上述技术目的的。
一种新型草莓采摘移动机器人,包括底板、机械手、传感器组件、限位开关组件、行走机构、动力机构和控制***;
所述机械手包括手臂组件、手爪组件和电气动剪柄组件,所述手臂组件安装于底板上,所述手爪组件安装于所述手臂组件上,所述动力机构驱动手臂组件控制手爪组件沿x轴方向和z轴方向运动;
所述手爪组件包括手爪摆杆机构、第二气缸和第二气缸活塞,所述手爪摆杆机构包括位于第二气缸活塞一侧的第一手指、第一摆杆和第一连杆,以及分布于第二气缸活塞另一侧的第二手指、第二摆杆、第二连杆和固定于第二气缸活塞前端的销钉槽轴,所述第二手指、第二摆杆和第二连杆与第一手指、第一摆杆和第一连杆分别关于第二气缸活塞一一对称分布,所述第一手指的一端与第一摆杆的一端铰接,所述第一摆杆的另一端与机械手支座铰接,所述机械手支座固定于手臂组件上,所述第一摆杆的中心与第一连杆的一端铰接,所述第一连杆的另一端与固定于第二气缸活塞前端的销钉槽轴一侧以圆柱销钉高副连接,所述第二气缸安装于所述机械手支座内;所述销钉槽轴的另一端穿过设置在机械手支座上的套筒内;所述第二手指的一端与第二摆杆的一端铰接,所述第二摆杆的另一端与机械手支座铰接,所述第二摆杆的中心与第二连杆的一端铰接,所述第二连杆另一端与所述第二气缸活塞固定的销钉槽轴另一侧以圆柱销钉高副连接。
所述电气动剪柄组件安装于所述手爪组件的上方,包括剪刀、第一气缸、第一气缸活塞、第一摇杆、第二摇杆、支撑杆,所述剪刀的第一手柄的尾端与第一摇杆铰接,所述剪刀的第二手柄的尾端与第二摇杆的一端铰接,所述第一摇杆和第二摇杆的另一端均与机械手支座铰接,所述支撑杆的一端与所述剪刀的刀口铰接处铰接,所述支撑杆的另一端垂直固定于所述第一气缸活塞上,所述第一气缸的一端固定在机械手支座上表面的安装块上;
所述传感器组件安装于所述手爪组件下方,包括超声波传感器、颜色传感器、第一丝杆与第一丝杆螺母,所述第一丝杆螺母与所述第一丝杆螺纹连接,所述颜色传感器安装于所述第一丝杆螺母上,所述超声波传感器安装于所述颜色传感器,所述动力机构驱动第一丝杆旋转,使得所述第一丝杆螺母沿x轴方向移动;
所述限位开关组件包括六个限位开关,六个所述限位开关分别安装在所述手爪组件沿x轴方向、z轴方向运动的极限位置以及所述传感器组件沿x轴方向运动的极限位置;
所述行走机构用于使底板沿y轴方向运动,并安装于底板的底面;
所述控制***包括控制器,所述控制器与所述传感器组件、限位开关组件和动力机构电连接,所述控制器接收传感器组件和限位开关组件的传递的信号,并控制动力机构以控制机械手和传感器组件的动作和位置。
优选地,所述手臂组件包括第三丝杆、第三丝杆螺母、第二丝杆、第二丝杆螺母、T型块、连轴节、手臂支架、第一立柱、第二立柱、支撑柱;
所述动力机构包括第二电机、第三电机、第四电机、定轴轮系和齿轮箱;
所述T型块固定于支撑柱的顶端,所述第一立柱和第二立柱分别位于T型块的两侧,所述第一立柱的底端固定于底板上,第一立柱的另一端穿过连轴节后固定于T型块上,所述第二立柱的底端固定于底板上,第二立柱的另一端穿过手臂支架后固定于T型块上,所述手臂支架的前端与连轴节固定连接;
所述定轴轮系设置在T型块上,包括五个依次啮合的齿轮,五个齿轮排成一条直线,第一齿轮和第三齿轮分别固定套装在第三电机和第四电机的电机轴上;
所述第三丝杆竖直设置在底板的上方,所述第三丝杆与第三丝杆螺母螺纹连接,第五齿轮固定套装在所述第三丝杆的一端,所述第三丝杆的另一端可转动地安装在底板上,第三丝杆螺母与手臂支架固定连接;
所述齿轮箱安装在手臂支架的后端,所述第二电机的电机轴与齿轮箱的输入端连接,所述齿轮箱的输出端与第二丝杆的一端连接,所述第二丝杆的另一端可转动地安装于手臂支架上,所述第二丝杆螺母与所述第二丝杆螺纹连接,所述机械手支座的一端穿过连轴节,并与第二丝杆螺母固定连接,所述机械手支座可随着第二丝杆螺母与底板一起沿y轴方向运动。
优选地,所述动力机构还包括第一电机,所述第一电机固定于机械手支座上,所述第一电机的电机轴与第一丝杆的一端连接。
优选地,所述机械手支座上设有LED灯。
优选地,所述行走机构包括分布于底板底面的多个车轮,每两个位于底板两侧的车轮(20)形成一排;所述动力机构还包括第五电机和第六电机,所述第五电机和第六电机分别驱动底板最前排的两个车轮运动。
优选地,还包括电磁阀、打气装置和储气罐,所述电磁阀包括电磁阀A、电磁阀B、电磁阀C和电磁阀D,所述储气罐的一端与电磁阀A的通气孔连通,电磁阀A与第一气缸的进气口连通,所述第一气缸的出气口与电磁阀B连通,电磁阀B的通气孔与储气罐连通;电磁阀C的通气孔与气管连通并与储气罐保持通气,电磁阀C与第二气缸的进气口连通,第二气缸的出气口与电磁阀D连通,电磁阀D的通气孔与储气罐保持通气;
所述动力机构还包括第七电机,所述打气装置包括皮带轮、折杆和活塞杆;所述第七电机的电机轴与中轴连接,所述中轴通过皮带与皮带轮连接,所述皮带轮与折杆的一端固定连接,所述折杆的另一端***活塞杆下端的孔里,活塞杆与储气罐上的气动活塞固定连接。
优选地,所述控制***包括一个ROBO主控制器、两个ROBO子控制器和一台计算机,所述计算机上装有草莓采摘程序,所述草莓采摘程序通过USB串口下载到“1+2”模式耦合的三个ROBO控制器,三个ROBO控制器分别通过针状数据线互相连接,所述第一电机、第二电机、第三电机、第四电机分别连接ROBO主板的M1、M2、M3、M4输出端口;
六个限位开关分别为第一~第六限位开关,第一限位开关和第二限位开关分别位于第三丝杆的最底端和最顶端,第三限位开关和第四限位开关分别位于第二丝杆的最前端和最后端,第五限位开关和第六限位开关分别位于第一丝杆的最前端和最后端,第一~第六限位开关分别连接ROBO主板的数字输入口I5、I4、I3、I8、I6和I7,超声波传感器和颜色传感器分别连接ROBO主板的数字输入口I1和I2;第五电机、第六电机、第七电机和LED灯分别连接第一ROBO子控制器上的EM1、EM2、EM3、EM4输出端口;电磁阀A、电磁阀B、电磁阀C和电磁阀D分别连接第二ROBO子控制器上的M1、M2、M3、M4输出端口。
一种新型草莓采摘移动机器人的控制方法,采用多线程编程,通过编写ROBO Pro主程序调用子程序,包括以下步骤:
步骤一:采摘机器人初始复位:主程序开始,第三电机、第四电机逆时针转动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,使得机械手手臂组件垂直运动到z轴最高处位置,第二限位开关触发,第三电机、第四电机停止,第三丝杆螺母到达初始位置;然后第二电机顺时针转动,用一个判断模块,查询第三限位开关的状态,对输入口I3进行设置,使得手臂组件运动到x轴最右端,第三限位开关触发,第二电机停止,接着控制第二电机逆时针转动,第二丝杆螺母到达初始位置,第二电机停止;然后控制第一电机逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置。到指定的位置,当传感器组件运动到最前方,第五限位开关触发,第一电机停止,传感器组件到达初始工作位置;
步骤二:完成初始准备工作:电磁阀A、电磁阀B、电磁阀C和电磁阀D断电,手爪组件保持第一手指和第二手指合拢,第七电机启动,开始打气,第五电机和第六电机顺时针转动,车轮滚动使底板前进10cm,进入草莓生长区;
步骤三:由上至下搜索草莓:启动第三电机和第四电机顺时针转动,机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波下”,通过超声波传感器进行目标锁定,***颜色传感器面板Co,基于颜色传感器进行颜色判断,实现草莓识别;颜色传感器识别寻找到目标,则停止第三电机和第四电机,运行子程序“颜色下”,未识别到则保持机械手手臂组件向下移动,用一个判断模块,查询第一限位开关的状态,对输入口I5进行设置,当第三丝杆螺母向下移动到最底部时,压住第一限位开关,第三电机和第四电机停止;跳出子程序“超声波下”,子程序“颜色下”,进入主程序;
步骤四:机器人移动:启动第五电机、第六电机顺时针转动,车轮滚动,进入未识别过的草莓生长区;
步骤五:由下至上搜索草莓:启动第三电机和第四电机逆时针转动,第三丝杆螺母向上移动,使得机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波上”,通过超声波传感器感进行目标锁定,***颜色传感器面板Co,基于颜色传感器进行颜色判断,实现草莓识别;颜色识别寻找到目标,则停止第三电机和第四电机,运行子程序“颜色上”,未识别到则保持机械手手臂组件向上移动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,当第三丝杆螺母向上移动到最顶部时,压住第二限位开关,第三电机和第四电机停止,完成一个循环的草莓搜寻;跳出子程序“超声波上”,子程序“颜色上”,进入主程序;
步骤六:重复步骤二至五,如此往复循环,直至采摘移动机器人驶出草莓生长区后结束;
所述子程序“超声波下”的具体步骤如下:
S1:创建与主程序相同的超声波传感器面板U1,第三电机停止,超声波传感器距离草莓小于3cm时,第二电机顺时针启动,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器与草莓的距离,若还是小于3cm,则第二电机顺时针启动,直至距离大于3cm;
S2:第二电机逆时针转动,手爪组件前进,判断超声波传感器与草莓的距离是否为3cm~4cm之间,若否,则第二电机逆时针转动,直至超声波传感器与草莓的距离为3cm~4cm;
S3:第三电机和第四电机顺时针运行,机械手向下移动,结束;
所述子程序“颜色下”的具体步骤如下:
A1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000(红色)时,由子程序“颜色下”回到主程序;当颜色传感器测的数值<1000(红色)时,关闭电磁阀,停止第三电机和第四电机;第一电机顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机停止,第一丝杆螺母到达第一丝杆的最后端,传感器组件停止工作
A2:第三电机和第四电机顺时针启动,使机械手下降,到达草莓正前方后停止第三电机和第四电机;
A3:第二电机逆时针启动,手爪组件前进,使草莓处在机械手抓取范围以后停止第二电机;
A4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指和第二手指合拢抓取红草莓;
A5:第二电机顺时针启动,使手爪组件后退,将红草莓的绿果柄拉出绷紧;
A6:电磁阀A开,电磁阀B关,剪刀合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,保持两秒,剪刀打开,重复循环两次,确保绿果柄被剪断;
A7:第二电机顺时针启动,手爪组件后退到识别位置;
A8:电磁阀C关,电磁阀D开,第一手指和第二手指张开将红草莓果实放下后,关闭电磁阀D;
A9:第一电机逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置。到指定的位置,第五限位开关触发,第一电机停止,第三丝杆螺母回到最前端,传感器组件到达工作位置;
所述子程序“超声波上”的具体步骤如下:
F1:创建与主程序相同的超声波传感器面板U1,第三电机停止,超声波传感器距离草莓小于3cm时,第二电机顺时针启动,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器与草莓的距离,若还是小于3cm,则第二电机顺时针启动,直至距离大于3cm;
F2:第二电机逆时针转动,手爪组件前进,判断超声波传感器与草莓的距离是否为3cm~4cm之间,若否,则第二电机逆时针转动,直至超声波传感器与草莓的距离为3cm~4cm;
F3:第三电机和第四电机逆时针运行,机械手向上移动,结束;
所述子程序“颜色上”的具体步骤如下:
B1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000(红色)时,由子程序“颜色上”回到主程序;当颜色传感器测的数值<1000(红色)时,关闭电磁阀(19),停止第三电机和第四电机;第一电机顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机停止,第一丝杆螺母到达第一丝杆的最后端,传感器组件停止工作
B2:第三电机和第四电机顺时针启动,使机械手下降,到达草莓正前方后停止第三电机和第四电机;
B3:第二电机逆时针启动,手爪组件前进,使草莓处在机械手抓取范围以后停止电机M2;
B4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指和第二手指合拢抓取红草莓;
B、5:第二电机顺时针启动,使手爪组件后退,将红草莓的绿果柄拉出绷紧;
B6:电磁阀A开,电磁阀B关,剪刀合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,保持两秒,剪刀打开,重复循环两次,确保绿果柄被剪断;
B7:第二电机顺时针启动,手爪组件后退到识别位置;
B8:电磁阀C关,电磁阀D开,第一手指和第二手指张开将红草莓果实放下后,关闭电磁阀D;
B9:第一电机逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置,到指定的位置,第五限位开关触发,第一电机停止,第三丝杆螺母回到最前端,传感器组件到达工作位置。
本发明的有益效果:
1)本发明所述的一种新型草莓采摘移动机器人是具有感知、识别、采摘能力的智能机械收获***,控制器与超声波传感器、颜色传感器连接,通过超声波传感器接收端在前方3~4cm内感知有果实时触发信号,颜色传感器完成颜色识别,实现了果实空间的初步定位和有效的识别,通过草莓采摘控制方法控制机器人的运动,能够自动完成草莓采摘。
2)本发明的气动机械手运动更加自如,本发明的有效可行的多线程算法,在非线性情况下更加实用。
3)本发明结构优化、高智能型、操作方便、准确率高,易于推广使用。
附图说明
图1为本发明所述一种新型草莓采摘移动机器人的结构示意图。
图2为本发明所述机械手的局部放大示意图。
图3为本发明所述一种新型草莓采摘移动机器人的局部示意图。
图4为本发明所述气缸手爪摆杆机构抓取草莓示意图。
图5为本发明所述气动剪刀组合机构示意图。
图6为本发明所述主程序流程框图。
图7为本发明所述子程序“超声波下”流程框图。
图8为本发明所述子程序“颜色下”流程框图。
图9为本发明所述子程序“超声波上”流程框图。
图10为本发明所述子程序“颜色上”流程框图。
图中:1.打气装置;2.储气罐;3.底板;4.第一电机;5.限位开关;6.超声波传感器;7.颜色传感器;8.机械手;9.剪刀;10.气动装置;11.机械手支座;12.第三丝杆螺母;13.定轴轮系;14.第二丝杆;15.齿轮箱,16.第二电机,17.第三电机,18.第三丝杆,19.电磁阀,20.车轮;21.第四电机;22.第二丝杆螺母;23.第一丝杆;24.第一丝杆螺母;25.第一气缸;26.第一气缸活塞;27-1.第一摆杆;27-2.第二摆杆;28-1第一连杆;28-2.第二连杆;29-1.第一手指;29-2.第二手指;30.第五电机;31.第六电机;32.第二气缸;33.第二气缸活塞;34.支撑杆;35.第七电机;36.皮带轮;37.折杆;38.输气孔;39.活塞杆;40.中轴;41.气动活塞;42.第一摇杆;43.第二摇杆;44.第一立柱;45.第二立柱;46.T型块;47.联轴节;48.手臂支架;49.支撑柱。
具体实施方式
下面结合附图以及具体实施例对本发明作进一步的说明,但本发明的保护范围并不限于此。
如图1所示,本发明所述的一种新型草莓采摘移动机器人,包括底板3、机械手8、传感器组件、限位开关组件、行走机构、动力机构、控制***、电磁阀19、打气装置1和储气罐2。
动力机构包括第一电机4、第二电机16、第三电机17、第四电机21、第五电机30、第六电机31、第七电机35、定轴轮系13和齿轮箱15。
如图2所示,机械手包括手臂组件、手爪组件和电气动剪柄组件,手臂组件包括第三丝杆18、第三丝杆螺母12、第二丝杆14、第二丝杆螺母22、T型块46、连轴节47、手臂支架48、第一立柱44、第二立柱45、支撑柱49。
如图1所示,T型块46固定于支撑柱49的顶端,第一立柱44和第二立柱45分别位于T型块46的两侧,第一立柱44的底端固定于底板3上,第一立柱44的另一端穿过连轴节47后固定于T型块46上,第二立柱45的底端固定于底板3上,第二立柱45的另一端穿过手臂支架48后固定于T型块46上,手臂支架48的前端与连轴节47固定连接。
定轴轮系13设置在T型块46上,包括五个依次啮合的齿轮,五个齿轮排成一条直线,第一齿轮和第三齿轮分别固定套装在第三电机17和第四电机21的电机轴上。第三丝杆18竖直设置在底板3的上方,并通过支撑柱49和T型块46支撑,第三丝杆18与第三丝杆螺母12螺纹连接,第五齿轮固定套装在所述第三丝杆18的一端,所述第三丝杆18的另一端可转动地安装在底板3上,第三丝杆螺母12与手臂支架48固定连接。
齿轮箱15安装在手臂支架48的后端,第二电机16的电机轴与齿轮箱15的输入端连接,齿轮箱15的输出端与第二丝杆14的一端连接,第二丝杆14的另一端可转动地安装于手臂支架48上,第二丝杆螺母22与所述第二丝杆14螺纹连接,机械手支座11的一端穿过连轴节47,并与第二丝杆螺母22固定连接,所述机械手支座11可随着第二丝杆螺母22与底板3一起沿y轴方向运动。
如图3和图4所示,所述手爪组件包括手爪摆杆机构、第二气缸32和第二气缸活塞33,所述手爪摆杆机构包括位于第二气缸活塞33一侧的第一手指29-1、第一摆杆27-1和第一连杆28-1,以及分布于第二气缸活塞33另一侧的第二手指29-2、第二摆杆27-2、第二连杆28-2和固定于第二气缸活塞33前端的销钉槽轴。所述第二手指29-2、第二摆杆27-2和第二连杆28-2与第一手指29-1、第一摆杆27-1和第一连杆28-1分别关于第二气缸活塞33一一对称分布,所述第一手指29-1的一端与第一摆杆27-1的一端铰接,所述第一摆杆27-1的另一端与机械手支座11铰接,所述机械手支座11固定于手臂组件上,所述第一摆杆27-1的中心与第一连杆28-1的一端铰接,所述第一连杆28-1的另一端与固定于第二气缸活塞33前端的销钉槽轴一侧以圆柱销钉高副连接,所述第二气缸32安装于所述机械手支座11内;所述销钉槽轴的另一端穿过设置在机械手支座11内的套筒内,形成移动副,所述第二手指29-2的一端与第二摆杆27-2的一端铰接,所述第二摆杆27-2的另一端与机械手支座11铰接,所述第二摆杆27-2的中心与第二连杆28-2的一端铰接,所述第二连杆28-2另一端与所述第二气缸活塞33固定的销钉槽轴另一侧以圆柱销钉高副连接。
如图4所示,手爪组件运动时分三种状态:
如图4a所示,手指未碰到草莓或茎叶,构件n=6,低副PL=6,高副PH=2;
如图4b所示,一个手指碰到草莓或茎叶,在图4a所示状态下,结构上增加1构件、增加1铰链、增加1高副,此时n=7,PL=7,PH=3;
如图4c所示,两个手指碰到茎叶,在图4a所示状态下,结构上增加2构件、增加2铰链、增加2高副,此时n=8,PL=8,PH=4。
手爪组件的平面自由度在以上三种状态下均等于1,F=3(n-1)-2PL-PH=1。
如图2和图5所示,电气动剪柄组件安装于所述手爪组件的上方,包括剪刀9、第一气缸25、第一气缸活塞26、第一摇杆42、第二摇杆43、支撑杆34,所述剪刀9的第一手柄9-1的尾端与第一摇杆42铰接,所述剪刀9的第二手柄9-2的尾端与第二摇杆43的一端铰接,所述第一摇杆42和第二摇杆43的另一端均与机械手支座11铰接,所述支撑杆34的一端与所述剪刀9的刀口铰接处铰接,所述支撑杆34的另一端垂直固定于所述第一气缸活塞26上,第一气缸26的伸缩,带动剪刀9的刀口张开与闭合。所述第一气缸25的一端固定在机械手支座11上表面的安装块上,手爪组件与电气动剪柄组件沿x轴方向同步运动。
传感器组件安装于所述手爪组件下方,包括超声波传感器6、颜色传感器7、第一丝杆23与第一丝杆螺母24,所述第一丝杆螺母24与所述第一丝杆23螺纹连接,所述颜色传感器7安装于所述第一丝杆螺母24上,所述超声波传感器6安装于所述颜色传感器7,第一电机4的电机轴与第一丝杆23的一端连接,驱动第一丝杆23旋转,使得所述第一丝杆螺母24沿x轴方向移动,带动传感器组件沿x轴方向移动,第一电机4固定于机械手支座11上。
限位开关组件包括六个限位开关5,六个所述限位开关5分别安装在所述手爪组件沿x轴方向、z轴方向运动的极限位置以及所述传感器组件沿x轴方向运动的极限位置。
行走机构包括分布于底板3底面的八个车轮20,每两个位于底板3两侧的车轮20形成一排,一共四排;所述动力机构还包括第五电机30和第六电机31,所述第五电机30和第六电机31分别驱动底板3最前排的两个车轮20运动。
所述电磁阀19包括电磁阀A、电磁阀B、电磁阀C和电磁阀D,所述储气罐2的一端与电磁阀A的通气孔连通,电磁阀A与第一气缸25的进气口连通,所述第一气缸25的出气口与电磁阀B连通,电磁阀B的通气孔与储气罐2连通,电磁阀A和电磁阀B控制第一气缸25的进气与出气;电磁阀C的通气孔与气管连通并与储气罐2保持通气,电磁阀C与第二气缸32的进气口连通,第二气缸32的出气口与电磁阀D连通,电磁阀D的通气孔与储气罐2保持通气,电磁阀C和电磁阀D控制第二气缸32的进气与出气。
打气装置1包括皮带轮36、折杆37和活塞杆39;所述第七电机35的电机轴与中轴40连接,带动中轴40旋转,中轴40与皮带轮36之间绕有皮带,皮带轮36也随之转动,折杆37一端固定穿过带轮36,所以折杆37也随之转动,由于折杆37弯折端***于活塞杆39下端的孔里,所以活塞杆39带动气动活塞41上下来回移动,不断打气,气体通过输气孔38进入与储气罐2相连的气管里,再进入储气罐2储存,因为电磁阀19关闭,气缸不漏气。当需要使用时,打开电磁阀19,储气罐2气体输出。
控制***包括一个ROBO主控制器、两个ROBO子控制器和一台计算机,所述计算机上装有草莓采摘程序,所述草莓采摘软件程序通过USB串口下载到三个ROBO控制器,三个ROBO控制器分别通过针状数据线互相连接,所述第一电机4、第二电机16、第三电机17、第四电机21分别连接ROBO主板的M1、M2、M3、M4输出端口;
六个限位开关5分别为第一~第六限位开关,第一限位开关和第二限位开关分别位于第三丝杆18的最底端和最顶端,第三限位开关和第四限位开关分别位于第二丝杆14的最前端和最后端,第五限位开关和第六限位开关分别位于第一丝杆23的最前端和最后端,第一~第六限位开关分别连接ROBO主板的数字输入口I5、I4、I3、I8、I6和I7,超声波传感器6和颜色传感器7分别连接ROBO主板的数字输入口I1和I2;第五电机30、第六电机31、第七电机35和LED灯分别连接第一ROBO子控制器上的EM1、EM2、EM3、EM4输出端口;电磁阀A、电磁阀B、电磁阀C和电磁阀D分别连接第二ROBO子控制器上的M1、M2、M3、M4输出端口。
所述控制***包括控制器,所述控制器与所述传感器组件、限位开关组件和动力机构电连接,控制***通过控制第一电机4、第二电机16、第三电机17、第四电机21控制机械手的位置,控制***根据超声波传感器6反馈的信号控制机械手8的运动接近草莓,并通过颜色传感器7将识别到的草莓颜色传输给控制***,控制***将草莓红颜色与草莓茎叶、果柄的绿颜色进行判断分配,根据分配结果控制机械手8运动将成熟草莓抓夹,反馈的颜色信号通过控制电磁阀19来控制气动剪刀组合机构剪断草莓绿果柄,然后控制气缸手爪摆杆机构松开机械手夹持的红草莓,实现红草莓的采摘。控制***通过控制第五电机30、第六电机31的脉冲,分别控制第五电机30、第六电机31的速度,当第五电机30速度=第六电机31速度,采摘机器人走直线,当第五电机30速度>第六电机31速度,采摘机器人左转,当第五电机30速度<第六电机31速度,采摘机器人右转。
一种新型草莓采摘移动机器人的控制方法,所述控制方法采用多线程编程,通过编写ROBO Pro主程序调用子程序的方法,如图6所示,包括以下步骤:
步骤一:采摘机器人初始复位:主程序开始,第三电机17、第四电机21均以8转/秒逆时针转动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,使得机械手手臂组件垂直运动到z轴最高处位置,第二限位开关触发,第三电机17、第四电机21停止,第三丝杆螺母12到达初始位置;然后第二电机16以8转/秒顺时针转动4秒,用一个判断模块,查询第三限位开关的状态,对输入口I3进行设置,使得手臂组件运动到x轴最右端,第三限位开关触发,第二电机16停止,接着控制第二电机16以8转/秒逆时针转动,延时4秒后,第二电机16停止,第二丝杆螺母22到达初始位置;然后控制第一电机4以8转/秒逆时针转动,用一个判断模块,查询第五限位开关的状态。对输入口I6进行设置,到指定的位置,当传感器组件运动到最前方,第五限位开关触发,第一电机4停止,传感器组件到达初始工作位置;
步骤二:完成初始准备工作:电磁阀A、电磁阀B、电磁阀C和电磁阀D断电,手爪组件保持第一手指29-1和第二手指29-2合拢,第七电机35启动,开始打气,第五电机30和第六电机31均以8转/秒顺时针转动两秒,车轮20滚动使底板前进10cm,进入草莓生长区;
步骤三:由上至下搜索草莓:启动第三电机17和第四电机21均以5转/秒顺时针转动,机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波下”,通过超声波传感器6进行目标锁定,***颜色传感器面板Co,基于颜色传感器7进行颜色判断,实现草莓识别;颜色传感器7识别寻找到目标,则停止第三电机17和第四电机21,运行子程序“颜色下”,未识别到则保持机械手手臂组件向下移动,用一个判断模块,查询第一限位开关的状态,对输入口I5进行设置,当第三丝杆螺母12向下移动到最底部时,压住第一限位开关,第三电机17和第四电机21停止;跳出子程序“超声波下”,子程序“颜色下”,进入主程序;
步骤四:机器人移动:启动第五电机30、第六电机31均以8转/秒顺时针转动2秒,车轮20滚动,进入未识别过的草莓生长区;
步骤五:由下至上搜索草莓:启动第三电机17和第四电机21均以8转/秒逆时针转动,第三丝杆螺母12向上移动,使得机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波上”,通过超声波传感器感6进行目标锁定,***颜色传感器面板Co,基于颜色传感器7进行颜色判断,实现草莓识别;颜色识别寻找到目标,则停止第三电机17和第四电机21,运行子程序“颜色上”,未识别到则保持机械手手臂组件向上移动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,当第三丝杆螺母12向上移动到最顶部时,压住第二限位开关,第三电机17和第四电机21停止,完成一个循环的草莓搜寻;跳出子程序“超声波上”,子程序“颜色上”,进入主程序;
步骤六:重复步骤二至五,如此往复循环,直至采摘移动机器人驶出草莓生长区后结束;
如图7所示,所述子程序“超声波下”的具体步骤如下:
S1:创建与主程序相同的超声波传感器面板U1,第三电机17停止,超声波传感器6距离草莓小于3cm时,第二电机16以8转/秒顺时针启动,保持0.2秒,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器6与草莓的距离,若还是小于3cm,则第二电机16以8转/秒顺时针启动,保持0.2秒,直至距离大于3cm;
S2:第二电机16以8转/秒逆时针转动,手爪组件前进,判断超声波传感器6与草莓的距离是否为3cm~4cm之间,若否,则第二电机16以8转/秒逆时针转动0.2秒,直至超声波传感器6与草莓的距离为3cm~4cm;
S3:第三电机17和第四电机21均以5转/秒顺时针运行0.5秒,机械手向下移动,结束;
如图8所示,所述子程序“颜色下”的具体步骤如下:
A1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000红色时,子程序交回到主程序;当颜色传感器测的数值<1000红色时,关闭电磁阀19,停止第三电机17和第四电机21;第一电机4以8转/秒顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机4停止,第一丝杆螺母24到达第一丝杆23的最后端,传感器组件停止工作;
A2:第三电机17和第四电机21均以8转/秒顺时针启动,保持三秒,使机械手下降3.5cm,到达草莓正前方后停止第三电机17和第四电机21;
A3:第二电机16以8转/秒逆时针启动,保持7秒,手爪组件前进4.5cm,使草莓处在机械手抓取范围以后停止第二电机16;
A4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指29-1和第二手指29-2合拢抓取红草莓;
A5:第二电机16以8转/秒顺时针启动,保持2秒,使手爪组件后退,将红草莓的绿果柄拉出绷紧;
A6:电磁阀A开,电磁阀B关,保持3秒,剪刀9合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,保持两秒,剪刀9打开,重复循环两次,确保绿果柄被剪断;
A7:第二电机16以8转/秒顺时针启动,保持5秒,手爪组件后退到识别位置;
A8:电磁阀C关,电磁阀D开,第一手指29-1和第二手指29-2张开将红草莓果实放下后,关闭电磁阀D;
A9:第一电机4以8转/秒逆时针转动,用一个判断模块,查询第五限位开关的状态。对输入口I6进行设置。到指定的位置,第五限位开关触发,第一电机4停止,第一丝杆螺母24回到最前端,传感器组件到达工作位置;第三电机17和第四电机21均以5转/秒顺时针启动,使机械手向下移动,结束。
如图9所示,所述子程序“超声波上”的具体步骤如下:
F1:创建与主程序相同的超声波传感器面板U1,第三电机17停止,超声波传感器6距离草莓小于3cm时,第二电机16以8转/秒顺时针启动,保持0.2秒,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器6与草莓的距离,若还是小于3cm,则第二电机16以8转/秒顺时针启动,保持0.2秒,直至距离大于3cm;
F2:第二电机16以8转/秒逆时针转动,手爪组件前进,判断超声波传感器6与草莓的距离是否为3cm~4cm之间,若否,则第二电机16以8转/秒逆时针转动0.2秒,直至超声波传感器6与草莓的距离为3cm~4cm;
F3:第三电机17和第四电机21逆时针运行0.5秒,机械手向上移动,结束;
如图10所示,所述子程序“颜色上”的具体步骤如下:
B1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000红色时,子程序交回到主程序;当颜色传感器测的数值<1000红色时,关闭电磁阀19,停止第三电机17和第四电机21;第一电机4以8转/秒顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机4停止,第一丝杆螺母24到达第一丝杆23的最后端,传感器组件停止工作。
B2:第三电机17和第四电机21均以8转/秒顺时针启动,保持0.5秒,使机械手下降3.5cm,到达草莓正前方后停止第三电机17和第四电机21;
B3:第二电机16以8转/秒逆时针启动,保持7秒,手爪组件前进4.5cm,使草莓处在机械手抓取范围以后停止电机第二电机16;
B4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指29-1和第二手指29-2合拢抓取红草莓;
B5:第二电机16以8转/秒顺时针启动,保持2秒,使手爪组件后退,将红草莓的绿果柄拉出绷紧;停止第二电机16;
B6:电磁阀A开,电磁阀B关,保持3秒,剪刀9合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,保持两秒,剪刀9打开,重复循环两次,确保绿果柄被剪断;
B7:第二电机16以8转/秒顺时针启动,保持5秒,手爪组件后退到识别位置,停止第二电机16;
B8:电磁阀C关,电磁阀D开,保持2秒,第一手指29-1和第二手指29-2张开将红草莓果实放下后,关闭电磁阀D;
B9:第一电机4以8转/秒逆时针转动,用一个判断模块,查询第五限位开关的状态。对输入口I6进行设置。到指定的位置,第五限位开关触发,第一电机4停止,第一丝杆螺母24回到最前端,传感器组件到达工作位置,第三电机17和第四电机21均以8转/秒逆时针启动,使机械手上升,结束。
所述实施例为本发明的优选的实施方式,但本发明并不限于上述实施方式,在不背离本发明的实质内容的情况下,本领域技术人员能够做出的任何显而易见的改进、替换或变型均属于本发明的保护范围。
Claims (8)
1.一种新型草莓采摘移动机器人,其特征在于,包括底板(3)、机械手(8)、传感器组件、限位开关组件、行走机构、动力机构和控制***;
所述机械手包括手臂组件、手爪组件和电气动剪柄组件,所述手臂组件安装于底板(3)上,所述手爪组件安装于所述手臂组件上,所述动力机构驱动手臂组件控制手爪组件沿x轴方向和z轴方向运动;
所述手爪组件包括手爪摆杆机构、第二气缸(32)和第二气缸活塞(33),所述手爪摆杆机构包括位于第二气缸活塞(33)一侧的第一手指(29-1)、第一摆杆(27-1)和第一连杆(28-1),以及分布于第二气缸活塞(33)另一侧的第二手指(29-2)、第二摆杆(27-2)、第二连杆(28-2)和固定于第二气缸活塞(33)前端的销钉槽轴,所述第二手指(29-2)、第二摆杆(27-2)和第二连杆(28-2)与第一手指(29-1)、第一摆杆(27-1)和第一连杆(28-1)分别关于第二气缸活塞(33)一一对称分布,所述第一手指(29-1)的一端与第一摆杆(27-1)的一端铰接,所述第一摆杆(27-1)的另一端与机械手支座(11)铰接,所述机械手支座(11)固定于手臂组件上,所述第一摆杆(27-1)的中心与第一连杆(28-1)的一端铰接,所述第一连杆(28-1)的另一端与固定于第二气缸活塞(33)前端的销钉槽轴一侧以圆柱销钉高副连接,所述第二气缸(32)安装于所述机械手支座(11)内;所述销钉槽轴穿过设置在机械手支座(11)上的套筒内,所述第二手指(29-2)的一端与第二摆杆(27-2)的一端铰接,所述第二摆杆(27-2)的另一端与机械手支座(11)铰接,所述第二摆杆(27-2)的中心与第二连杆(28-2)的一端铰接,所述第二连杆(28-2)另一端与销钉槽轴的另一侧以圆柱销钉高副连接;
所述电气动剪柄组件安装于所述手爪组件的上方,包括剪刀(9)、第一气缸(25)、第一气缸活塞(26)、第一摇杆(42)、第二摇杆(43)、支撑杆(34),所述剪刀(9)的第一手柄(9-1)的尾端与第一摇杆(42)铰接,所述剪刀(9)的第二手柄(9-2)的尾端与第二摇杆(43)的一端铰接,所述第一摇杆(42)和第二摇杆(43)的另一端均与机械手支座(11)铰接,所述支撑杆(34)的一端与所述剪刀(9)的刀口铰接处铰接,所述支撑杆(34)的另一端垂直固定于所述第一气缸活塞(26)上,所述第一气缸(25)的一端固定在机械手支座(11)上表面的安装块上;
所述传感器组件安装于所述手爪组件下方,包括超声波传感器(6)、颜色传感器(7)、第一丝杆(23)与第一丝杆螺母(24),所述第一丝杆螺母(24)与所述第一丝杆(23)螺纹连接,所述颜色传感器(7)安装于所述第一丝杆螺母(24)上,所述超声波传感器(6)安装于所述颜色传感器(7),所述动力机构驱动第一丝杆(23)旋转,使得所述第一丝杆螺母(24)沿x轴方向移动;
所述限位开关组件包括六个限位开关(5),六个所述限位开关(5)分别安装在所述手爪组件沿x轴方向、z轴方向运动的极限位置以及所述传感器组件沿x轴方向运动的极限位置;
所述行走机构用于使底板(3)沿y轴方向运动,并安装于底板(3)的底面;
所述控制***包括控制器,所述控制器与所述传感器组件、限位开关组件和动力机构电连接,所述控制器接收传感器组件和限位开关组件的传递的信号,并控制动力机构以控制机械手和传感器组件的动作和位置。
2.根据权利要求1所述的新型草莓采摘移动机器人,其特征在于,所述手臂组件包括第三丝杆(18)、第三丝杆螺母(12)、第二丝杆(14)、第二丝杆螺母(22)、T型块(46)、连轴节(47)、手臂支架(48)、第一立柱(44)、第二立柱(45)、支撑柱(49);
所述动力机构包括第二电机(16)、第三电机(17)、第四电机(21)、定轴轮系(13)和齿轮箱(15);
所述T型块(46)固定于支撑柱(49)的顶端,所述第一立柱(44)和第二立柱(45)分别位于T型块(46)的两侧,所述第一立柱(44)的底端固定于底板(3)上,第一立柱(44)的另一端穿过连轴节(47)后固定于T型块(46)上,所述第二立柱(45)的底端固定于底板(3)上,第二立柱(45)的另一端穿过手臂支架(48)后固定于T型块(46)上,所述手臂支架(48)的前端与连轴节(47)固定连接;
所述定轴轮系(13)设置在T型块(46)上,包括五个依次啮合的齿轮,五个齿轮排成一条直线,第一齿轮和第三齿轮分别固定套装在第三电机(17)和第四电机(21)的电机轴上;
所述第三丝杆(18)竖直设置在底板(3)的上方,所述第三丝杆(18)与第三丝杆螺母(12)螺纹连接,第五齿轮固定套装在所述第三丝杆(18)的一端,所述第三丝杆(18)的另一端可转动地安装在底板(3)上,第三丝杆螺母(12)与手臂支架(48)固定连接;
所述齿轮箱(15)安装在手臂支架(48)的后端,所述第二电机(16)的电机轴与齿轮箱(15)的输入端连接,所述齿轮箱(15)的输出端与第二丝杆(14)的一端连接,所述第二丝杆(14)的另一端可转动地安装于手臂支架(48)上,所述第二丝杆螺母(22)与所述第二丝杆(14)螺纹连接,所述机械手支座(11)的一端穿过连轴节(47),并与第二丝杆螺母(22)固定连接,所述机械手支座(11)可随着第二丝杆螺母(22)与底板(3)一起沿y轴方向运动。
3.根据权利要求1所述的新型草莓采摘移动机器人,其特征在于,所述动力机构还包括第一电机(4),所述第一电机(4)固定于机械手支座(11)上,所述第一电机(4)的电机轴与第一丝杆(23)的一端连接。
4.根据权利要求1所述的新型草莓采摘移动机器人,其特征在于,所述机械手支座(11)上设有LED灯。
5.根据权利要求1所述的新型草莓采摘移动机器人,其特征在于,所述行走机构包括分布于底板(3)底面的多个车轮(20),每两个位于底板(3)两侧的车轮(20)形成一排;所述动力机构还包括第五电机(30)和第六电机(31),所述第五电机(30)和第六电机(31)分别驱动底板(3)最前排的两个车轮(20)运动。
6.根据权利要求1所述的新型草莓采摘移动机器人,其特征在于,还包括电磁阀(19)、打气装置(1)和储气罐(2),所述电磁阀(19)包括电磁阀A、电磁阀B、电磁阀C和电磁阀D,所述储气罐(2)的一端与电磁阀A的通气孔连通,电磁阀A与第一气缸(25)的进气口连通,所述第一气缸(25)的出气口与电磁阀B连通,电磁阀B的通气孔与储气罐(2)连通;电磁阀C的通气孔与气管连通并与储气罐(2)保持通气,电磁阀C与第二气缸(32)的进气口连通,第二气缸(32)的出气口与电磁阀D连通,电磁阀D的通气孔与储气罐(2)保持通气;
所述动力机构还包括第七电机(35),所述打气装置(1)包括皮带轮(36)、折杆(37)和活塞杆(39);所述第七电机(35)的电机轴与中轴(40)连接,所述中轴(40)通过皮带与皮带轮(36)连接,所述皮带轮(36)与折杆(37)的一端固定连接,所述折杆(37)的另一端***活塞杆(39)下端的孔里,活塞杆(39)与储气罐(2)上的气动活塞(41)固定连接。
7.根据权利要求6所述的新型草莓采摘移动机器人,其特征在于,所述控制***包括一个ROBO主控制器、两个ROBO子控制器和一台计算机,所述计算机上装有草莓采摘程序,所述草莓采摘程序通过USB串口下载到三个ROBO控制器,三个ROBO控制器分别通过针状数据线互相连接,所述第一电机(4)、第二电机(16)、第三电机(17)、第四电机(21)分别连接ROBO主板的M1、M2、M3、M4输出端口;
六个限位开关(5)分别为第一~第六限位开关,第一限位开关和第二限位开关分别位于第三丝杆(18)的最底端和最顶端,第三限位开关和第四限位开关分别位于第二丝杆(14)的最前端和最后端,第五限位开关和第六限位开关分别位于第一丝杆(23)的最前端和最后端,第一~第六限位开关分别连接ROBO主板的数字输入口I5、I4、I3、I8、I6和I7,超声波传感器(6)和颜色传感器(7)分别连接ROBO主板的数字输入口I1和I2;第五电机(30)、第六电机(31)、第七电机(35)和LED灯分别连接第一ROBO子控制器上的EM1、EM2、EM3、EM4输出端口;电磁阀A、电磁阀B、电磁阀C和电磁阀D分别连接第二ROBO子控制器上的M1、M2、M3、M4输出端口。
8.一种新型草莓采摘移动机器人的控制方法,其特征在于,所述控制方法采用多线程编程,通过编写ROBO Pro主程序调用子程序,包括以下步骤:
步骤一:采摘机器人初始复位:主程序开始,第三电机(17)、第四电机(21)逆时针转动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,使得机械手手臂组件垂直运动到z轴最高处位置,第二限位开关触发,第三电机(17)、第四电机(21)停止,第三丝杆螺母(12)到达初始位置;然后第二电机(16)顺时针转动,用一个判断模块,查询第三限位开关的状态,对输入口I3进行设置,使得手臂组件运动到x轴最右端,第三限位开关触发,第二电机(16)停止,接着控制第二电机(16)逆时针转动,第二电机(16)停止,第二丝杆螺母(22)到达初始位置;然后控制第一电机(4)逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置,到指定的位置,当传感器组件运动到最前方,第五限位开关触发,第一电机(4)停止,传感器组件到达初始工作位置;
步骤二:完成初始准备工作:电磁阀A、电磁阀B、电磁阀C和电磁阀D断电,手爪组件保持第一手指(29-1)和第二手指(29-2)合拢,第七电机(35)启动,开始打气,第五电机(30)和第六电机(31)顺时针转动,车轮(20)滚动使底板(3)前进,进入草莓生长区;
步骤三:由上至下搜索草莓:启动第三电机(17)和第四电机(21)顺时针转动,机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波下”,通过超声波传感器(6)进行目标锁定,***颜色传感器面板Co,基于颜色传感器(7)进行颜色判断,实现草莓识别;颜色传感器(7)识别寻找到目标,则停止第三电机(17)和第四电机(21),运行子程序“颜色下”,未识别到则保持机械手手臂组件向下移动,用一个判断模块,查询第一限位开关的状态,对输入口I5进行设置,当第三丝杆螺母(12)向下移动到最底部时,压住第一限位开关,第三电机(17)和第四电机(21)停止;跳出子程序“超声波下”,子程序“颜色下”,进入主程序;
步骤四:机器人移动:启动第五电机(30)、第六电机(31)顺时针转动,车轮(20)滚动,进入未识别过的草莓生长区;
步骤五:由下至上搜索草莓:启动第三电机(17)和第四电机(21)逆时针转动,第三丝杆螺母(12)向上移动,使得机械手手臂组件垂直运动到草莓区,***超声波传感器面板U1,调用子程序“超声波上”,通过超声波传感器感(6)进行目标锁定,***颜色传感器面板Co,基于颜色传感器(7)进行颜色判断,实现草莓识别;颜色识别寻找到目标,则停止第三电机(17)和第四电机(21),运行子程序“颜色上”,未识别到则保持机械手手臂组件向上移动,用一个判断模块,查询第二限位开关的状态,对输入口I4进行设置,当第三丝杆螺母(12)向上移动到最顶部时,压住第二限位开关,第三电机(17)和第四电机(21)停止,完成一个循环的草莓搜寻;跳出子程序“超声波上”,子程序“颜色上”,进入主程序;
步骤六:重复步骤二至五,如此往复循环,直至采摘移动机器人驶出草莓生长区后结束;
所述子程序“超声波下”的具体步骤如下:
S1:创建与主程序相同的超声波传感器面板U1,第三电机(17)停止,超声波传感器(6)距离草莓小于3cm时,第二电机(16)顺时针启动,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器(6)与草莓的距离,若还是小于3cm,则第二电机(16)顺时针启动,直至距离大于3cm;
S2:第二电机(16)逆时针转动,手爪组件前进,判断超声波传感器(6)与草莓的距离是否为3cm~4cm之间,若否,则第二电机(16)逆时针转动,直至超声波传感器(6)与草莓的距离为3cm~4cm;
S3:第三电机(17)和第四电机(21)顺时针运行,机械手向下移动,结束;
所述子程序“颜色下”的具体步骤如下:
A1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000(红色)时,由子程序“颜色下”回到主程序;当颜色传感器测的数值<1000(红色)时,关闭电磁阀(19),停止第三电机(17)和第四电机(21);第一电机(4)顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机(4)停止,第一丝杆螺母(24)到达第一丝杆(23)的最后端,传感器组件停止工作;
A2:第三电机(17)和第四电机(21)顺时针启动,使机械手下降,到达草莓正前方后停止第三电机(17)和第四电机(21);
A3:第二电机(16)逆时针启动,手爪组件前进,使草莓处在机械手抓取范围以后停止第二电机(16);
A4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指(29-1)和第二手指(29-2)合拢抓取红草莓;
A5:第二电机(16)顺时针启动,使手爪组件后退,将红草莓的绿果柄拉出绷紧;
A6:电磁阀A开,电磁阀B关,剪刀(9)合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,剪刀(9)打开,重复循环两次,确保绿果柄被剪断;
A7:第二电机(16)顺时针启动,手爪组件后退到识别位置;
A8:电磁阀C关,电磁阀D开,第一手指(29-1)和第二手指(29-2)张开将红草莓果实放下后,关闭电磁阀D;
A9:第一电机(4)逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置,到指定的位置,第五限位开关触发,第一电机(4)停止,第一丝杆螺母(24)回到最前端,传感器组件到达工作位置;
所述子程序“超声波上”的具体步骤如下:
F1:创建与主程序相同的超声波传感器面板U1,第三电机(17)停止,超声波传感器(6)距离草莓小于3cm时,第二电机(16)顺时针启动,使手爪组件沿x轴右移,传感器组件后退,拉大传感器组件与草莓区之间的距离,继续校对超声波传感器(6)与草莓的距离,若还是小于3cm,则第二电机(16)顺时针启动,直至距离大于3cm;
F2:第二电机(16)逆时针转动,手爪组件前进,判断超声波传感器(6)与草莓的距离是否为3cm~4cm之间,若否,则第二电机(16)逆时针转动,直至超声波传感器(6)与草莓的距离为3cm~4cm;
F3:第三电机(17)和第四电机(21)逆时针运行,机械手向上移动,结束;
所述子程序“颜色上”的具体步骤如下:
B1:创建与主程序相同的颜色传感器面板Co,白天关闭LED灯,夜间打开LED灯,当颜色传感器测的数值>1000(红色)时,子程序交回到主程序;当颜色传感器测的数值<1000(红色)时,关闭电磁阀(19),停止第三电机(17)和第四电机(21);第一电机(4)顺时针旋转,用一个判断模块,查询第六限位开关的状态,对输入口I7进行设置,到指定的位置,第六限位开关触发,第一电机(4)停止,第一丝杆螺母(24)到达第一丝杆(23)的最后端,传感器组件停止工作;
B2:第三电机(17)和第四电机(21)顺时针启动,使机械手下降,到达草莓正前方后停止第三电机(17)和第四电机(21);
B3:第二电机(16)逆时针启动,手爪组件前进使草莓处在机械手抓取范围以后停止第二电机(16);
B4:电磁阀C开,电磁阀D关,使机械手在气体推动下第一手指(29-1)和第二手指(29-2)合拢抓取红草莓;
B5:第二电机(16)顺时针启动,使手爪组件后退,将红草莓的绿果柄拉出绷紧;
B6:电磁阀A开,电磁阀B关,剪刀(9)合拢剪去绿果柄,然后电磁阀A关,电磁阀B开,剪刀(9)打开,重复循环两次,确保绿果柄被剪断;
B7:第二电机(16)顺时针启动,手爪组件后退到识别位置;
B8:电磁阀C关,电磁阀D开,第一手指(29-1)和第二手指(29-2)张开将红草莓果实放下后,关闭电磁阀D;
B9:第一电机(4)逆时针转动,用一个判断模块,查询第五限位开关的状态,对输入口I6进行设置,到指定的位置,第五限位开关触发,第一电机(4)停止,第一丝杆螺母(24)回到最前端,传感器组件到达工作位置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711001360.3A CN107743768A (zh) | 2017-10-24 | 2017-10-24 | 一种新型草莓采摘移动机器人 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711001360.3A CN107743768A (zh) | 2017-10-24 | 2017-10-24 | 一种新型草莓采摘移动机器人 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107743768A true CN107743768A (zh) | 2018-03-02 |
Family
ID=61253152
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711001360.3A Pending CN107743768A (zh) | 2017-10-24 | 2017-10-24 | 一种新型草莓采摘移动机器人 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107743768A (zh) |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108370723A (zh) * | 2018-04-26 | 2018-08-07 | 梧州学院 | 一种苹果采摘机 |
CN108513803A (zh) * | 2018-06-14 | 2018-09-11 | 梧州学院 | 柑子采摘收集装置 |
CN108575320A (zh) * | 2018-05-23 | 2018-09-28 | 芮杰 | 草莓采摘机器人 |
CN108781762A (zh) * | 2018-04-10 | 2018-11-13 | 河海大学文天学院 | 一种高效草莓采摘机器人及采摘方法 |
CN109176490A (zh) * | 2018-10-05 | 2019-01-11 | 西北农林科技大学 | 一种采摘机器人控制*** |
CN109952862A (zh) * | 2019-05-06 | 2019-07-02 | 西南石油大学 | 一种草莓采摘剪 |
CN109964649A (zh) * | 2018-12-28 | 2019-07-05 | 江苏农林职业技术学院 | 一种蔬果采摘机装置及采摘方法 |
CN110122073A (zh) * | 2019-05-28 | 2019-08-16 | 江苏大学 | 一种基于机器视觉的草莓采摘机器人 |
CN110249785A (zh) * | 2019-07-23 | 2019-09-20 | 中国农业大学 | 一种多机械手串番茄采摘机器人及其采摘方法 |
CN111602511A (zh) * | 2020-06-29 | 2020-09-01 | 广西师范大学 | 一种半自动化桑叶采摘机 |
CN113383642A (zh) * | 2021-07-12 | 2021-09-14 | 扬州大学 | 一种瓜菜智能采摘机器人及其采摘方法 |
CN113575108A (zh) * | 2021-07-19 | 2021-11-02 | 杭州电子科技大学 | 一种蒜苔采收机及其蒜苔采收方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102577755A (zh) * | 2012-02-17 | 2012-07-18 | 中国农业大学 | 草莓采摘机器人精准采摘执行机构及垄作草莓采摘机器人 |
CN205196357U (zh) * | 2015-12-10 | 2016-05-04 | 大连交通大学 | 水果采摘机器人 |
CN106538146A (zh) * | 2016-10-27 | 2017-03-29 | 深圳市安思科电子科技有限公司 | 一种自动采摘机 |
CN106717546A (zh) * | 2016-11-22 | 2017-05-31 | 中国计量大学 | 番茄果实串收获机械手末端执行器及其方法 |
-
2017
- 2017-10-24 CN CN201711001360.3A patent/CN107743768A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102577755A (zh) * | 2012-02-17 | 2012-07-18 | 中国农业大学 | 草莓采摘机器人精准采摘执行机构及垄作草莓采摘机器人 |
CN205196357U (zh) * | 2015-12-10 | 2016-05-04 | 大连交通大学 | 水果采摘机器人 |
CN106538146A (zh) * | 2016-10-27 | 2017-03-29 | 深圳市安思科电子科技有限公司 | 一种自动采摘机 |
CN106717546A (zh) * | 2016-11-22 | 2017-05-31 | 中国计量大学 | 番茄果实串收获机械手末端执行器及其方法 |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108781762A (zh) * | 2018-04-10 | 2018-11-13 | 河海大学文天学院 | 一种高效草莓采摘机器人及采摘方法 |
CN108781762B (zh) * | 2018-04-10 | 2021-04-13 | 河海大学文天学院 | 一种高效草莓采摘机器人及采摘方法 |
CN108370723A (zh) * | 2018-04-26 | 2018-08-07 | 梧州学院 | 一种苹果采摘机 |
CN108575320B (zh) * | 2018-05-23 | 2020-08-25 | 芮杰 | 草莓采摘机器人 |
CN108575320A (zh) * | 2018-05-23 | 2018-09-28 | 芮杰 | 草莓采摘机器人 |
CN108513803A (zh) * | 2018-06-14 | 2018-09-11 | 梧州学院 | 柑子采摘收集装置 |
CN109176490A (zh) * | 2018-10-05 | 2019-01-11 | 西北农林科技大学 | 一种采摘机器人控制*** |
CN109964649A (zh) * | 2018-12-28 | 2019-07-05 | 江苏农林职业技术学院 | 一种蔬果采摘机装置及采摘方法 |
CN109964649B (zh) * | 2018-12-28 | 2022-06-10 | 江苏农林职业技术学院 | 一种蔬果采摘机装置及采摘方法 |
CN109952862A (zh) * | 2019-05-06 | 2019-07-02 | 西南石油大学 | 一种草莓采摘剪 |
CN110122073A (zh) * | 2019-05-28 | 2019-08-16 | 江苏大学 | 一种基于机器视觉的草莓采摘机器人 |
CN110249785A (zh) * | 2019-07-23 | 2019-09-20 | 中国农业大学 | 一种多机械手串番茄采摘机器人及其采摘方法 |
CN110249785B (zh) * | 2019-07-23 | 2020-07-14 | 中国农业大学 | 一种多机械手串番茄采摘机器人及其采摘方法 |
CN111602511A (zh) * | 2020-06-29 | 2020-09-01 | 广西师范大学 | 一种半自动化桑叶采摘机 |
CN111602511B (zh) * | 2020-06-29 | 2024-05-24 | 广西师范大学 | 一种半自动化桑叶采摘机 |
CN113383642A (zh) * | 2021-07-12 | 2021-09-14 | 扬州大学 | 一种瓜菜智能采摘机器人及其采摘方法 |
CN113383642B (zh) * | 2021-07-12 | 2022-08-05 | 扬州大学 | 一种瓜菜智能采摘方法 |
CN113575108A (zh) * | 2021-07-19 | 2021-11-02 | 杭州电子科技大学 | 一种蒜苔采收机及其蒜苔采收方法 |
CN113575108B (zh) * | 2021-07-19 | 2022-05-13 | 杭州电子科技大学 | 一种蒜苔采收机及其蒜苔采收方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107743768A (zh) | 一种新型草莓采摘移动机器人 | |
Ling et al. | Sensing and end-effector for a robotic tomato harvester | |
CN201504423U (zh) | 一种菠萝采摘机械手爪 | |
CN101878699B (zh) | 一种拧断式采摘手爪机构及其采摘方法 | |
CN105563514B (zh) | 一种机械手装置 | |
CN102227973B (zh) | 球状果实采摘机器人末端执行器 | |
CN110832991B (zh) | 一种基于图像识别的采摘机 | |
Gao et al. | Development and evaluation of a pneumatic finger-like end-effector for cherry tomato harvesting robot in greenhouse | |
CN113843810B (zh) | 基于机器视觉的类球形水果采摘机器人及其水果采摘方法 | |
CN205671007U (zh) | 可伸缩苹果采摘装置 | |
CN101601345B (zh) | 一种便携式自动夹切水果采摘机 | |
CN109156161A (zh) | 一种智能沃柑采摘机器人 | |
CN203896767U (zh) | 一种无损伤式果蔬采摘装置 | |
CN108848889A (zh) | 一种基于图像识别的叶菜收获机械装置及其控制方法 | |
CN111758397B (zh) | 一种基于视觉识别的花椒智能采摘装置 | |
CN106954426B (zh) | 一种基于近景深度传感器的机器人实时逼近定位采摘方法 | |
CN108401664A (zh) | 一种球形果蔬柔性采摘末端执行器 | |
CN113591293A (zh) | 用于采摘银杏花穗的末端执行器的采摘部分的设计方法 | |
CN110896734A (zh) | 一种水果采摘机器人及其采摘方法 | |
CN108901362A (zh) | 一种绿豆采摘机器人 | |
WO2024096988A1 (en) | End effector for harvesting plants | |
CN208924693U (zh) | 惯性采摘器 | |
Hu et al. | Design and experiment of a new citrus harvesting robot | |
CN216180608U (zh) | 抓取机器人及其目标抓取执行***及其末端执行器 | |
US8523254B2 (en) | Robot hand with connection unit that undergoes stretching deformation according to object shape and method for controlling robot hand |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20180302 |
|
RJ01 | Rejection of invention patent application after publication |