CN106338994B - 一种温室物流植保机器人控制***及方法 - Google Patents
一种温室物流植保机器人控制***及方法 Download PDFInfo
- Publication number
- CN106338994B CN106338994B CN201610887534.XA CN201610887534A CN106338994B CN 106338994 B CN106338994 B CN 106338994B CN 201610887534 A CN201610887534 A CN 201610887534A CN 106338994 B CN106338994 B CN 106338994B
- Authority
- CN
- China
- Prior art keywords
- robot
- parameter
- chip microcontroller
- unit
- greenhouse
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 238000001514 detection method Methods 0.000 claims abstract description 48
- 239000007921 spray Substances 0.000 claims abstract description 48
- 238000005507 spraying Methods 0.000 claims abstract description 41
- 238000012360 testing method Methods 0.000 claims abstract description 16
- 241000196324 Embryophyta Species 0.000 claims description 53
- 235000013311 vegetables Nutrition 0.000 claims description 17
- 235000012055 fruits and vegetables Nutrition 0.000 claims description 15
- 238000004364 calculation method Methods 0.000 claims description 12
- 239000000463 material Substances 0.000 claims description 10
- 239000003814 drug Substances 0.000 claims description 8
- 230000005540 biological transmission Effects 0.000 claims description 7
- 229940079593 drug Drugs 0.000 claims description 7
- 230000002093 peripheral effect Effects 0.000 claims description 7
- 238000013178 mathematical model Methods 0.000 claims description 6
- 238000004891 communication Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 claims description 5
- 239000003595 mist Substances 0.000 claims description 4
- 241000208340 Araliaceae Species 0.000 claims description 3
- 235000005035 Panax pseudoginseng ssp. pseudoginseng Nutrition 0.000 claims description 3
- 235000003140 Panax quinquefolius Nutrition 0.000 claims description 3
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 235000008434 ginseng Nutrition 0.000 claims description 3
- 230000012010 growth Effects 0.000 claims description 3
- 238000012856 packing Methods 0.000 claims description 3
- 230000008676 import Effects 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 4
- 238000011161 development Methods 0.000 description 3
- 208000037805 labour Diseases 0.000 description 2
- 238000013139 quantization Methods 0.000 description 2
- 241000607479 Yersinia pestis Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 201000010099 disease Diseases 0.000 description 1
- 208000037265 diseases, disorders, signs and symptoms Diseases 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000005611 electricity Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008635 plant growth Effects 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 230000009897 systematic effect Effects 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01G—HORTICULTURE; CULTIVATION OF VEGETABLES, FLOWERS, RICE, FRUIT, VINES, HOPS OR SEAWEED; FORESTRY; WATERING
- A01G25/00—Watering gardens, fields, sports grounds or the like
- A01G25/02—Watering arrangements located above the soil which make use of perforated pipe-lines or pipe-lines with dispensing fittings, e.g. for drip irrigation
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B19/00—Programme-control systems
- G05B19/02—Programme-control systems electric
- G05B19/04—Programme control other than numerical control, i.e. in sequence controllers or logic controllers
- G05B19/042—Programme control other than numerical control, i.e. in sequence controllers or logic controllers using digital processors
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0891—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Life Sciences & Earth Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Water Supply & Treatment (AREA)
- Environmental Sciences (AREA)
- Soil Sciences (AREA)
- Mechanical Engineering (AREA)
- Robotics (AREA)
- Catching Or Destruction (AREA)
Abstract
一种温室物流植保机器人控制***所采用的技术方案:包括作业参数配置***、检测***和控制***。所述的作业参数配置***,在服务器端生成不同作物种植模式在不同生长期适宜的物流植保机器人作业参数集;所述的检测***,通过传感器将检测数据反馈给单片机,构成一个闭环的控制***;所述的控制***,主要处理传感器以及手机发送来的数据信息,并通过单片机的控制完成喷雾作业或物流运输。本发明提供了一种温室物流植保机器人控制方法,实现远程配置喷雾模式或物流模式相应的作业参数,控制温室物流植保机器人完成喷雾作业或物流运输,并通过手机客户端的控制软件中的电子地图界面实时显示温室物流植保机器人的位置信息和当前工作情况。
Description
技术领域
本发明属于农业机械领域,具体涉及一种温室物流植保机器人控制***及方法,完成日光温室内基于精确定位的喷雾作业和物料运送,实现智能化、轻便化和自动化控制。
背景技术
我国是设施农业生产大国,面积和产量稳居世界首位,日光温室产业作为我国设施农业产业的主体,近年来已成为农业种植中效益最高的产业。它的出现打破了植物生长的地域和时空界限,为蔬菜淡季供应、节约能源、促进农业产业结构调整等做出了历史性贡献。随着日光温室的快速发展,温室内蔬菜的植保机械、运输车已经成为研制的热点。
一方面,目前设施蔬菜病虫害的防治主要通过喷洒药物完成,温室内传统的喷雾方式,如背负式喷雾机、电动喷雾机全程需人力参与,效率低,费时费力,同时温室喷雾作业对人体损害大。由于温室内种植作物种类繁多,且不同生长期作物的疏密程度不同,因此要实现喷雾作业的精量化和精准化施药需要对喷雾的作业模式进行有效控制。
另一方面,温室内的物流运送车发展比较缓慢,现有的物流小车,存在无法精确定位和自动行驶等问题,大多需人工控制其行进的方向、速度和停靠位置,浪费劳动力,物料运输已成为温室中最耗工费力的生产环节之一。
因此,针对温室喷雾和物流运输装备存在的机械化、自动化程度不高,受地形空间限制,效果差等问题,迫切需要发明一种温室物流植保机器人控制***及方法,以完成日光温室内基于精确定位的喷雾作业和物料运送,实现智能化、轻便化、精量化和自动化控制。
发明内容
为了解决日光温室内作物喷雾和物料运输中存在的问题,本发明提供了一种温室物流植保机器人控制***及方法,实现远程配置喷雾模式或物流模式相应的作业参数,控制温室物流植保机器人完成喷雾作业或物流运输,并通过手机客户端的控制软件中的电子地图界面实时显示温室物流植保机器人的位置信息和当前工作情况。
本发明一种温室物流植保机器人控制***所采用的技术方案:包括作业参数配置***、检测***和控制***。所述的作业参数配置***,在服务器端生成不同作物种植模式在不同生长期适宜的物流植保机器人作业参数集;所述的检测***,通过传感器将检测数据反馈给单片机,构成一个闭环的控制***;所述的控制***,主要处理传感器以及手机发送来的数据信息,并通过单片机的控制完成喷雾作业或物流运输。
所述的作业参数配置***包括喷雾模式参数配置和物流模式参数配置。所述的喷雾模式参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数。其中温室内获取的直观参数包括植株类型、疏密程度、叶片的大小、植株生长的高矮程度;物流植保机器人所需的作业参数集包括:机器人行进速度、喷雾流量、风机风转速、俯仰角度、俯仰速度、回转角度、回转速度。温室内植株类型分为密植绿叶蔬菜和离壁式果蔬种植类型两种,从而喷雾方式分为密植绿叶蔬菜种植喷雾方式和离壁式果蔬种植喷雾方式。
在密植绿叶蔬菜种植喷雾方式下,可调节机器人行进速度、流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现机器人前进的同时对密植绿叶蔬菜种植类型完成喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况。操作人员在安装有参数计算软件的PC机上输入参数后,PC机应用程序自动通过以下计算公式输出单片机可识别的参数。
Vrobot=∫1/Dxdx(10>x>0)
上式中,Vrobot为机器人的行进速度,单位为m/s;D为叶子的疏密程度,推荐值3~8;x为机器人前进加速度常数,单位为m/s2。
θH=((θ_R-θ_L)/2π+L/R)×KH
上式中,θH为机器人喷雾装置回转的角度,单位为rad;θ_R为连线与机器人前进方向的夹角,其中连线为右边行最远端的点与两行中间位置近端的点的连线,单位为度;θ_L为连线与机器人前进方向的夹角,其中连线为左边行最远端的点与两行中间位置近端的点的连线,单位为度;L为行长,单位为m;R为机器人到行近端的距离,单位为m;KH为修正参数,推荐1.1~1.3。
θV=((θ_up-θ_down)/2π+H/R)×KV
上式中,θV为机器人喷雾装置俯仰的角度,单位为rad;θ_up为连线与地面的夹角,其中连线为植株行最近端的植物冠层的点与机器人质心的连线,单位为度;θ_down为连线与地面的夹角,其中连线为植株行最远端的植物根部的点与机器人质心的连线,单位为度;H为机器人质心离地面的高度,单位为m;R为机器人到行近端的距离,单位为m;KV为修正参数,推荐0.8~1.2。
VH-rotation=D×θH/t
上式中,VH-rotation为回转速度,单位为rad/s;D叶子的疏密程度,推荐值2~8;θH为机器人喷雾装置回转的角度,单位为rad;t为时间常数,单位为s,推荐40~60。
VV-rotation=D×θV/t
上式中,VV-rotation为俯仰速度,单位为rad/s;D叶子的疏密程度,推荐值2~8;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,推荐40~60。
Q=S×V∫1/(t+1)dt×S
上式中,Q为流量的大小,单位为L/min;S为管道的截面积,单位为dm2;V为流速,单位为m/s,t为流量的系数,t从0.5开始增加;S为叶片的大小,单位为dm2,推荐0.3~1.5。
VWindow-scale=D×(2-θH×θV)/t2+Kw
上式中,VWind-scale为风力的大小,单位为m/s;D叶子的疏密程度,推荐值2~8;θH为机器人喷雾装置回转的角度,单位为rad;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,推荐40~60;Kw为修正参数,推荐2~4。
在离壁式果蔬种植喷雾方式下,控制机器人行进到达指定位置,控制流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现到达指定喷雾行完成离壁式果蔬种植类型的精准喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况。具体运行参数数学模型如下:
Vrobot={0,v,0,v...}
上式中,Vrobot为机器人的行进速度,单位为m/s;由于在离壁式果蔬种植类型需要进行行间定点喷雾,速度采用离散型数学模型,其中v为常量,范围0~2。
其他参数的计算和密植绿叶蔬菜种植喷雾方式下计算类似,不在重复。
物流模式的参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数,其中温室内获取的直观参数包括要搬运物料的重量、搬运位置;单片机可以识别的参数包括:机器人行进的速度、机器人停靠位置。温室物流植保机器人的停靠位置就是参数输入的搬运位置,直接在PC机软件中输入距离即可。
Vrobot=200/m+LDis/t
上式中,Vrobot为机器人的行进速度,单位为m/s;m为搬运物料的重量,单位为kg;LDis为搬运的距离,单位为m;t为估计搬运时间,单位为s,推荐30~240。
所述的检测***包括:位置和速度检测装置、流量检测、风力检测装置、俯仰角度和速度的检测装置、回转角度和速度的检测装置、剩余药量检测装置。所述的位置和速度检测装置采用现有的技术例如:雷达定位、GPS定位、激光测距定位、编码器测速、AGV智能小车的定位方式等,采用这些技术安装对应的模块配合单片机使用,实现在机器人在温室内的定位;所述的流量检测,在机器人药液管道上安装流量计,通过485总线的方式将监测到的流量信息传送至单片机;所述的风力检测装置是在风机的旋转轴上安装测速编码器,编码器将检测到的脉冲信息通过差分输入的方式传送至单片机,根据风机轴速大小的变化可得到风力的变化;所述的俯仰角度和速度的检测装置在俯仰轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的回转角度和速度的检测装置在回转轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的剩余药量检测装置在药液桶的下方安装一个压力传感器,压力传感器检测到药量的变化,把检测信息输入至A/D转换模块,A/D模块将转换完成的数字信号传送至单片机。
所述的控制***包括PC机参数计算软件、手机控制软件、单片机、电源以及其他***控制器。所述的PC机参数计算软件,对输入的参数进行计算从而得到单片机可识别的参数,同时将转换完成的参数按照一定的数据格式打包传送至互联网;所述的手机控制软件接收PC机传送至互联网的数据包,并通过路由器将数据包传送至单片机,再者可以接收单片机反馈回来的数据,将反馈的数据在手机控制软件里的电子地图模块进行处理,从而实时显示机器人当前的位置和作业情况,其中,温室电子地图的形成原理是将温室的地况(温室大小、种植行分布)参数编写为一个可修改TXT文本,根据当前温室设定对应文本参数,导入手机软件从而形成当前温室的电子地图;所述的单片机选用ARM3系列的高性能stm32单片机;所述电源优先选用24V、5V直流的电源对单片机、其他***控制器等进行供电;所述的其他***控制器包括电机驱动器、无线通讯模块、泵驱动器、风机驱动器等,其中无线通讯模块有无线路由器和wifi转串口子模块用于单片机和手机之间的数据传输。
本发明还提供了一种温室物流植保机器人控制装置的控制方法,包括如下步骤:
1)操作人员在PC机端输入温室内获取直观的参数,通过PC机开发的对应软件计算之后,将计算所得数据发向网络。
2)打开手机控制软件,接收PC机发送到网络上的数据;启动温室物流植保机器人,通过无线WIFI传输信号的方式,完成手机与单片机的连接。
3)根据温室当前需要,在手机上选择物流模式或喷雾模式,将得到的数据包发送至单片机。
4)单片机接收到手机控制软件发送来的信息,开始进行温室内的喷雾作业或者物流作业,同时所有传感器处于工作状态,将检测到的信息反馈至单片机,单片机根据反馈信息自动进行姿态的调整,形成闭环的控制***,实现自动控制;同时单片机将机器人位置信息和工作情况通过路由器发送至手机,并在手机上以电子地图的方式动态显示。
5)完成作业后,操作人员操作手机软件,控制机器人由工作位置运动到原始位置,关闭机器人电源。
本发明的有益效果:
1)本发明采用手机控制,自动化程度高,节省大量劳动力。
2)本发明采用自走式,无需人工直接参与喷雾,避免人药不能隔离造成的人生伤害。
3)本发明能在手机地图上实时反馈当前机器人的位置、工作状态信息,定位精度高,方便对其进行控制。
4)采用PC机进行参数的自动计算,参数修改方便、简单,提高计算效率。
5)本发明结构简单,操作方便,工作效率高,适合在温室进行喷雾和运输作业。
附图说明
图1是作业参数配置***原理图;
图2是检测***原理图;
图3是控制***原理图;
图4是手机软件的主界面和定位显示界面图;
图5是喷雾工作示意;
图6是温室物流植保机器人的工作流程图;
具体实施方式:
下面结合附图对本发明专利进行进一步描述。本发明所述一种温室物流植保机器人控制***及方法,控制装置包括:包括作业参数配置***、检测***和控制***。如图1所示,所述的作业参数配置***包括喷雾模式和物流模式的参数配置。喷雾模式参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数。其中温室内获取的直观参数包括植株类型、疏密程度、叶片的大小、植株生长的高矮程度;单片机可以识别的参数包括:机器人行进速度、流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度。温室内植株类型分为密植绿叶蔬菜和离壁式果蔬种植类型两种,从而喷雾方式分为密植绿叶蔬菜种植喷雾方式和离壁式果蔬种植喷雾方式。在密植绿叶蔬菜种植喷雾方式下,可调节机器人行进速度、流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现机器人前进的同时对密植绿叶蔬菜种植类型完成喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况。操作人员在安装有参数计算软件的PC机上输入参数后,PC机应用程序自动通过以下计算公式输出单片机可识别的参数。Vrobot=∫1/Dxdx(10>x>0)式中,Vrobot为机器人的行进速度,单位为m/s;D为叶子的疏密程度,推荐值3~8;x为机器人前进加速度常数,单位为m/s2。
θH=((θ_R-θ_L)/2π+L/R)×KH式中,θH为机器人喷雾装置回转的角度,单位为rad;θ_R为连线与机器人前进方向的夹角,其中连线为右边行最远端的点与两行中间位置近端的点的连线,单位为度;θ_L为连线与机器人前进方向的夹角,其中连线为左边行最远端的点与两行中间位置近端的点的连线,单位为度;L为行长,单位为m;R为机器人到行近端的距离,单位为m;KH为修正参数,推荐1.1~1.3。
θV=((θ_up-θ_down)/2π+H/R)×KV式中,θV为机器人喷雾装置俯仰的角度,单位为rad;θ_up为连线与地面的夹角,其中连线为植株行最近端的植物冠层的点与机器人质心的连线,单位为度;θ_down为连线与地面的夹角,其中连线为植株行最远端的植物根部的点与机器人质心的连线,单位为度;H为机器人质心离地面的高度,单位为m;R为机器人到行近端的距离,单位为m;KV为修正参数,推荐0.8~1.2。
VH-rotation=D×θH/t式中,VH-rotation为回转速度,单位为rad/s;D叶子的疏密程度,推荐值2~8;θH为机器人喷雾装置回转的角度,单位为rad;t为时间常数,单位为s,推荐40~60。VV-rotation=D×θV/t式中,VV-rotation为俯仰速度,单位为rad/s;D叶子的疏密程度,推荐值2~8;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,推荐40~60。Q=S×V∫1/(t+1)dt×S式中,Q为流量的大小,单位为L/min;S为管道的截面积,单位为dm2;V为流速,单位为m/s,t为流量的系数,t从0.5开始增加;S为叶片的大小,单位为dm2,推荐0.3~1.5。
VWindow-scale=D×(2-θH×θV)/t2+Kw式中,VWind-scale为风力的大小,单位为m/s;D叶子的疏密程度,推荐值2~8;θH为机器人喷雾装置回转的角度,单位为rad;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,推荐40~60;Kw为修正参数,推荐2~4。
在离壁式果蔬种植喷雾方式下,控制机器人行进到达指定位置,控制流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现到达指定喷雾行完成离壁式果蔬种植类型的精准喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况。具体运行参数数学模型如下:
Vrobot={0,v,0,v...}式中,Vrobot为机器人的行进速度,单位为m/s;由于在离壁式果蔬种植类型需要进行行间定点喷雾,速度采用离散型数学模型,其中v为常量,范围0~2。
其他参数的计算和密植绿叶蔬菜种植喷雾方式下计算类似,不在重复。
物流模式的参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数,其中温室内获取的直观参数包括要搬运物料的重量、搬运位置;单片机可以识别的参数包括:机器人行进的速度、机器人停靠位置。温室物流植保机器人的停靠位置就是参数输入的搬运位置,直接在PC机软件中输入距离即可。
Vrobot=200/m+LDis/t式中,Vrobot为机器人的行进速度,单位为m/s;m为搬运物料的重量,单位为kg;LDis为搬运的距离,单位为m;t为估计搬运时间,单位为s,推荐30~240。
如图2所示,所述的检测***包括:位置和速度检测装置、流量检测、风力检测装置、俯仰角度和速度的检测装置、回转角度和速度的检测装置、剩余药量检测装置。所述的位置和速度检测装置采用现有的技术例如:雷达定位、GPS定位、激光测距定位、编码器测速、AGV智能小车的定位方式等,采用这些技术安装对应的模块配合单片机使用,实现在机器人在温室内的定位;所述的流量检测,在机器人药液管道上安装流量计,通过485总线的方式将监测到的流量信息传送至单片机;所述的风力检测装置是在风机的旋转轴上安装测速编码器,编码器将检测到的脉冲信息通过差分输入的方式传送至单片机,根据风机轴速大小的变化可得到风力的变化;所述的俯仰角度和速度的检测装置在俯仰轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的回转角度和速度的检测装置在回转轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的剩余药量检测装置在药液桶的下方安装一个压力传感器,压力传感器检测到药量的变化,把检测信息输入至A/D转换模块,A/D模块将转换完成的数字信号传送至单片机。
如图3所示,所述的控制***包括PC机参数计算软件、手机控制软件、单片机、电源以及其他***控制器。所述的PC机参数计算软件,对输入的参数进行计算从而得到单片机可识别的参数,同时将转换完成的参数按照一定的数据格式打包传送至互联网;所述的手机控制软件接收PC机传送至互联网的数据包,并通过路由器将数据包传送至单片机,再者可以接收单片机反馈回来的数据,将反馈的数据在手机控制软件里的电子地图模块进行处理,从而实时显示机器人当前的位置和作业情况,其中,温室电子地图的形成原理是将温室的地况(温室大小、种植行分布)参数编写为一个可修改TXT文本,根据当前温室设定对应文本参数,导入手机软件从而形成当前温室的电子地图;所述的单片机选用ARM3系列的高性能stm32单片机;所述电源优先选用24V、5V直流的电源对单片机、其他***控制器等进行供电;所述的其他***控制器包括电机驱动器、无线通讯模块、泵驱动器、风机驱动器等,其中无线通讯模块有无线路由器和wifi转串口子模块用于单片机和手机之间的数据传输。
如图4所示,所述的手机软件的主界面和定位显示界面,手机主界面包括网络连接和模式选择两个部分,网络连接是wifi转串口子模块的IP与手机对应的无线连接,网络确认连接后,根据温室作业进行模式的选择,本发明提供了物流模式和喷雾模式的选择。定位界面包括当前温室地图和喷雾机当前位置信息两个部分。
如图5所示,所述的喷雾工作示意,在喷雾模式下喷雾装置进行回转和俯仰两个运动,底盘进行前后和启停运动,完成对喷雾对象的喷雾作业。
如图6所示,一种温室物流植保机器人控制装置的控制方法,包括如下步骤:
3)操作人员在PC机端输入温室内获取直观的参数,通过PC机开发的对应软件计算之后,将计算所得数据发向网络。
4)打开手机控制软件,接收PC机发送到网络上的数据;启动温室物流植保机器人,通过无线WIFI传输信号的方式,完成手机与单片机的连接。
3)根据温室当前需要,在手机上选择物流模式或喷雾模式,将得到的数据包发送至单片机。
4)单片机接收到手机控制软件发送来的信息,开始进行温室内的喷雾作业或者物流作业,同时所有传感器处于工作状态,将检测到的信息反馈至单片机,单片机根据反馈信息自动进行姿态的调整,形成闭环的控制***,实现自动控制;同时单片机将机器人位置信息和工作情况通过路由器发送至手机,并在手机上以电子地图的方式动态显示。
5)完成作业后,操作人员操作手机软件,控制机器人由工作位置运动到原始位置,关闭机器人电源。
Claims (2)
1.一种温室物流植保机器人控制***,其特征在于包括:作业参数配置***、检测***和控制***;所述的作业参数配置***,在服务器端生成不同作物种植模式在不同生长期适宜的物流植保机器人作业参数集;所述的检测***,通过传感器将检测数据反馈给单片机;所述的控制***,主要处理传感器以及手机发送来的数据信息,并通过单片机的控制完成喷雾作业或物流运输;
所述的作业参数配置***包括喷雾模式参数配置和物流模式参数配置;所述的喷雾模式参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数;其中温室内获取的直观参数包括植株类型、疏密程度、叶片的大小、植株生长的高矮程度;物流植保机器人所需的作业参数集包括:机器人行进速度、喷雾流量、风机风转速、俯仰角度、俯仰速度、回转角度、回转速度;温室内植株类型分为密植绿叶蔬菜和离壁式果蔬种植类型两种,从而喷雾方式分为密植绿叶蔬菜种植喷雾方式和离壁式果蔬种植喷雾方式;
在密植绿叶蔬菜种植喷雾方式下,可调节机器人行进速度、流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现机器人前进的同时对密植绿叶蔬菜种植类型完成喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况;操作人员在安装有参数计算软件的PC机上输入参数后,PC机应用程序自动通过以下计算公式输出单片机可识别的参数;
其中10>x>0;
上式中,Vrobot为机器人的行进速度,单位为m/s;D为叶子的疏密程度,D取值范围为3~8;x为机器人前进加速度常数,单位为m/s2;
上式中,θH为机器人喷雾装置回转的角度,单位为rad;θ_R为连线与机器人前进方向的夹角,其中连线为右边行最远端的点与两行中间位置近端的点的连线,单位为度;θ_L为连线与机器人前进方向的夹角,其中连线为左边行最远端的点与两行中间位置近端的点的连线,单位为度;L为行长,单位为m;R为机器人到行近端的距离,单位为m;KH为修正参数,KH取值范围为1.1~1.3;
上式中,θV为机器人喷雾装置俯仰的角度,单位为rad;θ_up为连线与地面的夹角,其中连线为植株行最近端的植物冠层的点与机器人质心的连线,单位为度;θ_down为连线与地面的夹角,其中连线为植株行最远端的植物根部的点与机器人质心的连线,单位为度;H为机器人质心离地面的高度,单位为m;R为机器人到行近端的距离,单位为m;KV为修正参数,KV取值范围为0.8~1.2;
上式中,VH-rotation为回转速度,单位为rad/s;D为叶子的疏密程度,D取值范围为2~8;θH为机器人喷雾装置回转的角度,单位为rad;t为时间常数,单位为s,t取值范围为40~60;
上式中,VV-rotation为俯仰速度,单位为rad/s;D为叶子的疏密程度,D取值范围为2~8;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,t取值范围为40~60;
上式中,Q为流量的大小,单位为L/min;s为管道的截面积,单位为dm2;V为流速,单位为m/s,t为流量的系数,t从0.5开始增加;S为叶片的大小,单位为dm2,S取值范围为0.3~1.5;
上式中,VWind-scale为风力的大小,单位为m/s;D为叶子的疏密程度,D取值范围为2~8;θH为机器人喷雾装置回转的角度,单位为rad;θV为机器人喷雾装置俯仰的角度,单位为rad;t为时间常数,单位为s,t取值范围为40~60;Kw为修正参数,Kw取值范围为2~4;
在离壁式果蔬种植喷雾方式下,控制机器人行进到达指定位置,控制流量大小、风力大小、俯仰角度、俯仰速度、回转角度、回转速度,实现到达指定喷雾行完成离壁式果蔬种植类型的精准喷雾作业,通过手机电子地图实时显示机器人的当前位置信息,并通过电子地图上喷雾行的颜色由绿色变红色显示喷雾完成情况;具体运行参数数学模型如下:
上式中,Vrobot为机器人的行进速度,单位为m/s;由于在离壁式果蔬种植类型需要进行行间定点喷雾,速度采用离散型数学模型,其中v为常量,范围0~2;
物流模式的参数配置:开发相关的温室作业参数计算PC机软件,操作人员在PC机上输入温室内获取的直观参数,通过PC机软件自动计算出单片机可以识别的参数,其中温室内获取的直观参数包括要搬运物料的重量、搬运位置;单片机可以识别的参数包括:机器人行进的速度、机器人停靠位置;温室物流植保机器人的停靠位置就是参数输入的搬运位置,直接在PC机软件中输入距离即可;
上式中,Vrobot为机器人的行进速度,单位为m/s;m为搬运物料的重量,单位为kg;LDis为搬运的距离,单位为m;t为估计搬运时间,单位为s,t取值范围为30~240;
所述的检测***包括:位置和速度检测装置、流量检测、风力检测装置、俯仰角度和速度的检测装置、回转角度和速度的检测装置、剩余药量检测装置;所述的位置和速度检测装置采用以下现有技术中的一种:雷达定位、GPS定位、激光测距定位、编码器测速或AGV智能小车的定位方式;采用这些技术安装对应的模块配合单片机使用,实现在机器人在温室内的定位;所述的流量检测,在机器人药液管道上安装流量计,通过485总线的方式将监测到的流量信息传送至单片机;所述的风力检测装置是在风机的旋转轴上安装测速编码器,编码器将检测到的脉冲信息通过差分输入的方式传送至单片机,根据风机轴速大小的变化可得到风力的变化;所述的俯仰角度和速度的检测装置在俯仰轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的回转角度和速度的检测装置在回转轴上安装霍尔角度传感器,并通过GPIO口与单片机相连接,将检测到的信息通过GPIO口传送至单片机;所述的剩余药量检测装置在药液桶的下方安装一个压力传感器,压力传感器检测到药量的变化,把检测信息输入至A/D转换模块,A/D模块将转换完成的数字信号传送至单片机;
所述的控制***包括PC机参数计算软件、手机控制软件、单片机、电源以及其他***控制器;所述的PC机参数计算软件,对输入的参数进行计算从而得到单片机可识别的参数,同时将转换完成的参数按照一定的数据格式打包传送至互联网;所述的手机控制软件接收PC机传送至互联网的数据包,并通过路由器将数据包传送至单片机,再者可以接收单片机反馈回来的数据,将反馈的数据在手机控制软件里的电子地图模块进行处理,从而实时显示机器人当前的位置和作业情况,其中,温室电子地图的形成原理是将温室的地况参数编写为一个可修改TXT文本,根据当前温室设定对应文本参数,导入手机软件从而形成当前温室的电子地图;所述的单片机选用ARM3系列的高性能stm32单片机;所述电源选用24V、5V直流的电源对单片机、其他***控制器进行供电;所述的其他***控制器包括电机驱动器、无线通讯模块、泵驱动器、风机驱动器,其中无线通讯模块有无线路由器和wifi转串口子模块用于单片机和手机之间的数据传输。
2.如权利要求1所述的一种温室物流植保机器人控制***的控制方法,其特征在于其控制过程如下:
1)操作人员在PC机端输入温室内获取直观的参数,通过PC机开发的对应软件计算之后,将计算所得数据发向网络;
2)打开手机控制软件,接收PC机发送到网络上的数据;启动温室物流植保机器人,通过无线WIFI传输信号的方式,完成手机与单片机的连接;
3)根据温室当前需要,在手机上选择物流模式或喷雾模式,将得到的数据包发送至单片机;
4)单片机接收到手机控制软件发送来的信息,开始进行温室内的喷雾作业或者物流作业,同时所有传感器处于工作状态,将检测到的信息反馈至单片机,单片机根据反馈信息自动进行姿态的调整,形成闭环的控制***,实现自动控制;同时单片机将机器人位置信息和工作情况通过路由器发送至手机,并在手机上以电子地图的方式动态显示;
5)完成作业后,操作人员操作手机软件,控制机器人由工作位置运动到原始位置,关闭机器人电源。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610887534.XA CN106338994B (zh) | 2016-10-11 | 2016-10-11 | 一种温室物流植保机器人控制***及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610887534.XA CN106338994B (zh) | 2016-10-11 | 2016-10-11 | 一种温室物流植保机器人控制***及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106338994A CN106338994A (zh) | 2017-01-18 |
CN106338994B true CN106338994B (zh) | 2019-06-07 |
Family
ID=57840159
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610887534.XA Active CN106338994B (zh) | 2016-10-11 | 2016-10-11 | 一种温室物流植保机器人控制***及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106338994B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107870624A (zh) * | 2017-11-30 | 2018-04-03 | 沈阳农业大学 | 一种日光温室自动导航多功能智能作业车 |
CN109644834A (zh) * | 2018-12-26 | 2019-04-19 | 丰疆智慧农业股份有限公司 | 多功能喷嘴喷淋作业车及其应用 |
CN109819958A (zh) * | 2019-02-21 | 2019-05-31 | 山东理工大学 | 一种只加水不加农药的高压电离风送式agv***植保车 |
CN110352837A (zh) * | 2019-08-01 | 2019-10-22 | 盐城工学院 | 一种智能灌溉装置 |
CN113412780B (zh) * | 2021-05-24 | 2022-07-22 | 江苏大学 | 一种基于物联网的智能雾化栽培控制***及方法 |
CN113534823B (zh) * | 2021-09-16 | 2021-12-14 | 季华实验室 | 种植机器人路径规划方法、装置、电子设备和存储介质 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4195322B2 (ja) * | 2003-03-24 | 2008-12-10 | 株式会社ショーシン | 農業用車輌 |
KR100590170B1 (ko) * | 2004-04-12 | 2006-06-19 | 한아에쎄스 주식회사 | 집중식 약제살포기 |
CN2852624Y (zh) * | 2005-09-29 | 2007-01-03 | *** | 多功能农用机 |
CN101622983A (zh) * | 2009-08-14 | 2010-01-13 | 潘虹 | 土壤害虫微波杀灭车 |
FR2963200B1 (fr) * | 2010-07-30 | 2012-08-10 | Eurl Buchet | Systeme et procede de controle d?une machine agricole d?epandage |
JP5939502B2 (ja) * | 2011-12-13 | 2016-06-22 | 井関農機株式会社 | 薬剤散布車 |
JP5880133B2 (ja) * | 2012-02-28 | 2016-03-08 | 井関農機株式会社 | 薬剤散布作業車 |
CN102599138B (zh) * | 2012-04-06 | 2013-05-29 | 山东农业大学 | 一种作业环境感知的喷杆喷雾机主动控制*** |
CN103927685A (zh) * | 2014-04-23 | 2014-07-16 | 广西力源宝科技有限公司 | 农(林)业智能施肥*** |
CN104020706B (zh) * | 2014-06-23 | 2017-06-13 | 华南农业大学 | 果园管道自动顺序喷雾***及控制方法 |
CN205250035U (zh) * | 2015-06-03 | 2016-05-25 | 祖元丁 | 一种变速箱前置的玉米去雄喷药多功能一体机 |
CN105360095B (zh) * | 2015-12-08 | 2017-11-10 | 山东农业大学 | 一种温室用单轨植保机器人及其控制方法 |
CN205233273U (zh) * | 2015-12-08 | 2016-05-18 | 山东农业大学 | 一种温室用单轨植保机器人 |
CN205311599U (zh) * | 2015-12-08 | 2016-06-15 | 山东农业大学 | 一种设施农业用精确定位的单轨物流车 |
CN105501863B (zh) * | 2015-12-08 | 2017-07-25 | 山东农业大学 | 一种基于温室内精确定位的单轨物流车及其控制方法 |
-
2016
- 2016-10-11 CN CN201610887534.XA patent/CN106338994B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN106338994A (zh) | 2017-01-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106338994B (zh) | 一种温室物流植保机器人控制***及方法 | |
CN205594695U (zh) | 一种基于物联网的农业智能应用*** | |
CN206833217U (zh) | 一种大田种植监控*** | |
CN204859395U (zh) | 大面积农业作业无人机 | |
US20080046130A1 (en) | Agricultural automation system with field robot | |
CN109566359B (zh) | 基于北斗卫星定位的浇花机器人*** | |
CN106406178A (zh) | 一种温室作物生长信息实时对等监测装置及监测方法 | |
CN103999841A (zh) | 一种自动对靶喷施*** | |
CN101716567B (zh) | 基于处方图控制的智能变量喷药机 | |
CN105557476B (zh) | 一种基于土壤湿度调节的智能高效喷灌***和方法 | |
CN103988824A (zh) | 一种基于双目视觉技术的自动对靶喷施*** | |
CN104881012A (zh) | 一种基于cps的智能农作物培养种植管理*** | |
CN101099446A (zh) | 基于计算机视觉的灌溉水车*** | |
CN112772385B (zh) | 全自动化的远程灌溉*** | |
CN203860304U (zh) | 一种自动对靶喷施*** | |
CN113057154A (zh) | 一种温室药液喷洒机器人 | |
CN204667158U (zh) | 一种基于cps的智能农作物培养种植管理*** | |
Pala et al. | Aeroponic greenhouse as an autonomous system using intelligent space for agriculture robotics | |
CN105766566B (zh) | 一种基于无线定位技术的园圃微灌方法及*** | |
CN109964905A (zh) | 基于果树识别定位的自走对靶施药机器人及其控制方法 | |
CN108271756A (zh) | 一种无人机农田喷药作业自动控制*** | |
CN106779414A (zh) | 设施农业远程监控与智能决策*** | |
CN109832246A (zh) | 一种基于北斗导航的植保无人机数据综合采集*** | |
CN205281296U (zh) | 一种植物生长环境监测控制*** | |
CN110432122A (zh) | 园林植被灌溉及园林水体一体化综合循环控制***及方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |