1.一种轮式移动水果采摘机器人,包括机械执行装置和控制系统,其特征是:
所述机械执行装置包括轮式智能移动平台、采摘机械臂(5)和欠驱动采摘机械手(2)和电动滑台(8);
所述轮式智能移动平台包括第一驱动轮总成(19)、第二驱动轮总成(20)、第一从动轮总成(23)、第二从动轮总成(24)、平台机架(21)、电机控制柜(15)、水果收集箱(16)以及侧面挡板(9),其中第一驱动轮总成(19)、第二驱动轮总成(20)、第一从动轮总成(23)、第二从动轮总成(24)与平台机架(21)之间采用螺栓联接,侧面挡板(9)用铆钉铆接平台机架(21)上,电机控制柜(15)固定在轮式智能移动平台的中部;水果收集箱(16)位于采摘机械臂(5)和电机控制柜(15)之间;
所述第一驱动轮总成(19)和第二驱动轮总成(20)均包括驱动轴(77)、轴承(78)、减速器(79)、直流伺服电机(80)、编码器(81)、第三轴承盖(82)、平键(83)、轴承座固定法兰(84)、轴承(85)、轴承座(86)、第一轴承盖(87)和轮毂联接法兰(76),第一从动轮总成(23)和第二从动轮总成(24)均包括轴、轴承、轴承座、轴承盖、轴承座固定法兰和轮毂联接法兰;
第一从动轮总成(23)和第二从动轮总成(24)分别包括的轴与驱动轴(77)不同;
所述采摘机械臂(5)固定在轮式智能移动平台前端的电动滑台(8)上,采摘机械臂(5)的结构包括大臂(26)、小臂(28)、伸缩臂、两个直流伺服舵机(25、27)、两个直流伺服电机(29、51)、水果下滑管道(4)和漏斗状缓冲节(30);
所述伸缩臂的结构包括伸缩臂连接架(31)、第一套筒(32)、第一深沟球轴承(33)、滑槽(34)、第二深沟球轴承(35)、第二套筒(36)、直线轴承(37)、机械手连接框(38)、第三深沟球轴承(39)、直线轴承(40)、滑杆(41)、第一圆形滑块(42)、第四深沟球轴承(43)、水果接收篮固定架(44)、第二圆形滑块(45)、双向丝杠(46)、第五深沟球轴承(47)、第二轴承盖(48)、第一联轴器(49)、电机固定法兰(50)和直流伺服电机(51);
所述电动滑台(8)包括直流伺服电机(52)、联轴器(53)、滑杆(54)、螺杆(55)、滑杆(56)、第一轴承座(57)、机械臂固定滑块(58)、第二轴承座(59)和电机固定架(60);
所述欠驱动采摘机械手(2)包括第一手指关节(61)、第一手指连杆(62)、第二手指关节(63)、手掌(64)、第二手指连杆(65)、连杆(66)、驱动杆(67)、第二联轴器(68)、下支撑杆(69)、下底盘(70)、直流伺服电机(71)、长连接杆(72)、上支撑杆(73)、中间法兰(74)和螺杆轴(75);手掌(64)与中间法兰(74)通过上支撑杆(73)进行联接;下底盘(70)与中间法兰(74)通过下支撑杆(69)进行联接,行程开关安装在下支撑杆(69)与中间法兰(74)的连接处;还包括安装在手掌(64)上的手指,两个手指平行对称布置;第二联轴器(68)将螺杆轴(75)与直流伺服电机轴联接在一起,使得工作时伺服电机转动,将螺杆轴(75)的转动则转化为驱动杆(67)的上下运动;
所述控制系统包括工控机(12)、8轴运动控制卡、数据采集卡、直流伺服电机、编码器、AHRS姿态方位参考系统(7)、单目摄像机组件(6)、双目摄像机(1)、工业级超声波传感器、力传感器、滑觉传感器、位置传感器、控制电路及电机控制柜。
2.根据权利要求1所述的一种轮式移动水果采摘机器人,其特征在于所述轮式智能移动平台后端左侧设有工控机(12),轮式智能移动平台后端右侧设有锂电池供电箱(13),给工控机(12)供电的蓄电池(17)和逆变器(18)位于工控机(12)和锂电池供电箱(13)中间,运动控制卡、数据采集卡分别插装在工控机(12)的PCI插槽内,双目摄像机(1)位于所述机械手连接框(38)的上侧,智能移动平台前端设有AHRS姿态方位参考系统(7)和单目摄像机组件(6)。
3.根据权利要求1所述的一种轮式移动水果采摘机器人,其特征在于所述欠驱动采摘机械手(2)、螺杆轴(75)和驱动杆(67)的材料为45号钢,第一手指关节(61)、第一手指连杆(62)、第二手指关节(63)、手掌(64)、第二手指连杆(65)、连杆(66)、下支撑杆(69)、下底盘(70)、长连接杆(72)、上支撑杆(73)和中间法兰(74)的材料均为尼龙。
4.根据权利要求1所述的一种轮式移动水果采摘机器人,其特征在于所述水果下滑管道(4)内部有多个漏斗状缓冲节,缓冲节由软橡胶材料制成。
5.根据权利要求1所述的一种轮式移动水果采摘机器人,其特征在于所述伸缩臂设置在采摘机械臂(5)末端关节处,伸缩臂还包括传动机构,传动机构由双向丝杠、圆形滑块、滑槽和滑杆组成;伸缩臂的外部由第一套筒(32)和第二套筒(36)用螺栓联接在一起,第一套筒(32)上侧开有滑槽,下侧开有腰型通孔,第二套筒(36)上下两侧均开有滑槽;第一圆形滑块(42)的上下两侧均装有一个第二深沟球轴承(35)和第四深沟球轴承(43),深沟球轴承卡在滑槽内,第一圆形滑块(42)中间有内螺纹孔;第二圆形滑块(45)上侧装有第一深沟球轴承(33),轴承卡在滑槽内,下侧与水果接收篮固定架(44)相连接,第二圆形滑块(45)中间设有内螺纹孔。
6.一种利用如权利要求1所述的一种轮式移动水果采摘机器人进行的水果采摘方法,其特征在于包括以下步骤:
水果采摘时,机械臂将采摘机械手送到果实附近;
采摘机械手上的位置传感器检测采摘机械手与果实的相对位置,当检测到果实已进入采摘机械手采摘范围时,直流伺服电机正向转动,采摘机械手开始抓取果实,压力传感器检测手指和果实之间的夹持力,并判断是否达到实验所给出的水果所能承受的力阈值;
若达到力阈值则采摘机械手停止运动,机械臂模拟人工采摘的上抬动作,完成果枝与果柄的分离;
接下来采摘机械臂伸缩关节回缩,采摘机械手的手指张开,将果实放入水果接收篮内,最后水果经水果下落管道和缓冲漏斗缓慢地滑落到水果收集箱内。
一种轮式移动水果采摘机器人及水果采摘方法\n技术领域\n[0001] 本发明涉及农业机器人技术领域,尤其是一种轮式移动水果采摘机器人及水果采摘方法。\n背景技术\n[0002] 水果是我国重要的经济作物,目前水果己成为继粮食、蔬菜之后的第三大农作物。\n水果产业在国民经济中具有重要地位。在食品消费结构中,随着主食消费比重的缓慢下降和副食品消费比重的上升,水果消费在整个食物消费中的比重也在逐步上升。自1978年中国实行农业结构调整政策以来,中国的水果产业得到快速发展,1997年一跃成为世界第一水果生产大国。水果产量从1978年的657万吨增长至1997年的5089.3万吨。到2006年,中国水果产量己达9599.2万吨,占世界水果产量的18.1%。除了具有总量优势外,中国许多水果的产量都居于世界前列,2006年中国苹果和梨产量为2605.9万吨和1198.6万吨,分别占世界产量的40.8%和61.4%,均居于世界第一位。柑橘产量达1591.9万吨,占世界产量的50.5%,也居于世界第一位。以上数据显示,苹果、柑橘、梨是我国水果的主要种植品种,无论是面积还是产量均一直排在前三位。因此,本发明的轮式移动水果采摘机器人主要采摘对象是针对以上几种水果。\n[0003] 进入21世纪以来,我国人口面临老龄化问题日趋严重,而且随着工业的迅速发展,农业劳动力逐渐向工业及其他行业转移,农业劳动力成本短缺严重且成本逐渐提高。水果采摘作业是水果生产中最耗时、最费力的环节,其收获又属于劳动密集型作业。以上种种因素给水果的收获带来了很大的困难,因此研究开发一种智能化的水果采摘装置势在必行。轮式移动水果采摘机器人不仅能够降低果农的劳动强度、降低果树采摘成本、提高采摘效率、保证果实及时收获、保证果品质量,而且对于促进农村经济发展,提高我国农业机械的现代化、智能化水平,加速农业现代化进程有着重大的推动作用。\n[0004] 相对于发达国家,我国在水果采摘机器人领域的研究起步较晚,大概始于20世纪\n90年代中期。目前国内有不少科研院校和研究所在进行采摘机器人和智能农业机械相关的研究。\n[0005] 中国发明专利ZL200310118301.6,发明名称为“一种移动机器人平台的驱动结构和驱动方法”。该专利介绍了一种用于轮式移动机器人平台的驱动结构,采用协调的驱动方式,它包括一个主动导向轮和两个独立的驱动轮。主动导向轮由小功率较高减速比的电机驱动,控制导向轮的转角;两个驱动后轮分别由两个低控制精度的扁平电机或轮毂电机驱动。平台驱动控制器按照本体电机协调算法把移动平台的运动要求分解为对三个电机的控制命令,然后控制导向轮的转动和两个后轮的差动以完成本体的运动。但该专利中没有描述详细的机械结构,而且也没有针对果园路面环境进行设计,因此该结构很难应用于水果的采摘。\n[0006] 中国发明专利ZL200410053041.3,发明名称为“智能移动机器人”。该专利介绍了一种智能移动机器人,包括车体平台和大脑两大部分,采用笔记本电脑作为机器人大脑。机器人大脑负责采集处理视觉信号,负责与外界对象通信和高层决策,下位机负责机器人执行机构的底层控制,并将获得的里程计信息、超声波传感器信息和储能状态信息上传给机器人大脑。该专利主要对控制系统组成进行了描述,但没有涉及到机器人的具体机械结构的详细描述。该专利使用的是普通的超声波传感器,虽然价格便宜,经济性好,但是普通的超声波传感器发射角大,探测范围大,但是其致命的缺点是方向性不好。而对于路面环境比较复杂的果园,使用普通的超声波传感器极易造成障碍物的误判,因此该平台并不适宜在果园环境中使用。\n[0007] 此外,南京农业大学对茄子收获的视觉系统和机械臂的避障进行了研究;上海交通大学对黄瓜采摘进行了研究;江苏大学对番茄收获机械手进行相应研究;西北农林科技大学对苹果采摘机器人手臂控制进行了研究;浙江大学对番茄收获机械手进行了运动学分析。从以上研究可以看出,在采摘机器人领域国内的科研人员做了大量的探索性工作,但是水果的采摘是个极其复杂的过程,目前仍有很多难题很难解决。比如以上研究大多是集中在智能移动平台、采摘机械臂、各种末端执行器、视觉传感器系统、果实的各种分割和识别算法等几个单方面的研究,由于工作量太大,研究难度高,所以几乎没有人将果实采摘的各个环节整合在一起深入研究。这就带来一些重要的问题,研究出来的成果比较零散,采摘机器人执行采摘任务仍然需要人的协助,只能实现半自动化,而且采摘的效率普遍比较低。这些问题在国内外都广泛存在。\n发明内容\n[0008] [0007] 本发明的目的在于提供一种轮式移动水果采摘机器人及水果采摘方法,本发明就是针对以上研究中存在的问题,将轮式智能移动平台、电动滑台、采摘机械臂、欠驱动采摘机械手、传感器系统整合在一起,将采摘机械臂的运动、欠驱动采摘机械手的抓取和轮式智能移动平台的行走等几个关键步骤整合在一起,真正实现了水果的智能化采摘。\n采摘的几个关键步骤的整合并非几个步骤的简单叠加,采摘机械臂的运动、欠驱动采摘机械手的抓取和轮式智能移动平台的行走是非常复杂的系统工程,不仅机械结构、软件和算法需要完美地融合在一起,而且整个系统运转要结合果园实际的采摘工作环境。要想取得良好的采摘效果,以上几个关键因素缺一不可。\n[0009] 本发明的技术方案是:\n[0010] 一种轮式移动水果采摘机器人,包括机械执行装置和控制系统,其特征是:\n[0011] 所述机械执行装置包括轮式智能移动平台、采摘机械臂5和欠驱动采摘机械手2和电动滑台8;\n[0012] 所述轮式智能移动平台包括第一驱动轮总成19、第二驱动轮总成20、第一从动轮总成23、第二从动轮总成24、平台机架21、电机控制柜15、水果收集箱16以及侧面挡板9,其中第一驱动轮总成19、第二驱动轮总成20、第一从动轮总成23、第二从动轮总成24与平台机架21之间采用螺栓联接,侧面挡板9用铆钉铆接平台机架21上,电机控制柜15固定在轮式智能移动平台的中部;水果收集箱16位于采摘机械臂5和电机控制柜15之间;\n[0013] 所述第一驱动轮总成19和第二驱动轮总成20分别包括各自的驱动轴77、轴承\n78、减速器79、直流伺服电机80、编码器81、轴承盖82、平键83、轴承座固定法兰84、轴承\n85、轴承座86、第一轴承盖87和轮毂联接法兰76,第一从动轮总成23和第二从动轮总成24分别包括各自的轴、轴承、轴承座、轴承盖、轴承座固定法兰和轮毂联接法兰;第一从动轮总成23和第二从动轮总成24分别包括的轴与驱动轴77不同;\n[0014] 所述采摘机械臂5固定在轮式智能移动平台前端的电动滑台8上,采摘机械臂5的结构包括大臂26、小臂28、伸缩臂、两个直流伺服舵机25、27、两个直流伺服电机29、51、水果下滑管道4和漏斗状缓冲节30;\n[0015] 所述伸缩臂的结构包括伸缩臂连接架31、第一套筒32、第一深沟球轴承33、滑槽\n34、第二深沟球轴承35、第二套筒36、直线轴承37、机械手连接框38、第三深沟球轴承39、直线轴承40、滑杆41、第一圆形滑块42、第四深沟球轴承43、水果接收篮固定架44、第二圆形滑块45、双向丝杠46、第五深沟球轴承47、第二轴承盖48、第一联轴器49、电机固定法兰50和直流伺服电机51;\n[0016] 所述电动滑台8包括直流伺服电机52、联轴器53、滑杆54、螺杆55、滑杆56、第一轴承座57、机械臂固定滑块58、第二轴承座59和电机固定架60;\n[0017] 所述欠驱动采摘机械手2包括第一手指关节61、第一手指连杆62、第二手指关节\n63、手掌64、第二手指连杆65、连杆66、驱动杆67、第二联轴器68、下支撑杆69、下底盘70、直流伺服电机71、长连接杆72、上支撑杆73、中间法兰74和螺杆轴75;手掌64与中间法兰\n74通过上支撑杆73进行联接;下底盘70与中间法兰74通过下支撑杆69进行联接,行程开关安装在下支撑杆69与中间法兰74的连接处;还包括安装在手掌64上的手指,两个手指平行对称布置;第二联轴器68将螺杆轴75与直流伺服电机轴联接在一起,使得工作时伺服电机转动,将螺杆轴75的转动则转化为驱动杆67的上下运动;\n[0018] 所述控制系统包括工控机12、8轴运动控制卡、数据采集卡、直流伺服电机、编码器、AHRS姿态方位参考系统7、单目摄像机组件6、双目摄像机1、工业级超声波传感器、力传感器、滑觉传感器、位置传感器、控制电路及电机控制柜。\n[0019] 所述轮式智能移动平台后端左侧设有工控机12,轮式智能移动平台后端右侧设有锂电池供电箱13,给工控机12供电的蓄电池17和逆变器18位于工控机12和锂电池供电箱13中间,运动控制卡、数据采集卡、分别插装在工控机12的PCI插槽内,双目摄像机1位于所述机械手连接框38的上侧,智能移动平台前端设有AHRS姿态方位参考系统7和单目摄像机组件6。\n[0020] 所述欠驱动采摘机械手2、螺杆轴75和驱动杆67的材料为45号钢,第一手指关节\n61、第一手指连杆62、第二手指关节63、手掌64、第二手指连杆65、连杆66、下支撑杆69、下底盘70、长连接杆72、上支撑杆73和中间法兰74的材料均为尼龙。\n[0021] 所述水果下滑管道4内部有多个漏斗状缓冲节,缓冲节由软橡胶材料制成。\n[0022] 所述伸缩臂设置在采摘机械臂5末端关节处,伸缩臂还包括传动机构,传动机构由双向丝杠、圆形滑块、滑槽和滑杆组成;伸缩臂的外部由第一套筒32和第二套筒36用螺栓联接在一起,第一套筒32上侧开有滑槽,下侧开有腰型通孔,第二套筒36上下两侧均开有滑槽;第一圆形滑块42的上下两侧分别装有一个第二深沟球轴承35和第四深沟球轴承\n43,深沟球轴承卡在滑槽内,第一圆形滑块42中间有内螺纹孔;第二圆形滑块45上侧装有第一深沟球轴承33,轴承卡在滑槽内,下侧与水果接收篮固定架44相连接,第二圆形滑块\n45中间设有内螺纹孔。\n[0023] 一种利用如权利要求1所述的一种轮式移动水果采摘机器人进行的水果采摘方法,其特征在于包括以下步骤:\n[0024] 水果采摘时,机械臂将采摘机械手送到果实附近;\n[0025] 采摘机械手上的位置传感器检测采摘机械手与果实的相对位置,当检测到果实已进入采摘机械手采摘范围时,直流伺服电机正向转动,采摘机械手开始抓取果实,压力传感器检测手指和果实之间的夹持力,并判断是否达到实验所给出的水果所能承受的力阈值;\n[0026] 若达到力阈值则采摘机械手停止运动,机械臂模拟人工采摘的上抬动作,完成果枝与果柄的分离;\n[0027] 接下来采摘机械臂伸缩关节回缩,采摘机械手的手指张开,将果实放入水果接收篮内,最后水果经水果下落管道和缓冲漏斗缓慢地滑落到水果收集箱内。\n[0028] 本发明的有益效果是:\n[0029] 本发明的优点如下:(1)欠驱动采摘机械手的螺杆轴和驱动杆的材料为45钢,其它部分材料均为尼龙,质量相比之下采摘机械手总重量降低约25%,重量降低会直接导致采摘机械臂系统的能耗随之降低约25%;(2)在机械臂下方设计水果接收篮和水果下落管道,当果实与果枝分离后直接放入水果接收篮,果实经下落管道直接滑落到水果收集箱内,这样机械臂工作时就会大大减小了机械臂多数关节的旋转角度,有些关节甚至无需动作,而采摘的效率却提高40%左右,机械臂动作部分能耗也随之降低约40%;(3)水果下滑管道内部有多个漏斗状缓冲节,缓冲节由软橡胶材料制成,能够降低果实下滑过程中的速度,从而减少果实在下滑过程中因碰撞或摩擦引起的损伤;(4)整个机械臂固定在电动滑台上,在工作时机械臂可以在电动滑台上左右滑动,这样设计的优点是智能移动平台在果园行间行走一次就可以采摘完其两侧的果实,整个智能移动平台行走的路程可以减半,行走部分的能耗可以降低35%-40%;(5)机械臂末端关节的伸缩臂传动机构由双向丝杠、圆形滑块、滑槽和滑杆等部分组成,当机械臂在采摘水果时机械手伸进树冠,同时水果接收篮退出树冠,这样既可以减少果实下滑管道与果枝碰撞而损伤果枝和果胎现象,也可以防止果实下滑管道被果枝阻挡造成果实滑落不畅的现象;(6)AHRS姿态方位参考系统,可输出智能移动平台的三轴的角速度、航向角度、加速度值。AHRS、工业级超声波传感器和双目立体视觉系统信息融合后大大提高了智能移动平台导航精度和避障能力;(7)轮式智能移动平台由直流伺服电机和减速机驱动,由编码器来反馈当前位置信息,能够实现精确的位置控制;(8)机械手的旋转关节模拟人工采摘的上台动作,实现果实与果枝的分离,这样设计就是为了避免在采摘机械手上增加复杂的果实分离装置,简化了欠驱动机械手的结构,降低了机械臂末端的重量。(9)采摘机械臂是根据果园实际使用环境自行研制的,虽然精度与工业机械臂相比还有距离,但是完全能够满足果实采摘的使用要求,而且整个机械臂的成本仅为同类工业机械臂的25%左右,大大降低了果农的使用成本。(10)轮式智能移动平台由两个驱动轮来驱动,由两个驱动轮的速度差和软件转向模型实现转向,这样就避免使用结构复杂且笨重的平行四边形转向机构,减轻了整个系统的重量,节约了成本。\n[0030] 本发明提高了水果采摘劳动生产率、降低了果农的劳动强度、降低了水果采摘成本、解决了劳动力短缺且成本过高这一问题,保证了果实及时采收、保证了果品质量。\n[0031] 本发明对于促进农村经济发展,提高我国农业的现代化、智能化水平,加快农业科技进步具有重要意义。\n附图说明\n[0032] 图1是本发明一个实施例的侧面结构示意图。\n[0033] 图2是本发明一个实施例的结构俯视图。\n[0034] 图3是本发明的驱动轮总成和从动轮总成与平台机架联接图。\n[0035] 图4是本发明一个实施例的结构左视图。。\n[0036] 图5是本发明的机械臂的结构图。\n[0037] 图6是本发明的机械臂末端关节剖视图。\n[0038] 图7是本发明的电动滑台结构图之一。\n[0039] 图8是本发明的电动滑台结构图之二。\n[0040] 图9是本发明的机械手的结构示意图。\n[0041] 图10是本发明的驱动系统装配图。\n[0042] 图11本发明的控制系统的主要功能模块构成示意图。\n[0043] 图1中,1为双目摄像机、2为欠驱动采摘机械手、3为水果接收篮、4为水果下滑管道、5为采摘机械臂、6为单目摄像机组件、7为AHRS姿态方位参考系统、8为电动滑台、9为侧面挡板、10为驱动轮、11为从动轮、12为工控机、13为锂电池供电箱、14为显示器、15为电机控制柜、16为水果收集箱。\n[0044] 图2中,17为蓄电池、18为逆变器。\n[0045] 图3中,19为驱动轮总成1、20为驱动轮总成2、21为平台机架、22为轮胎、23为从动轮总成1、24为从动轮总成2。\n[0046] 图5中,25为直流伺服舵机、26为机械臂大臂、27为直流伺服舵机、28为机械臂小臂、29为直流伺服电机、30为漏斗状缓冲节。\n[0047] 图6中, 31为伸缩臂连接架、32为第一套筒、33为深沟球轴承、34为滑槽、35为深沟球轴承、36为第二套筒、37为直线轴承、38为机械手连接框、39为深沟球轴承、40为直线轴承、41为滑杆、42为第一圆形滑块、43为深沟球轴承、44为水果接收篮固定架、45为第二圆形滑块、46为双向丝杠、47为深沟球轴承、48为轴承盖、49为联轴器、50为电机固定法兰、51为直流伺服电机。\n[0048] 图7中,52为直流伺服电机、53为联轴器、54为滑杆、55为螺杆、56为滑杆、57为轴承座、58为机械臂固定滑块、59为轴承座、60为电机固定架。\n[0049] 图8中,61为第一手指关节、62为第一手指连杆、63为第二手指关节、64为手掌、\n65为第二手指连杆、66为连杆、67为驱动杆、68为联轴器、69为下支撑杆、70为下底盘、71为直流伺服电机、72为长连接杆、73为上支撑杆、74为中间法兰、75为螺杆轴。\n[0050] 图9中,76为轮毂联接法兰、77为驱动轴、78为轴承、79为减速器、80为直流伺服电机、81为编码器、82为轴承盖、83为平键、84为轴承座固定法兰、85为轴承、86轴承座、87为轴承盖。\n具体实施方式\n[0051] 下面结合附图对本发明作进一步描述:\n[0052] 对照图1,本实施例的轮式移动水果采摘机器人主要由双目摄像机1、欠驱动采摘机械手2、水果接收篮3、水果下滑管道4、采摘机械臂5、单目摄像机组件6、AHRS姿态方位参考系统7、电动滑台8、侧面挡板9、驱动轮10、从动轮11、工控机12、锂电池供电箱13、显示器14、电机控制柜15、水果收集箱16等组成。\n[0053] 对照图1、图2、图3和图4,轮式智能移动平台包括第一驱动轮总成(19)、第二驱动轮总成(20)、第一从动轮总成(23)、第二从动轮总成(24)、平台机架(21)、及侧面挡板(9),其中第一驱动轮总成(19)、第二驱动轮总成(20)和第一从动轮总成(23)、第二从动轮总成(24)与平台机架(21)之间采用螺栓联接,侧面挡板(9)用铆钉铆接平台机架(21)上,电机控制柜(15)固定在轮式智能移动平台的中部;水果收集箱(16)位于采摘机械臂(5)和电机控制柜(15)之间;\n[0054] 对照图5,采摘机械臂(5)固定在轮式智能移动平台前端的电动滑台(8)上,采摘机械臂的结构包括大臂(26)、小臂(28)、伸缩臂、两个直流伺服舵机(25、27),两个直流伺服电机(29、51),水果下滑管道(4)、漏斗状缓冲节(30)。\n[0055] 对照图6,伸缩臂的结构包括伸缩臂连接架31、第一套筒32、第一深沟球轴承33、滑槽34、第二深沟球轴承35、第二套筒36、直线轴承37、机械手连接框38、第三深沟球轴承\n39、直线轴承40、滑杆41、圆形滑块42、第四深沟球轴承43、水果接收篮固定架44、圆形滑块45、双向丝杠46、第五深沟球轴承47、第二轴承盖48、第一联轴器49、电机固定法兰50、直流伺服电机51。\n[0056] 对照图7,电动滑台8包括直流伺服电机52、联轴器53、滑杆54、螺杆55、滑杆56、第一轴承座57、机械臂固定滑块58、第二轴承座59、电机固定架60。\n[0057] 对照图8,欠驱动采摘机械手2包括第一手指关节61、第一手指连杆62、第二手指关节63、手掌64、第二手指连杆65、连杆66、驱动杆67、第二联轴器68、下支撑杆69、下底盘\n70、直流伺服电机71、长连接杆72、上支撑杆73、中间法兰74、螺杆轴75。手掌64与中间法兰74通过上支撑杆73进行联接;下底盘70与中间法兰74通过下支撑杆69进行联接,行程开关安装在下支撑杆69与中间法兰74的连接处。手指安装在手掌64上,两个手指平行对称布置。第二联轴器68将螺杆轴75与直流伺服电机轴联接在一起,工作时伺服电机转动,将螺杆轴75的转动则转化为驱动杆67的上下运动。\n[0058] 对照图9,第一驱动轮总成19和第二驱动轮总成20包括、驱动轴77、轴承78、减速器79、直流伺服电机80、编码器81、轴承盖82、平键83、轴承座固定法兰84、轴承85、轴承座\n86、第一轴承盖87和轮毂联接法兰76,从动轮总成23和从动轮总成24包括轴、轴承、轴承座、轴承盖、轴承座固定法兰和轮毂联接法兰;\n[0059] 轮式移动水果采摘机器人的控制系统包括工控机、8轴运动控制卡、数据采集卡、直流伺服电机、编码器、AHRS姿态方位参考系统、单目摄像机组件、双目摄像机、工业级超声波传感器、力传感器、滑觉传感器、位置传感器、控制电路及电机控制柜等。\n[0060] 欠驱动采摘机械手2通过机械手连接框38与机械臂的伸缩臂相连,水果接收篮3通过其固定架44与圆形滑块45下侧的螺栓相联接,果实接收篮上的水果下滑管道内有多个软橡胶材料的漏斗状缓冲节30,在水果下滑时缓冲节30可以降低水果下滑的速度,从而降低果实下滑过程中因碰撞和摩擦造成的损伤。整个采摘机械臂5固定在智能移动平台的前端的电动滑台8上,在工作时机械臂5可以在电动滑台8上左右滑动。 \n[0061] 工控机12位于智能移动平台后端左侧,锂电池供电箱13位于智能移动平台后端右侧,给工控机12供电的蓄电池17和逆变器18位于工控机和锂电池供电箱中间,运动控制卡、数据采集卡、分别插装在工控机的PCI插槽内,双目摄像机1位于机械手连接框38的上侧,AHRS姿态方位参考系统)和单目摄像机组件6位于智能移动平台前端。\n[0062] 机械臂末端关节的伸缩臂传动机构由双向丝杠、圆形滑块、滑槽和滑杆组成,伸缩臂的外部由第一套筒32、第二套筒36用螺栓联接在一起,第一套筒32上侧开有滑槽,下侧开有腰型通孔,第二套筒36上下两侧均开有滑槽。圆形滑块42的上下两侧装有第二深沟球轴承35、第四深沟球轴承43,轴承卡在滑槽内,圆形滑块42中间有内螺纹孔,圆形滑块45上侧装有第一深沟球轴承33,轴承卡在滑槽内,下侧与水果接收篮固定架44相连接,圆形滑块45中间也有内螺纹孔,直流伺服电机51转动使双向丝杠上的两个圆形滑块在滑槽内同时往里缩进或同时往外伸出运动。\n[0063] 本发明的工作原理和工作过程如下:\n[0064] 采摘机器人工作时,单目摄像机组件6检测路面导航信息,AHRS姿态方位参考系统7检测智能移动平台的航向角度、加速度值,编码器反馈智能移动平台的移动速度和移动距离信息。双目摄像机1检测待采摘果树的位置,当检测到视野范围内有果树时,工控机\n12向8轴运动控制卡发送轮式智能移动平台停止前进指令。双目摄像机1用来采集果树、果实的图像信息以及采摘机械臂采摘路径中的障碍物图像信息,接下来主控制器工控机对成熟果实图像及障碍物图像进行识别,并且解算出果实相对机械臂基坐标的空间位置坐标,获取水果抓取所需位姿信息,然后工控机13对采摘路径进行规划,并向采摘机械臂5的控制器(8轴运动控制卡)发送果实采摘指令。当采摘机械手2被机械臂5送到待摘果实附近时,采摘机械手2上的位置传感器对采摘机械手与苹果的相对位置进行检测,当检测到果实已进入采摘机械手采摘范围时,直流伺服电机71正向转动,采摘机械手2开始抓取果实,压力传感器检测手指和果实之间的夹持力,并判断是否达到实验所给出的水果所能承受的力阈值。若达到力阈值则直流伺服电机71停止转动,机械臂模拟人工采摘的上抬动作,完成果枝与果柄的分离。接下来采摘机械臂伸缩关节回缩,采摘机械手的手指张开,将果实放入水果接收篮3内,最后水果经水果下落管道4和漏斗缓冲节30缓慢地滑落到水果收集箱\n16内。\n[0065] 重复执行以上过程,直到采摘范围里的水果全部采摘完毕,移动平台继续前进,并重复以上行走和果实采摘过程。如果前进过程中单目摄像机组件6和工业级超声波传感器检测到智能移动平台前进方向上有障碍物,工控机12就会将单目摄像机组件6检测的障碍物大小信息、超声波传感器与单目摄像机组件6检测的采摘机器人距离障碍物的深度信息、AHRS姿态方位参考系统7检测到的智能移动平台的航向角度以及路面的环境信息进行综合处理计算。如果计算结果显示采摘机器人可以避障,则系统立刻启动避障程序,如果计算结果显示不能绕过障碍物,采摘机器人就立刻停止在原地并发出警报。当单目摄像机组件6检测到路面果树行特征丢失,即采摘机器人到达地头,立刻启动转弯程序,当再次检测到果树行特征时,采摘机器人继续跟踪行特征,并重复以上的水果采摘过程。\n[0066] 本世纪以来,我国人口老龄化问题日趋严重,而且随着工业的迅速发展,农业劳动力逐渐向工业及其他行业转移,农业劳动力短缺日趋严重且成本不断提高。水果的采摘是水果生产中最费力且耗时的环节之一,而且水果的采摘又属于劳动密集型作业。以上多种因素给水果的收获带来了很大的困难,因此研究开发一种智能化的水果采摘装置势在必行。本发明就是为了解决以上难题,本发明对降低果农的劳动强度、降低果树采摘成本、提高采摘效率、保证果实及时收获、保证果品质量具有重要意义,而且对于促进农村经济发展,提高我国农业机械的现代化、智能化水平,加速农业现代化进程有着重大的推动作用。\n[0067] 上面所述的实施例仅仅是对本发明的优选实施方式进行描述,并非对本发明的构思和范围进行限定,在不脱离本发明设计构思前提下,本领域中普通工程技术人员对本发明的技术方案做出的各种变型和改进,均应落入本发明的保护范围,本发明请求保护的技术内容已经全部记载在权利要求书中。
法律信息
- 2018-03-13
未缴年费专利权终止
IPC(主分类): A01D 46/00
专利号: ZL 201110021812.0
申请日: 2011.01.19
授权公告日: 2013.05.29
- 2013-05-29
- 2013-04-24
著录事项变更
申请人由南京农业大学变更为南京农业大学
地址由210095 江苏省南京市玄武区卫岗1号变更为211225 江苏省南京市溧水区白马镇国家农业科技园南京农业大学基地
- 2011-08-31
实质审查的生效
IPC(主分类): A01D 46/00
专利申请号: 201110021812.0
申请日: 2011.01.19
- 2011-07-20
引用专利(该专利引用了哪些专利)
序号 | 公开(公告)号 | 公开(公告)日 | 申请日 | 专利名称 | 申请人 |
1
| |
2008-12-17
|
2008-07-02
| | |
2
| |
2009-04-01
|
2008-10-10
| | |
3
| | 暂无 |
1974-06-07
| | |
被引用专利(该专利被哪些专利引用)
序号 | 公开(公告)号 | 公开(公告)日 | 申请日 | 专利名称 | 申请人 | 1 | | 2016-01-21 | 2016-01-21 | | |