CN106276113A - 一种半结构化日光温室用智能移动平台及其控制方法 - Google Patents

一种半结构化日光温室用智能移动平台及其控制方法 Download PDF

Info

Publication number
CN106276113A
CN106276113A CN201610886882.5A CN201610886882A CN106276113A CN 106276113 A CN106276113 A CN 106276113A CN 201610886882 A CN201610886882 A CN 201610886882A CN 106276113 A CN106276113 A CN 106276113A
Authority
CN
China
Prior art keywords
mobile platform
platform
controller
module
distance
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.)
Granted
Application number
CN201610886882.5A
Other languages
English (en)
Other versions
CN106276113B (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.)
Shandong Agricultural University
Original Assignee
Shandong 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 Shandong Agricultural University filed Critical Shandong Agricultural University
Priority to CN201610886882.5A priority Critical patent/CN106276113B/zh
Publication of CN106276113A publication Critical patent/CN106276113A/zh
Application granted granted Critical
Publication of CN106276113B publication Critical patent/CN106276113B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G35/00Mechanical conveyors not otherwise provided for
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G43/00Control devices, e.g. for safety, warning or fault-correcting
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B65CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
    • B65GTRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
    • B65G2203/00Indexing code relating to control or detection of the articles or the load carriers during conveying
    • B65G2203/02Control or detection
    • B65G2203/0266Control or detection relating to the load carrier(s)

Abstract

本发明提供了一种半结构化日光温室用智能移动平台及其控制方法所采用的技术方案包括:底盘、行走装置、转弯导向装置、升降装置、智能控制模块和半结构化温室路面。本发明采用了后轮差速驱动,前轮万向轮转向,结合低成本的温室半结构化结构,节约了轨道铺设成本,最大程度的实现了温室内的无轨道自主运动的工作模式进行作业,提高劳动效率,省时、省力、易操作。本发明可配套使用多种农用机具和自动运输物料及工作人员,并具备远程无线控制的升降功能,能够实现在温室内集内灵活地移动实现物流运输并具有升降功能于一体的智能化移动平台,用于施药、采摘、作物整理等作业,自动化程度高、作业效率高、功能全面、灵活度高、节省劳动力。

Description

一种半结构化日光温室用智能移动平台及其控制方法
技术领域
本发明涉及一种设施农业机械,尤其涉及一种半结构化日光温室用智能移动平台及其控制方法,在温室内集内灵活地移动实现物流运输并具有升降功能于一体的智能化移动平台,用于施药、采摘、作物整理等操控自动化作业。
背景技术
近几年,随着农业产业结构的不断调整,日光温室在我国农村迅速发展。但是,日光温室内的各项农事作业,基本上都是手工操作,劳动强度大,工作效率低,因而经济效益仍处于低水平状态。日光温室灌溉、施肥、施药多采用传统的沟灌、漫灌,需水量大,劳动强度大,养分流失严重,对作物需水量难以有效控制。同时,也给温室内环境带来危害,尤其是温室内湿度大,温度高,对工作人员身体会造成损害,工作效率低。
温室内现有移动平台仅能实现一些简单的直线或轨道化运动,因此其可以进行的温室内作业非常有限。为了实现灵活的温室内的灵活移动,有些移动平台需要投入高成本的传感器,例如激光雷达或机器视觉,这样非常限制了普通日光温室的大面积应用。
但温室是一个种植模式相对固定的生成场所,迫切需要发明一种针对现有温室改造要求不高,投入成本低,并且能在温室内集内灵活地移动实现物流运输并具有升降功能于一体的智能化移动平台,用于施药、采摘、作物整理等操控自动化作业。这对温室的轻简化、自动化工作的推进有非常重要的实际意义。
发明内容
本发明针对现有技术存在的不足,提供了一种半结构化日光温室用智能移动平台及其控制方法,能够实现在温室内集内灵活地移动实现物流运输并具有升降功能于一体的智能化移动平台,用于施药、采摘、作物整理等操控自动化作业。
本发明一种半结构化日光温室用智能移动平台所采用的技术方案包括:底盘、行走装置、转弯导向装置、升降装置、智能控制模块和半结构化温室路面。
所述底盘用于固定和承载其他装置与模块,形成移动平台机械结构的基本框架;
所述行走装置,包括左右两个万向前轮总成和左右两个驱动后轮总成。所述左右两个万向前轮总成分别固定在底盘前端横梁两侧;所述左右两个驱动后轮总成包括左右两个驱动电机和左右两个后轮,左右两个驱动电机分别固定于底盘后端的T形架上左右两侧,驱动电机输出轴固定于后轮轮毂上,实现两后轮的差速驱动。
所述转弯导向装置,包括导向电动推杆,轴承,弹簧,转向轴,导向杆。所述导向电动推杆共有两个,分别位于底盘前后两端中央处的底面,通过螺栓与导向杆固联;所述轴承共有四个,两两一组,分别位于两个导向杆的下端,每个导向杆底端的两个轴承分别成水平和竖直安置;所述弹簧位于导向杆与导向电动推杆之间;所述转向轴用于导向杆与导向电动推杆以及轴承与导向杆的连接与固定;所述导向杆,用来连接导向电动推杆与轴承。
所述升降装置,包括支撑架、连接杆、升降台、升降轴、升降电动推杆、底座。所述支撑架用于链接底盘和升降台;所述连接杆用于支撑架内侧的固定,并与电动推杆连接;所述升降台位于支撑架的上端;所述升降轴位于升降台和底盘的槽钢内;所述的升降电动推杆固定于底座上,与连接杆连接;所述底座位于底盘底板的最前端中央处。
所述智能控制模块,包括控制箱、控制器、驱动轮电机驱动器、激光测距模块、超声波测距模块、WIFI模块、无线路由器、平板电脑、急停按钮和蓄电池。所述控制箱固定于底盘底板上,用于布置控制器、驱动轮电机驱动器、电动推杆驱动器、WIFI模块、急停按钮和蓄电池;所述的控制器优先选用STM32单片机系统,所述的导向电动推杆和升降电动推杆分别与控制器电气连接,实现电动推杆的伸缩与停止控制;所述的驱动轮电机驱动器的输入端与控制器电气连接,输出端分别与左右两个驱动电机电气连接,用于分别驱动后轮正转、反转和停止;所述的激光测距模块安装于底盘最前端,与控制器进行电气连接;所述超声波测距模块设有四个,分别固定于底盘的两侧的前后边沿上,与控制器进行电气连接。所述激光测距模块和超声波测距模块用于监测探测头与反射面的距离;所述无线路由器安装于日光温室的后墙上;所述WIFI模块串接到控制器,与无线路由器进行通讯,实现与平板电脑的信号收发功能;所述平板电脑用于对移动平台进行远程无线智能操控;所述蓄电池用于给移动平台提供电能。所述急停按钮位于底盘后端右上角,与蓄电池进行电气连接,发生意外情况时工作人员可以按下急停按钮,立刻切断移动平台电源,停止任何作业。
所述半结构化温室路面,包括过道,过道台沿,种植槽,垄间路面,地面凹槽。所述过道为铺设在温室后墙或前坡面的一条的平直铺装路面,用于移动平台沿温室东西走向的行进;所述过道台沿为过道离开种植区一侧的台沿,台沿高度一般不低于20cm;所述种植槽为种植作物区,一般为一行或两行作物种植区域,其边缘有限选用砖混结构包围,种植槽边缘一般不低于20cm;所述垄间路面位于两种植槽之间的一条平直铺装或非铺装路面,用于移动平台沿温室南北走向的行内行进;所述地面凹槽,位于过道与垄间路面的T形路口处,每个T形路口处各有一个地面凹槽,在进入行间转弯时,起到限制移动平台运动轨迹的作用。
本发明一种半结构化日光温室用智能移动平台的控制方法:
(1)移动平台启动、移动与关停:平板电脑的启动指令经过无线信号发送到移动平台的WiFi模块,控制器处理WiFi信号,并分析操作命令,形成移动轨迹规划,使移动平台从温室起始点开始运动。启动后,超声波测距模块和激光测距模块开始工作,并将信息反馈给控制器,控制器计算当前位置并与温室电子地图比较定位后,形成移动平台在温室内的定位信息,并将该信息通过WiFi模块传送给平板电脑,标示当前移动平台在电子地图中的位置。当控制器接受到关停命令时,控制器规划移动轨迹,使移动平台从当前位置运动至温室起始点。
(2)移动平台的直线运动控制:分为在过道和垄间路面的两种直线运动。
(A)在过道上的直线行走:一方面,远种植区侧的前后两个超声波测距模块开始实时探测车身与过道台沿的距离;当移动平台前超声波测距模块测量的距离大于后超声波测距模块测量的距离时,控制器减小远种植区侧驱动后轮的速度,增大近种植区侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离小于后超声波测距模块测量的距离时,控制器增大远种植区侧驱动后轮的速度,减小近种植区侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离等于后超声波测距模块测量的距离时,不单独改变驱动后轮的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶。另一方面,激光测距模块开始测量车身到前方反射面的距离,同时近种植区侧的前后两个超声波测距模块开始实时探测车身与种植槽距离的变化,来确定移动平台行驶过的垄间路面和种植槽的数目,将上述两种信息与电子地图上的位置信息融合确定移动平台在温室过道中更准确的当前位置信息。
(B)在垄间路面上的直线行走:一方面,使用与(A)中移动平台同侧的前后两个超声波测距模块开始实时探测车身与种植槽的距离;当移动平台前超声波测距模块测量的距离大于后超声波测距模块测量的距离时,控制器减小该超声波测距模块所在侧驱动后轮的速度,增大另一侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离小于后超声波测距模块测量的距离时,控制器增大该超声波测距模块所在侧驱动后轮的速度,减小另一侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离等于后超声波测距模块测量的距离时,不单独改变驱动后轮的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶。另一方面,激光测距模块开始测量车身到前方反射面的距离,将该距离信息发送给控制器计算出移动平台的当前位置信息,并将信息通过WiFi模块反馈回平板电脑,形成电子地图,通过电子地图可以确定移动平台在温室垄间路面内的确切位置,方便移动平台在温室垄间路面内进行精准作业。
(3)移动平台的转弯运动控制:分为进入垄间路面和离开垄间路面的两种转弯运动。
(a)进入垄间路面的转弯运动:按照移动平台的路径规划,移动平台行驶过若干数量的种植槽后,即在直行到要转弯位置的过道与垄间路面的T形路口时,控制器控制前后两个导向电动推杆使导向杆下降;移动平台向前行进的过程中行使入T形路口的地面凹槽中,使前后依次导向杆在地面凹槽的形状约束下,实现转弯导向,当四个超声波测距模块均检测到距离时,控制器控制前后两个导向电动推杆使导向杆上升,完成移动平台进入垄间路面的自主转弯运动。
(b)离开垄间路面的转弯运动:控制器控制驱动电机反向转动,移动平台实现自动倒行,并保持直线行驶。当激光测距模块探测到移动平台车身与大棚后墙的距离到设定值时,表明移动平台行驶到过道与垄间路面的T形路口,控制器控制前后两个导向电动推杆使导向杆下降,移动平台倒车的过程中行使入T形路口的地面凹槽中,使后导向杆和前导向杆依次在地面凹槽的形状约束下,完成移动平台从垄间路面驶入过道的转弯运动。当与(A)中移动平台同侧的前后两个超声波测距模块开始实时探测到车身与过道台沿的距离时,控制器控制前后两个导向电动推杆使导向杆上升,完成移动平台离开垄间路面的自主转弯运动。
(4)移动平台的升降运动:当移动平台需要升降作业时,平板电脑通过无线路由器将无线信号将升降指令经由WiFi模块传输给控制器,控制器对命令解析后,控制升降电动推杆上升或下降,通过控制电动推杆的伸出行程控制升降台的升降高度,实现移动平台升降台面的定量升降作业。
(5)移动平台的安全措施:移动平台前后激光测距模块探测距离信息实时传输到控制器,当移动平台前进同时前方有障碍物或移动平台倒车同时后方有障碍物时,移动平台车身距离障碍物的距离小于程序设定的最小安全距离,控制器将发出报警信息,同时控制驱动电机停止转动,等移动平台与障碍物的距离大于最小安全距离时,移动平台再继续进行原先的运动。当有突发状况发生时,工作人员可以关闭移动平台后端的急停按钮,使移动平台断电并立刻停止作业,从而保证移动平台、温室及工作人员的安全。
本发明的有益效果是:
1、本发明采用了后轮差速驱动,前轮万向轮转向,结合低成本的温室半结构化结构,节约了轨道铺设成本,最大程度的实现了温室内的无轨道自主运动的工作模式进行作业,提高劳动效率,省时、省力、易操作。
2、本发明的结构设计中升降台与底盘连结稳定,可以实现行走中稳定的升降合理使用了底盘结构空间,结构精炼,成本低廉,并设有防碰撞探测器和急停按钮,安全方便、设计精密、操作简单。
3、本发明可配套使用多种农用机具和自动运输物料及工作人员,并具备远程无线控制的升降功能,自动化程度高、作业效率高、功能全面、灵活度高、节省劳动力。
附图说明
图1为一种半结构化日光温室用智能移动平台的整体结构示意图;
图2为一种半结构化日光温室用智能移动平台的前视图;
图3为一种半结构化日光温室用智能移动平台的底视图;
图4为一种半结构化日光温室用智能移动平台的右视图;
图5为一种半结构化日光温室用智能移动平台的底盘俯视图;
图6为一种半结构化日光温室用智能移动平台作业路况图;
图7为一种半结构化日光温室用智能移动平台转弯导向装置图。
图中:1、升降台2、电动推杆3、激光测距模块4、前轮5、万向前叉6、超声波测距模块7、底盘8、实心后轮9、驱动电机10、导向电动推杆11、连接杆12、支撑架13、急停按钮14、导向轮15、底座16、驱动轮电机驱动器17、单片机18、WiFi模块19、蓄电池20、种植槽21、过道22、过道台沿23、地面凹槽24、垄间路面25、导向杆26、弹簧27、轴承
具体实施方式
下面结合附图对本专利进行进一步的说明。本发明是一种半结构化日光温室用智能移动平台,如图1、2、3、4、5、6、7所示。一种半结构化日光温室用智能移动平台所采用的技术方案包括:底盘7、行走装置、转弯导向装置、升降装置、智能控制模块和半结构化温室路面。
所述底盘7用于固定和承载其他装置与模块,形成移动平台机械结构的基本框架;
所述行走装置,包括左右两个万向前轮总成和左右两个驱动后轮总成。所述左右两个万向前轮总成分别固定在底盘7前端横梁两侧;所述左右两个驱动后轮总成包括左右两个驱动电机9和左右两个后轮8,左右两个驱动电机9分别固定于底盘7后端的T形架上左右两侧,驱动电机9输出轴固定于后轮8轮毂上,实现两后轮8的差速驱动。
所述转弯导向装置,包括导向电动推杆10,轴承27,弹簧26,转向轴,导向杆25。所述导向电动推杆10共有两个,分别位于底盘7前后两端中央处的底面,通过螺栓与导向杆25固联;所述轴承27共有四个,两两一组,分别位于两个导向杆25的下端,每个导向杆25底端的两个轴承27分别成水平和竖直安置;所述弹簧26位于导向杆25与导向电动推杆10之间;所述转向轴用于导向杆25与导向电动推杆10以及轴承24与导向杆25的连接与固定;所述导向杆25,用来连接导向电动推杆10与轴承27。
所述升降装置,包括支撑架12、连接杆11、升降台1、升降轴、升降电动推杆、底座15。所述支撑架12用于链接底盘7和升降台1;所述连接杆11用于支撑架12内侧的固定,并与电动推杆2连接;所述升降台1位于支撑架12的上端;所述升降轴位于升降台1和底盘7的槽钢内;所述的升降电动推杆固定于底座15上,与连接杆11连接;所述底座15位于底盘7底板的最前端中央处。
所述智能控制模块,包括控制箱、控制器、驱动轮电机驱动器16、激光测距模块3、超声波测距模块6、WIFI模块18、无线路由器、平板电脑、急停按钮13和蓄电池19。所述控制箱固定于底盘7底板上,用于布置控制器、驱动轮电机驱动器16、电动推杆驱动器、WIFI模块18、急停按钮13和蓄电池19;所述的控制器优先选用STM32单片机系统,所述的导向电动推杆10和升降电动推杆分别与控制器电气连接,实现电动推杆2的伸缩与停止控制;所述的驱动轮电机驱动器16的输入端与控制器电气连接,输出端分别与左右两个驱动电机9电气连接,用于分别驱动后轮8正转、反转和停止;所述的激光测距模块3安装于底盘7最前端,与控制器进行电气连接;所述超声波测距模块6设有四个,分别固定于底盘7的两侧的前后边沿上,与控制器进行电气连接。所述激光测距模块3和超声波测距模块6用于监测探测头与反射面的距离;所述无线路由器安装于日光温室的后墙上;所述WIFI模块18串接到控制器,与无线路由器进行通讯,实现与平板电脑的信号收发功能;所述平板电脑用于对移动平台进行远程无线智能操控;所述蓄电池19用于给移动平台提供电能。所述急停按钮13位于底盘7后端右上角,与蓄电池19进行电气连接,发生意外情况时工作人员可以按下急停按钮13,立刻切断移动平台电源,停止任何作业。
所述半结构化温室路面,包括过道21,过道台沿22,种植槽20,垄间路面24,地面凹槽23。所述过道21为铺设在温室后墙或前坡面的一条的平直铺装路面,用于移动平台沿温室东西走向的行进;所述过道台沿22为过道21离开种植区一侧的台沿,台沿高度一般不低于20cm;所述种植槽20为种植作物区,一般为一行或两行作物种植区域,其边缘有限选用砖混结构包围,种植槽20边缘一般不低于20cm;所述垄间路面24位于两种植槽20之间的一条平直铺装或非铺装路面,用于移动平台沿温室南北走向的行内行进;所述地面凹槽23,位于过道21与垄间路面24的T形路口处,每个T形路口处各有一个地面凹槽23,在进入行间转弯时,起到限制移动平台运动轨迹的作用。
本发明一种半结构化日光温室用智能移动平台的控制方法:
(1)移动平台启动、移动与关停:平板电脑的启动指令经过无线信号发送到移动平台的WiFi模块18,控制器处理WiFi信号,并分析操作命令,形成移动轨迹规划,使移动平台从温室起始点开始运动。启动后,超声波测距模块6和激光测距模块3开始工作,并将信息反馈给控制器,控制器计算当前位置并与温室电子地图比较定位后,形成移动平台在温室内的定位信息,并将该信息通过WiFi模块18传送给平板电脑,标示当前移动平台在电子地图中的位置。当控制器接受到关停命令时,控制器规划移动轨迹,使移动平台从当前位置运动至温室起始点。
(2)移动平台的直线运动控制:分为在过道21和垄间路面24的两种直线运动。
(A)在过道21上的直线行走:一方面,远种植区侧的前后两个超声波测距模块6开始实时探测车身与过道台沿22的距离;当移动平台前超声波测距模块6测量的距离大于后超声波测距模块6测量的距离时,控制器减小远种植区侧驱动后轮8的速度,增大近种植区侧驱动后轮8的速度;当移动平台前超声波测距模块6测量的距离小于后超声波测距模块6测量的距离时,控制器增大远种植区侧驱动后轮8的速度,减小近种植区侧驱动后轮8的速度;当移动平台前超声波测距模块6测量的距离等于后超声波测距模块6测量的距离时,不单独改变驱动后轮8的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶。另一方面,激光测距模块3开始测量车身到前方反射面的距离,同时近种植区侧的前后两个超声波测距模块6开始实时探测车身与种植槽20距离的变化,来确定移动平台行驶过的垄间路面24和种植槽20的数目,将上述两种信息与电子地图上的位置信息融合确定移动平台在温室过道21中更准确的当前位置信息。
(B)在垄间路面24上的直线行走:一方面,使用与(A)中移动平台同侧的前后两个超声波测距模块6开始实时探测车身与种植槽20的距离;当移动平台前超声波测距模块6测量的距离大于后超声波测距模块6测量的距离时,控制器减小该超声波测距模块6所在侧驱动后轮8的速度,增大另一侧驱动后轮8的速度;当移动平台前超声波测距模块6测量的距离小于后超声波测距模块6测量的距离时,控制器增大该超声波测距模块6所在侧驱动后轮8的速度,减小另一侧驱动后轮8的速度;当移动平台前超声波测距模块6测量的距离等于后超声波测距模块6测量的距离时,不单独改变驱动后轮8的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶。另一方面,激光测距模块3开始测量车身到前方反射面的距离,将该距离信息发送给控制器计算出移动平台的当前位置信息,并将信息通过WiFi模块18反馈回平板电脑,形成电子地图,通过电子地图可以确定移动平台在温室垄间路面24内的确切位置,方便移动平台在温室垄间路面24内进行精准作业。
(3)移动平台的转弯运动控制:分为进入垄间路面24和离开垄间路面24的两种转弯运动。
(a)进入垄间路面24的转弯运动:按照移动平台的路径规划,移动平台行驶过若干数量的种植槽20后,即在直行到要转弯位置的过道21与垄间路面24的T形路口时,控制器控制前后两个导向电动推杆10使导向杆25下降;移动平台向前行进的过程中行使入T形路口的地面凹槽23中,使前后依次导向杆25在地面凹槽23的形状约束下,实现转弯导向,当四个超声波测距模块6均检测到距离时,控制器控制前后两个导向电动推杆10使导向杆25上升,完成移动平台进入垄间路面24的自主转弯运动。
(b)离开垄间路面24的转弯运动:控制器控制驱动电机9反向转动,移动平台实现自动倒行,并保持直线行驶。当激光测距模块3探测到移动平台车身与大棚后墙的距离到设定值时,表明移动平台行驶到过道21与垄间路面24的T形路口,控制器控制前后两个导向电动推杆10使导向杆25下降,移动平台倒车的过程中行使入T形路口的地面凹槽23中,使后导向杆25和前导向杆25依次在地面凹槽23的形状约束下,完成移动平台从垄间路面24驶入过道21的转弯运动。当与(A)中移动平台同侧的前后两个超声波测距模块6开始实时探测到车身与过道台沿22的距离时,控制器控制前后两个导向电动推杆10使导向杆25上升,完成移动平台离开垄间路面24的自主转弯运动。
(4)移动平台的升降运动:当移动平台需要升降作业时,平板电脑通过无线路由器将无线信号将升降指令经由WiFi模块18传输给控制器,控制器对命令解析后,控制升降电动推杆上升或下降,通过控制电动推杆2的伸出行程控制升降台1的升降高度,实现移动平台升降台面的定量升降作业。
(5)移动平台的安全措施:移动平台前后激光测距模块3探测距离信息实时传输到控制器,当移动平台前进同时前方有障碍物或移动平台倒车同时后方有障碍物时,移动平台车身距离障碍物的距离小于程序设定的最小安全距离,控制器将发出报警信息,同时控制驱动电机9停止转动,等移动平台与障碍物的距离大于最小安全距离时,移动平台再继续进行原先的运动。当有突发状况发生时,工作人员可以关闭移动平台后端的急停按钮13,使移动平台断电并立刻停止作业,从而保证移动平台、温室及工作人员的安全。

Claims (2)

1.一种半结构化日光温室用智能移动平台,其特征在于:底盘、行走装置、转弯导向装置、升降装置、智能控制模块和半结构化温室路面;
所述底盘用于固定和承载其他装置与模块,形成移动平台机械结构的基本框架;
所述行走装置,包括左右两个万向前轮总成和左右两个驱动后轮总成;所述左右两个万向前轮总成分别固定在底盘前端横梁两侧;所述左右两个驱动后轮总成包括左右两个驱动电机和左右两个后轮,左右两个驱动电机分别固定于底盘后端的T形架上左右两侧,驱动电机输出轴固定于后轮轮毂上,实现两后轮的差速驱动;
所述转弯导向装置,包括导向电动推杆,轴承,弹簧,转向轴,导向杆;所述导向电动推杆共有两个,分别位于底盘前后两端中央处的底面,通过螺栓与导向杆固联;所述轴承共有四个,两两一组,分别位于两个导向杆的下端,每个导向杆底端的两个轴承分别成水平和竖直安置;所述弹簧位于导向杆与导向电动推杆之间;所述转向轴用于导向杆与导向电动推杆以及轴承与导向杆的连接与固定;所述导向杆,用来连接导向电动推杆与轴承;
所述升降装置,包括支撑架、连接杆、升降台、升降轴、升降电动推杆、底座;所述支撑架用于链接底盘和升降台;所述连接杆用于支撑架内侧的固定,并与电动推杆连接;所述升降台位于支撑架的上端;所述升降轴位于升降台和底盘的槽钢内;所述的升降电动推杆固定于底座上,与连接杆连接;所述底座位于底盘底板的最前端中央处;
所述智能控制模块,包括控制箱、控制器、驱动轮电机驱动器、激光测距模块、超声波测距模块、WIFI模块、无线路由器、平板电脑、急停按钮和蓄电池;所述控制箱固定于底盘底板上,用于布置控制器、驱动轮电机驱动器、电动推杆驱动器、WIFI模块、急停按钮和蓄电池;所述的控制器优先选用STM32单片机系统,所述的导向电动推杆和升降电动推杆分别与控制器电气连接,实现电动推杆的伸缩与停止控制;所述的驱动轮电机驱动器的输入端与控制器电气连接,输出端分别与左右两个驱动电机电气连接,用于分别驱动后轮正转、反转和停止;所述的激光测距模块安装于底盘最前端,与控制器进行电气连接;所述超声波测距模块设有四个,分别固定于底盘的两侧的前后边沿上,与控制器进行电气连接;所述激光测距模块和超声波测距模块用于监测探测头与反射面的距离;所述无线路由器安装于日光温室的后墙上;所述WIFI模块串接到控制器,与无线路由器进行通讯,实现与平板电脑的信号收发功能;所述平板电脑用于对移动平台进行远程无线智能操控;所述蓄电池用于给移动平台提供电能。所述急停按钮位于底盘后端右上角,与蓄电池进行电气连接,发生意外情况时工作人员可以按下急停按钮,立刻切断移动平台电源,停止任何作业;
所述半结构化温室路面,包括过道,过道台沿,种植槽,垄间路面,地面凹槽;所述过道为铺设在温室后墙或前坡面的一条的平直铺装路面,用于移动平台沿温室东西走向的行进;所述过道台沿为过道离开种植区一侧的台沿,台沿高度一般不低于20cm;所述种植槽为种植作物区,一般为一行或两行作物种植区域,其边缘有限选用砖混结构包围,种植槽边缘一般不低于20cm;所述垄间路面位于两种植槽之间的一条平直铺装或非铺装路面,用于移动平台沿温室南北走向的行内行进;所述地面凹槽,位于过道与垄间路面的T形路口处,每个T形路口处各有一个地面凹槽,在进入行间转弯时,起到限制移动平台运动轨迹的作用。
2.根据权利要求1所述的一种半结构化日光温室用智能移动平台的控制方法,其特征在于包括如下步骤:
(1)移动平台启动、移动与关停:平板电脑的启动指令经过无线信号发送到移动平台的WiFi模块,控制器处理WiFi信号,并分析操作命令,形成移动轨迹规划,使移动平台从温室起始点开始运动;启动后,超声波测距模块和激光测距模块开始工作,并将信息反馈给控制器,控制器计算当前位置并与温室电子地图比较定位后,形成移动平台在温室内的定位信息,并将该信息通过WiFi模块传送给平板电脑,标示当前移动平台在电子地图中的位置;当控制器接受到关停命令时,控制器规划移动轨迹,使移动平台从当前位置运动至温室起始点;
(2)移动平台的直线运动控制:分为在过道和垄间路面的两种直线运动;
(A)在过道上的直线行走:一方面,远种植区侧的前后两个超声波测距模块开始实时探测车身与过道台沿的距离;当移动平台前超声波测距模块测量的距离大于后超声波测距模块测量的距离时,控制器减小远种植区侧驱动后轮的速度,增大近种植区侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离小于后超声波测距模块测量的距离时,控制器增大远种植区侧驱动后轮的速度,减小近种植区侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离等于后超声波测距模块测量的距离时,不单独改变驱动后轮的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶;另一方面,激光测距模块开始测量车身到前方反射面的距离,同时近种植区侧的前后两个超声波测距模块开始实时探测车身与种植槽距离的变化,来确定移动平台行驶过的垄间路面和种植槽的数目,将上述两种信息与电子地图上的位置信息融合确定移动平台在温室过道中更准确的当前位置信息;
(B)在垄间路面上的直线行走:一方面,使用与(A)中移动平台同侧的前后两个超声波测距模块开始实时探测车身与种植槽的距离;当移动平台前超声波测距模块测量的距离大于后超声波测距模块测量的距离时,控制器减小该超声波测距模块所在侧驱动后轮的速度,增大另一侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离小于后超声波测距模块测量的距离时,控制器增大该超声波测距模块所在侧驱动后轮的速度,减小另一侧驱动后轮的速度;当移动平台前超声波测距模块测量的距离等于后超声波测距模块测量的距离时,不单独改变驱动后轮的速度,使移动平台行进过程中使行进方向保持不变,移动平台就可以保持直线行驶;另一方面,激光测距模块开始测量车身到前方反射面的距离,将该距离信息发送给控制器计算出移动平台的当前位置信息,并将信息通过WiFi模块反馈回平板电脑,形成电子地图,通过电子地图可以确定移动平台在温室垄间路面内的确切位置,方便移动平台在温室垄间路面内进行精准作业;
(3)移动平台的转弯运动控制:分为进入垄间路面和离开垄间路面的两种转弯运动;
(a)进入垄间路面的转弯运动:按照移动平台的路径规划,移动平台行驶过若干数量的种植槽后,即在直行到要转弯位置的过道与垄间路面的T形路口时,控制器控制前后两个导向电动推杆使导向杆下降;移动平台向前行进的过程中行使入T形路口的地面凹槽中,使前后依次导向杆在地面凹槽的形状约束下,实现转弯导向,当四个超声波测距模块均检测到距离时,控制器控制前后两个导向电动推杆使导向杆上升,完成移动平台进入垄间路面的自主转弯运动;
(b)离开垄间路面的转弯运动:控制器控制驱动电机反向转动,移动平台实现自动倒行,并保持直线行驶。当激光测距模块探测到移动平台车身与大棚后墙的距离到设定值时,表明移动平台行驶到过道与垄间路面的T形路口,控制器控制前后两个导向电动推杆使导向杆下降,移动平台倒车的过程中行使入T形路口的地面凹槽中,使后导向杆和前导向杆依次在地面凹槽的形状约束下,完成移动平台从垄间路面驶入过道的转弯运动;当与(A)中移动平台同侧的前后两个超声波测距模块开始实时探测到车身与过道台沿的距离时,控制器控制前后两个导向电动推杆使导向杆上升,完成移动平台离开垄间路面的自主转弯运动;
(4)移动平台的升降运动:当移动平台需要升降作业时,平板电脑通过无线路由器将无线信号将升降指令经由WiFi模块传输给控制器,控制器对命令解析后,控制升降电动推杆上升或下降,通过控制电动推杆的伸出行程控制升降台的升降高度,实现移动平台升降台面的定量升降作业;
(5)移动平台的安全措施:移动平台前后激光测距模块探测距离信息实时传输到控制器,当移动平台前进同时前方有障碍物或移动平台倒车同时后方有障碍物时,移动平台车身距离障碍物的距离小于程序设定的最小安全距离,控制器将发出报警信息,同时控制驱动电机停止转动,等移动平台与障碍物的距离大于最小安全距离时,移动平台再继续进行原先的运动;当有突发状况发生时,工作人员可以关闭移动平台后端的急停按钮,使移动平台断电并立刻停止作业,从而保证移动平台、温室及工作人员的安全。
CN201610886882.5A 2016-10-11 2016-10-11 一种半结构化日光温室用智能移动平台及其控制方法 Active CN106276113B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201610886882.5A CN106276113B (zh) 2016-10-11 2016-10-11 一种半结构化日光温室用智能移动平台及其控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201610886882.5A CN106276113B (zh) 2016-10-11 2016-10-11 一种半结构化日光温室用智能移动平台及其控制方法

Publications (2)

Publication Number Publication Date
CN106276113A true CN106276113A (zh) 2017-01-04
CN106276113B CN106276113B (zh) 2018-07-24

Family

ID=57717544

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201610886882.5A Active CN106276113B (zh) 2016-10-11 2016-10-11 一种半结构化日光温室用智能移动平台及其控制方法

Country Status (1)

Country Link
CN (1) CN106276113B (zh)

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107235301A (zh) * 2017-06-07 2017-10-10 东莞光润家具股份有限公司 一种移动家具平台及用于移动家具平台的控制系统
CN108552154A (zh) * 2018-02-24 2018-09-21 南京工业职业技术学院 一种航空用驱鸟设备
CN112722067A (zh) * 2020-12-24 2021-04-30 黄日民 一种仓储输送机器人

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102754538A (zh) * 2012-07-13 2012-10-31 北京农业智能装备技术研究中心 用于连栋温室的机器人
CN202765753U (zh) * 2012-04-25 2013-03-06 绍兴文理学院 一种电控物流小车
CN105021225A (zh) * 2015-07-08 2015-11-04 江苏大学 一种温室智能移动检测平台
CN105383882A (zh) * 2015-12-28 2016-03-09 董敏 一种全自动物料输送升降台
CN105467892A (zh) * 2015-12-08 2016-04-06 山东农业大学 一种基于温室内凹槽单轨自动化作业车及其控制方法
CN105501863A (zh) * 2015-12-08 2016-04-20 山东农业大学 一种基于温室内精确定位的单轨物流车及其控制方法
CN206156246U (zh) * 2016-10-11 2017-05-10 山东农业大学 一种温室大棚用无轨道自主移动平台

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202765753U (zh) * 2012-04-25 2013-03-06 绍兴文理学院 一种电控物流小车
CN102754538A (zh) * 2012-07-13 2012-10-31 北京农业智能装备技术研究中心 用于连栋温室的机器人
CN105021225A (zh) * 2015-07-08 2015-11-04 江苏大学 一种温室智能移动检测平台
CN105467892A (zh) * 2015-12-08 2016-04-06 山东农业大学 一种基于温室内凹槽单轨自动化作业车及其控制方法
CN105501863A (zh) * 2015-12-08 2016-04-20 山东农业大学 一种基于温室内精确定位的单轨物流车及其控制方法
CN105383882A (zh) * 2015-12-28 2016-03-09 董敏 一种全自动物料输送升降台
CN206156246U (zh) * 2016-10-11 2017-05-10 山东农业大学 一种温室大棚用无轨道自主移动平台

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN107235301A (zh) * 2017-06-07 2017-10-10 东莞光润家具股份有限公司 一种移动家具平台及用于移动家具平台的控制系统
CN108552154A (zh) * 2018-02-24 2018-09-21 南京工业职业技术学院 一种航空用驱鸟设备
CN112722067A (zh) * 2020-12-24 2021-04-30 黄日民 一种仓储输送机器人

Also Published As

Publication number Publication date
CN106276113B (zh) 2018-07-24

Similar Documents

Publication Publication Date Title
CN206156246U (zh) 一种温室大棚用无轨道自主移动平台
US11465886B2 (en) Suspension rail type greenhouse comprehensive information automatic cruise monitoring device
CN202077380U (zh) 一种gps导航割草机器人
WO2017004943A1 (zh) 一种温室智能移动检测平台
CN103404379B (zh) 一种果园自走式智能疏花机
CN106276113B (zh) 一种半结构化日光温室用智能移动平台及其控制方法
US11925134B2 (en) Multilayered rail guide vehicle system for use in three-dimensional planting in plant factory, and control method therefor
CN106958373B (zh) 一种自动化停车库用智能全向移载平台泊车系统及方法
CN205233273U (zh) 一种温室用单轨植保机器人
CN101694313B (zh) 空气处理智能装置及其空气处理方法
CN112975890A (zh) 一种智能巡检机器人
CN107409516A (zh) 农用轨道直向横向自动移动装置
CN107870624A (zh) 一种日光温室自动导航多功能智能作业车
CN210328616U (zh) 一种灌木修剪机器人
CN113439524A (zh) 基于单线激光雷达自动升降装置的家用割草机器人、系统以及建图方法
CN103858808A (zh) 一种适用于水产养殖的工业化自动投饵系统
CN109430225B (zh) 温室高架作物剪叉式行间喷药机
CN207541501U (zh) 一种日光温室自动导航多功能智能作业车
CN109247247A (zh) 一种翻耙机
CN210181475U (zh) 一种农业大棚用喷药智能车
CN117016350A (zh) 一种用于立体农业的综合管理设备
CN209518153U (zh) 温室高架作物剪叉式行间喷药机及其控制系统
CN201928695U (zh) 自走式烟苗剪叶设备
CN209400016U (zh) 一种温室作物生境信息采集系统
CN207090361U (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