CN105929828B - 一种扒谷机器人控制***及控制方法 - Google Patents
一种扒谷机器人控制***及控制方法 Download PDFInfo
- Publication number
- CN105929828B CN105929828B CN201610418330.1A CN201610418330A CN105929828B CN 105929828 B CN105929828 B CN 105929828B CN 201610418330 A CN201610418330 A CN 201610418330A CN 105929828 B CN105929828 B CN 105929828B
- Authority
- CN
- China
- Prior art keywords
- module
- grain
- grain scraper
- device people
- master board
- 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 20
- 238000012544 monitoring process Methods 0.000 claims abstract description 26
- 230000007613 environmental effect Effects 0.000 claims abstract description 19
- 230000007246 mechanism Effects 0.000 claims abstract description 12
- 238000004891 communication Methods 0.000 claims description 34
- 239000002184 metal Substances 0.000 claims description 31
- 229910052751 metal Inorganic materials 0.000 claims description 31
- 230000004888 barrier function Effects 0.000 claims description 23
- 238000001514 detection method Methods 0.000 claims description 20
- 230000006378 damage Effects 0.000 claims description 14
- 238000012360 testing method Methods 0.000 claims description 12
- 208000027418 Wounds and injury Diseases 0.000 claims description 11
- 208000014674 injury Diseases 0.000 claims description 10
- 230000003750 conditioning effect Effects 0.000 claims description 8
- 230000008447 perception Effects 0.000 claims description 6
- 230000005611 electricity Effects 0.000 claims description 5
- 238000011084 recovery Methods 0.000 claims description 5
- 230000005540 biological transmission Effects 0.000 claims description 4
- 230000006870 function Effects 0.000 claims description 4
- 238000005259 measurement Methods 0.000 claims description 4
- 230000002093 peripheral effect Effects 0.000 claims description 3
- 230000002265 prevention Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 3
- 238000009434 installation Methods 0.000 description 3
- 238000013461 design Methods 0.000 description 2
- 239000000428 dust Substances 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 230000008569 process Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000036541 health Effects 0.000 description 1
- 238000007689 inspection Methods 0.000 description 1
- 239000004973 liquid crystal related substance Substances 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 230000008054 signal transmission Effects 0.000 description 1
- 230000001960 triggered effect Effects 0.000 description 1
- 238000002604 ultrasonography 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
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G65/00—Loading or unloading
- B65G65/02—Loading or unloading machines comprising essentially a conveyor for moving the loads associated with a device for picking-up the loads
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01D—MEASURING NOT SPECIALLY ADAPTED FOR A SPECIFIC VARIABLE; ARRANGEMENTS FOR MEASURING TWO OR MORE VARIABLES NOT COVERED IN A SINGLE OTHER SUBCLASS; TARIFF METERING APPARATUS; MEASURING OR TESTING NOT OTHERWISE PROVIDED FOR
- G01D21/00—Measuring or testing not otherwise provided for
- G01D21/02—Measuring two or more variables by means not covered by a single other subclass
-
- 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
- G05D1/0255—Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
-
- G—PHYSICS
- G08—SIGNALLING
- G08C—TRANSMISSION SYSTEMS FOR MEASURED VALUES, CONTROL OR SIMILAR SIGNALS
- G08C17/00—Arrangements for transmitting signals characterised by the use of a wireless electrical link
- G08C17/02—Arrangements for transmitting signals characterised by the use of a wireless electrical link using a radio link
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B65—CONVEYING; PACKING; STORING; HANDLING THIN OR FILAMENTARY MATERIAL
- B65G—TRANSPORT OR STORAGE DEVICES, e.g. CONVEYORS FOR LOADING OR TIPPING, SHOP CONVEYOR SYSTEMS OR PNEUMATIC TUBE CONVEYORS
- B65G2201/00—Indexing codes relating to handling devices, e.g. conveyors, characterised by the type of product or load being conveyed or handled
- B65G2201/04—Bulk
- B65G2201/042—Granular material
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Mechanical Engineering (AREA)
- Aviation & Aerospace Engineering (AREA)
- Automation & Control Theory (AREA)
- Computer Networks & Wireless Communication (AREA)
- Acoustics & Sound (AREA)
- Selective Calling Equipment (AREA)
- Storage Of Harvested Produce (AREA)
Abstract
本发明公开了一种扒谷机器人控制***,包括扒谷机器人及其控制***,所述扒谷机器人包括机架,所述机架上设有自行走机构、扒谷输送装置以及驱动电机;所述控制***包括主控制板、环境监测传感***以及手持设备;所述主控制板分别与所述环境监测传感***、所述手持设备相连;所述主控制板设置在扒谷机器人内,所述环境监测传感器设置在扒谷机器人的机架上,所述手持设备在仓外由工作人员操控。所述自行走装置、扒谷输送装置与驱动电机与所述主控制板相连,并与其进行信号的收发,执行所述主控制板的命令。本发明还提供了一种扒谷机器人的控制方法,通过布设本发明公开的扒谷机器人控制方法,采用一定的步骤控制所述扒谷机器人,实现智能化扒谷。
Description
技术领域
本发明涉及一种机器控制***及方法,尤其涉及扒谷机器人的控制***及控制方法。
背景技术
扒谷机是一种农用机械设备,广泛用于散粮收装倒仓、粮库使用时与输送机配合还可以堆囤、装车。现有的扒谷机大多数都包括机架、驱动电机,机架上设有输送装置,输送装置的上端设有出料口,下端设有进料端,机架的底部设有行走机构。
申请号为CN 203545174 U的实用新型专利《扒谷机》,公开了一种扒谷机,包括机架,所述机架上设有行走机构、输送装置以及驱动电机,所述输送装置包括设于机架上端的主动传动滚筒、设于机架下端的从动传动滚筒以及绕于主动传动滚筒与从动传动滚筒上的输送带,机架上设置防护罩,可有效避免粉尘飞扬。然而,该扒谷机的行走、转向和启动停止都是在人为操作下完成的,工作效率相对较低,粮食在出入仓输送过程中不可避免地产生大量粉尘,作业现场尘土飞扬,工作环境差,给作业人员的身体健康造成危害,此外,扒谷机应该避免碰触到粮仓内的墙壁、地上的通风笼,并且能够区分粮堆和障碍物,并精确感知其距离。因此,急需一种能够减少工作环境对员工人体伤害的无需现场操作的自动扒谷机。
发明内容
为了解决上述问题,本发明提供了一种扒谷机器人控制***,包括扒谷机器人及其控制***,所述扒谷机器人包括机架,所述机架上设有自行走机构、扒谷输送装置以及驱动电机。
所述控制***包括主控制板、环境监测传感***以及手持设备;所述主控制板分别与所述环境监测传感***、所述手持设备相连;
所述主控制板设置在扒谷机器人内,所述环境监测传感***的传感设备设置在扒谷机器人的机架上,所述手持设备在仓外,由工作人员操控,用于帮助场外人员远程监控粮仓内的扒谷机器人;
所述主控制板接收所述环境监测传感***的信号;
所述自行走机构、扒谷输送装置与驱动电机与所述主控制板相连,并与其进行信号的收发,执行所述主控制板的命令。
所述环境监测传感***包括测距模块、金属探测模块、温湿度测试模块、声光报警模块。所述测距模块设置在扒谷机器人的机架上,用于监测扒谷机器人周围的粮食堆放情况。所述金属探测模块设置在扒谷机器人自行走机构底盘上,用于探测扒谷机器人是否接近仓库里的金属地笼,使得扒谷机可以避开地笼。所述温湿度测试模块设置在扒谷机器人机架上,用于检测扒谷机器人工作环境中的温度和湿度。温湿度测试模块可以通过测试扒谷机器人工作环境,及时向主控制板发送信号,使得主控制板能够及时做出反应、防止温度过高而湿度较低时引起的火灾。
所述手持设备包括控制芯片、手持设备电源模块、报警模块、显示屏、手持设备无线通信模块、手持设备LED指示模块、手持设备电源模块、操纵模块。所述电源模块包括手持设备电源、手持设备电源检测电路、手持设备电源保护电路。
所述手持设备电源为直流电池;所述电源检测电路用于调节输出并检测电源电压,所述电源保护电路包括二极管及保险丝,用于防反接、浪涌及大电流保护,电源检测电路实时监测直流电池使用情况以便使用人员实时更换直流电池或充电。
所述控制芯片为MCU芯片,所述报警模块、显示屏、手持设备无线通信模块、手持设备LED指示模块、手持设备电源检测电路、手持设备电源保护电路、操纵模块分别通过IO接口与控制芯片相连。
所述无线通信模块用于在手持设备和扒谷机器人主控制板之间进行通信。
所述操纵模块用于按照控制需求通过按键和摇杆控制扒谷机器人前行、停止、关机、左转、右转,其指令通过无线通信模块发送。
所述显示屏可以显示仓库内红外摄像头的监控画面。
所述控制***还包括串口通信模块、无线通信模块和电源模块。所述串口通信模块一端与所述主控制板相连,一端与电机控制板相连;主要完成控制***与电机控制板之间的数据交换以及相关控制指令的传输。
所述无线通信模块与所述主控制板相连,所述手持设备通过所述无线通信模块与主控制板通信。所述无线通信模块通过网络将扒谷机器人工作状况发送给仓外手持设备;通过实时地将信息发送给仓外的工作人员,使得工作人员实时掌握扒谷机器人的工作情况并及时进行人工介入、取走地笼的操作,遇到其他紧急情况可以及时通过外部无线遥控设备关闭扒谷机。
所述电源模块包括电源、电源调理电路和防浪涌保护电路。所述电源为24VDC电源,通过电源调理电路后分别得到可供MCU和***模块使用的5.0VDC和3.3VDC电压电源。MCU通过检测电源电压的稳定程度来判断电源供电是否正常。
所述防浪涌保护电路用于防止反接对电路的伤害,包括TVS二极管和自恢复保险丝。所述TVS二极管其可防止浪涌和静电对电路的伤害,所述自恢复保险丝可防止后续电路出现故障时对前面电源电路以及控制电路的伤害。
所述控制***还包括继电器控制模块和LED指示模块,所述继电器模块主要用来控制外部需要较高电压供电的设备,比如在扒谷机器人上添加声光报警设备,仓外工作人员可以通过观察/听到声光报警信号来判断机器人是否工作过程中接近地笼或行进到谷仓尽头等信息。
所述LED指示模块,用于判断控制***的工作是否正常,以及通过指示灯的亮灭判断控制***的故障。
所述控制***还留有冗余接口,用于后续功能的增加。
所述测距模块为超声波探测器组件。所述超声波探测器组件包括:超声波探测器模块、超声波探测器控制板、壳体以及转接件。所述转接件一端通过螺栓锁紧扒谷机,另一端连接壳体。所述超声波探测器模块焊接在所述探测器控制板上,所述探测器控制板固定在壳体内部。
本发明还提供了一种扒谷机器人的控制方法,包括以下步骤:
S1搭建硬件:搭建本发明公开的所述扒谷机器人控制***;
S2设置传感器:在垂直于地面的同一条线上,在扒谷机器人机架上的高、低两个位置分别设置若干测距模块和金属探测模块;主控制板根据高、低位置的探测结果进行判断:
S3主控制板控制扒谷机器人前进;
S4测距模块与主控制板共同避让障碍物:若测距模块两个位置的传感器测距结果相等,则为墙壁,设置主控制板在此信号下输出避让指令;若所测距离不等,经计算得到是一个斜面,则为谷堆,设置主控制板在此信号下输出扒谷指令;
S5所述金属探测模块与主控制板共同避让金属地笼:根据金属探测器的测量确定是否接近金属地笼,如果接近地笼则设置主控制板输出避让指令;
S6若没有阻碍,则继续前进,直到机器到达粮堆,然后调整好机器的方向和位置等,开始进行扒谷动作;
S7在完成一次扒谷任务之后,通过所述测距模块的传感器判断附近是否还有粮食只需机器原地转向就可以开始扒谷作业:若有,则根据传感器感知到的粮食位置和障碍物情况等,计算扒谷机转弯的方向和角度,微调之后开始扒谷;若无,则采用传感器进行比较大范围的粮堆寻找,直至传感器探测不到谷堆。
本发明提供的所述控制方法,还包括以下步骤:
S8在步骤S3中,若没有找到粮堆,则主控制器输出指令,使扒谷机器人先向左转弯90°,机器前进,继续寻找粮堆,若还没有找到粮堆,则再向右转弯180°,机器前进,继续寻找粮堆,若仍然没有找到粮堆,则认为粮仓没有粮食了,此处采用能够覆盖整个粮仓的传感器。
S9在步骤S4和S5中:
若机器向着粮堆前进过程中,遇到阻碍,则对障碍物的类型进行识别;
若为墙壁,则直接开启避障操作,之后若机器能够移动,则利用传感器进行环境感知,如若机器不能移动,则停机;
若为地笼,则进行地笼预警,提醒工人可能需要进行地笼的拆除,同时对地笼预警的次数和时间进行记录;
设置相邻两次预警的时间间隔阈值,当地笼预警次数大于等于3次之后,对相邻两次预警的时间间隔进行计算,判断其是否小于阈值,时间间隔太短,则表明机器“卡死”在地笼中,则停机,并通过声光报警模块提示需要人工进行处理,仓外人员在手持设备上也可以收到报警提示;若地笼预警次数小于3次,或相邻两次预警时间间隔大于阈值,则继续工作;
S10步骤S4与步骤S5中所述的避让指令为:避障过程中,若左侧无障碍,则对前方有无障碍物进行判断:若无,则进行左转弯,否则进行后退,重新进行障碍物方位感知;
在避障过程中,若左侧有障碍物,则判断右侧是否有障碍,若右侧无障碍,则同样判断前方是否有障碍:若无,则进行右转弯,否则后退,重新进行障碍物方位感知;
在避障过程中,若左侧和右侧均有障碍,则判断前方是否有障碍:若无,则可继续前进,若有,则表明机器前方和左、右侧均有障碍物,表示“卡死”,不能移动,主控制板输出报警命令。
本发明分别提供了一种扒谷机器人的控制***以及其控制方法,通过将信号发送至手持设备,并通过传感器配合主控制板进行智能操作与远程操控,只在有问题时触发报警需要人工介入,能够解决扒谷机作业环境恶劣造成工作人员身体伤害的问题,提高了生产力,极大节省了人力物力。
附图说明
图1是本发明的扒谷机器人控制***连接示意图;
图2是本发明的控制***的电路连接框图;
图3是本发明的手持设备的电路连接框图。
具体实施方式
如图1所示,本实施例的扒谷机器人控制***,包括扒谷机器人及其控制***,其中,扒谷机器人包括机架,该机架上设有自行走机构、扒谷输送装置以及驱动电机。
控制***包括主控制板1、环境监测传感***2以及手持设备3;主控制板1分别与环境监测传感***2、所述手持设备3相连。
主控制板1接收环境监测传感***2的信号;
手持设备3与主控制板1进行信号的收发,并控制扒谷机器人;
所述自行走机构、扒谷输送装置与驱动电机与所述主控制板相连,并与其进行信号的收发,执行所述主控制板的命令。
主控制板1设置在扒谷机器人内,环境监测传感***2的传感器设置在扒谷机器人的机架上,其监测数据发送至主控制板1,手持设备3在仓外,供场外人员远程监控粮仓内的扒谷机器人。
如图2所示,环境监测传感***2的设备与主控制板1的相应接口相连;手持设备3与主控制板1通过无线通信模块5相连。
其中,环境监测传感***2包括若干测距模块21、金属探测模块23、温湿度测试模块22、声光报警模块24。测距模块21的测距传感器设置在扒谷机器人的机架上,其信号发送至主控制板1,用于监测扒谷机器人周围的粮食堆放情况。金属探测模块23的探测传感器设置在扒谷机器人自行走机构底盘上,其信号发送至主控制板1和手持设备3,用于探测扒谷机器人是否接近仓库里的金属地笼,必要时触发声光报警模块24,使得扒谷机可以避开地笼或由工作人员手动操作解决问题。温湿度测试模块22的温湿度传感器设置在扒谷机器人机架上,其信号发送至主控制板1和手持设备3,用于检测扒谷机器人工作环境中的温度和湿度。
温湿度测试模块22可以通过测试扒谷机器人工作环境,及时向主控制板1发送信号,使得主控制板1能够及时做出反应、防止温度过高而湿度较低时引起的火灾。
本实施例的控制***还包括串口通信模块4、无线通信模块5和电源模块6;
串口通信模块4一端与所述主控制板相连,一端与所述驱动电机的控制板相连,用于完成控制***与驱动电机控制板之间的数据交换以及相关控制指令的传输;
无线通信模块5与主控制板1相连,无线通信模块5通过网络将扒谷机器人工作状况发送给仓外的手持设备3;仓外的工作人员通过手持设备3,可实时掌握扒谷机器人的工作情况并及时进行人工介入、取走地笼等操作,遇到其他紧急情况可以及时通过外部无线遥控设备关闭扒谷机。
电源模块6包括电源61、电源调理电路62、电源检测电路63和防浪涌保护电路64。电源61为24VDC电源,通过电源调理电路62后分别得到可供主控制板1的芯片和***模块使用的5.0VDC和3.3VDC电压电源。电源检测电路63用于测试电源电压,防止对设备的伤害。防浪涌保护电路64包括TVS二极管和自恢复保险丝,其中TVS二极管其可防止浪涌和静电对电路的伤害,自恢复保险丝可防止后续电路出现故障时对前面电源电路以及控制电路的伤害。
控制***还包括继电器控制模块7和LED指示模块8,继电器控制模块7主要用来控制外部需要较高电压供电的设备,比如在扒谷机器人上添加声光报警设备,仓外工作人员可以通过观察/听到声光报警信号来判断机器人是否工作过程中接近地笼或行进到谷仓尽头等信息。LED指示模块8,用于判断控制***的工作是否正常,以及通过指示灯的亮灭判断控制***的故障。
本实施例的控制***还留有冗余接口,用于后续功能的增加。
本实施例的扒谷机器人控制***,其主控制板内设置有自操作流程,减少了人工参与,提高了扒谷机器人的智能化和信息化程度,解决了目前扒谷机器人每项活动都需要人工操控的问题。
如图3所示,手持设备3包括控制芯片31、手持设备电源模块32、操纵模块33、显示屏34、报警模块35、手持设备LED指示模块36、手持设备无线通信模块37。
其中,控制芯片31为MCU芯片,操纵模块33、显示屏34、报警模块35、手持设备LED指示模块36、手持设备无线通信模块37分别通过IO接口与控制芯片31相连。
手持设备电源模块32包括手持设备电源、手持设备电源检测电路、手持设备电源保护电路。
手持设备3采用电池供电,手持设备电源为供电电压为3.3V或5V的直流电源;其中,手持设备电源保护电路上设计有防反接、浪涌及大电流保护的电路,此为现有技术中,不再赘述。手持设备电源检测电路用于实时监测电池使用情况以便使用人员实时更换电池或充电。
操纵模块33用于按照控制需求通过按键和摇杆控制扒谷机器人前行、停止、关机、左转、右转,其指令通过无线通信模块发送。
显示屏34用于显示仓库内红外摄像头的监控画面。
报警模块35用于显示扒谷机器人的报障情况,并通过手持设备LED指示模块36的LED灯闪烁等设置通知工作人员手工解决现场问题。
手持设备无线通信模块37用于在手持设备3和扒谷机器人主控制板1之间进行通信.操纵模块33用于按照控制需求通过按键和摇杆控制扒谷机器人前行、停止、关机、左转、右转,其指令通过无线通信模块37发送至扒谷机器人的主控制板1。
在实际工作中,本实施例的设备安装参考如下:
测距模块21为超声波探测器组件。该超声波探测器组件包括:超声波探测器模块、超声波探测器控制板、壳体以及转接件。该转接件一端通过螺栓锁紧扒谷机,另一端连接壳体。该超声波探测器模块焊接在探测器控制板上,探测器控制板固定在壳体内部,该壳体满足IP6X的防尘要求。
超声波探测组件在扒谷机前、左、右侧机架上各安装一组,一组为两个,两个超声波探测器模块需安装要求在机架上的一条铅垂线上,两个探测器间距10cm。
无线通信模块5采用无线信号传输,优选地,无线通信模块选取2.4G吸盘天线直接吸附在扒谷机机架前端。
金属探测器组件包括:金属探测器模块和转接件。转接件一端通过螺栓锁紧扒谷机机架,另一端固定金属探测器模块。金属探测器组件在扒谷机左、右各安装一个金属探测器,离地高度10cm。金属探测器模块通过接插件与控制主板连接。
本实施例中的超声波测距传感器采用深圳导向技术公司的KS103.KS10R型号;金属探测器采用惠州福科机械设备有限公司的常开NPN型电感式接近开关或非接触式金属检测接近传感器。手持设备的显示屏采用2.4寸TFT液晶屏。主控制板MCU采用TI品牌MSP430G2553IPW28R型号;操纵模块的控制摇杆采用JoyStick Shield V1。
本实施例的设计方式,通过将信号发送至手持设备,进行远程操控,只在有问题时触发报警需要人工介入,能够解决扒谷机作业环境恶劣造成工作人员身体伤害的问题。同时,增加了温湿度探测和报警功能,能够第一时间预防火灾的发生,出现机器卡死的情况也能快速通知仓库外人员,体现了较好的智能性和环保水平。
本发明还提供了一种扒谷机器人的控制方法,其实施例包括以下步骤:
S1搭建硬件:搭建本发明上述实施例公开的扒谷机器人控制***;
S2设置传感器:在垂直于地面的同一条线上,在扒谷机器人机架上的高、低两个位置分别设置若干测距模块21和金属探测模块23;主控制板1根据高、低位置的探测结果进行判断:
S3主控制板1控制扒谷机器人前进;
S4测距模块21与主控制板1共同避让障碍物:若测距模块21两个位置的传感器测距结果相等,则为墙壁,设置主控制板在此信号下输出避让指令;若所测距离不等,经计算得到是一个斜面,则为谷堆,设置主控制板在此信号下输出扒谷指令;
S5金属探测模块23与主控制板1共同避让金属地笼:根据金属探测器的测量确定是否接近金属地笼,如果接近地笼则设置主控制板输出避让指令;
S6若没有阻碍,则继续前进,直到机器到达粮堆,然后调整好机器的方向和位置等,开始进行扒谷动作;
S7在完成一次扒谷任务之后,通过测距模块21的传感器判断附近是否还有粮食只需机器原地转向就可以开始扒谷作业:若有,则根据传感器感知到的粮食位置和障碍物情况等,计算扒谷机转弯的方向和角度,微调之后开始扒谷;若无,则采用传感器进行比较大范围的粮堆寻找,直至传感器探测不到谷堆;
S8在步骤S3中,若没有找到粮堆,则主控制器1输出指令,使扒谷机器人先向左转弯90°,机器前进,继续寻找粮堆,若还没有找到粮堆,则再向右转弯180°,机器前进,继续寻找粮堆,若仍然没有找到粮堆,则认为粮仓没有粮食了,此处采用能够覆盖整个粮仓的传感器;
S9在步骤S4和S5中,
若机器向着粮堆前进过程中,遇到阻碍,则对障碍物的类型进行识别;
若为墙壁,则直接开启避障操作,之后若机器能够移动,则利用传感器进行环境感知,如若机器不能移动,则停机;
若为地笼,则进行地笼预警,提醒工人可能需要进行地笼的拆除,同时对地笼预警的次数和时间进行记录;
设置相邻两次预警的时间间隔阈值,当地笼预警次数大于等于3次之后,对相邻两次预警的时间间隔进行计算,判断其是否小于阈值,时间间隔太短,则表明机器“卡死”在地笼中,则停机,并通过声光报警模块24提示需要人工进行处理,仓外人员在手持设备3上也可以收到报警提示;若地笼预警次数小于3次,或相邻两次预警时间间隔大于阈值,则继续工作;
S10步骤S4与步骤S5中所述的避让指令为:避障过程中,若左侧无障碍,则对前方有无障碍物进行判断:若无,则进行左转弯,否则进行后退,重新进行障碍物方位感知;
在避障过程中,若左侧有障碍物,则判断右侧是否有障碍,若右侧无障碍,则同样判断前方是否有障碍:若无,则进行右转弯,否则后退,重新进行障碍物方位感知;
在避障过程中,若左侧和右侧均有障碍,则判断前方是否有障碍:若无,则可继续前进,若有,则表明机器前方和左、右侧均有障碍物,表示“卡死”,不能移动,主控制板输出报警命令。
上述工作流程为在实际工作过程中,对于本发明的扒谷机器人的实际操作方法的实施例,其解决了当前扒谷机器人人工介入时间长、特殊工作环境对于人体损害程度大的问题,同时,通过主控制器内的内置算法,提高了扒谷机器人的信息化程度和智能化水平,符合当前智慧农业的发展需求,具有较好的市场价值。
以上所述并非对本发明的技术范围作任何限制,故凡是依照本发明的技术实质对以上实施例所做的任何细微修改、等同变化与修饰,均仍属于本发明技术方案的范围内。
Claims (9)
1.一种扒谷机器人控制***,包括扒谷机器人及其控制***,所述扒谷机器人包括机架,所述机架上设有自行走机构、扒谷输送装置以及驱动电机;
其特征在于,
所述控制***包括主控制板(1)、环境监测传感***(2)以及手持设备(3);所述主控制板(1)分别与所述环境监测传感***(2)、所述手持设备(3)相连;
所述主控制板(1)设置在扒谷机器人内,所述环境监测传感***(2)的传感设备设置在扒谷机器人的机架上,所述手持设备(3)在仓外,由工作人员操控,用于帮助场外人员远程监控粮仓内的扒谷机器人;
所述主控制板(1)接收所述环境监测传感***(2)的信号;
所述自行走机构、扒谷输送装置与驱动电机与所述主控制板(1)相连,并与其进行信号的收发,执行所述主控制板(1)的命令,
所述环境监测传感***(2)包括测距模块(21)、金属探测模块(23)、温湿度测试模块(22)、声光报警模块(24);
所述测距模块(21)设置在扒谷机器人的机架上,用于监测扒谷机器人周围的障碍物情况;
所述金属探测模块(23)设置在扒谷机器人自行走机构底盘上,用于探测扒谷机器人是否接近仓库里的金属地笼;
所述温湿度测试模块(22)设置在扒谷机器人机架上,用于检测扒谷机器人工作环境中的温度和湿度,
所述手持设备(3)包括控制芯片(31)、手持设备电源模块(32)、操纵模块(33)、显示屏(34)、报警模块(35)、手持设备LED指示模块(36)、手持设备无线通信模块(37);
所述手持设备电源模块(32)包括手持设备电源、电源检测电路和电源保护电路;
所述手持设备电源为直流电池;所述电源检测电路用于调节输出并检测电源电压,所述电源保护电路包括二极管及保险丝,用于防反接、浪涌及大电流保护,电源检测电路实时监测直流电池使用情况以便使用人员实时更换直流电池或充电;
所述控制芯片(31)为MCU芯片,所述操纵模块(33)、显示屏(34)、报警模块(35)、手持设备LED指示模块(36)、手持设备无线通信模块(37)分别通过IO接口与控制芯片(31)相连;
所述手持设备无线通信模块(37)用于在手持设备(3)和扒谷机器人主控制板(1)之间进行通信;
所述操纵模块(33)用于按照控制需求通过按键和摇杆控制扒谷机器人前行、停止、关机、左转、右转,其指令通过无线通信模块(37)发送至扒谷机器人的主控制板(1);
所述显示屏(34)用于显示仓库内红外摄像头的监控画面。
2.根据权利要求1所述的扒谷机器人控制***,其特征在于,
所述控制***还包括串口通信模块(4)、无线通信模块(5)和电源模块(6);
所述串口通信模块(4)一端与所述主控制板相连,一端与所述驱动电机的控制板相连,用于完成控制***与驱动电机控制板之间的数据交换以及相关控制指令的传输;
所述无线通信模块(5)与所述主控制板(1)相连,所述手持设备(3)通过所述无线通信模块(5)与主控制板(1)通信;
所述无线通信模块(5)通过网络将扒谷机器人工作状况发送给仓外的所述手持设备;仓外的工作人员通过手持设备,可实时掌握扒谷机器人的工作情况并及时进行人工介入、取走地笼的操作,遇到其他紧急情况可以及时通过外部无线遥控设备关闭扒谷机。
3.根据权利要求2所述的扒谷机器人控制***,其特征在于,
所述电源模块(6)包括电源(61)、电源调理电路(62)、电源检测电路(63)和防浪涌保护电路(64);
所述电源(61)为24VDC电源,通过所述电源调理电路(62)后分别得到可供主控制板(1)的芯片和***模块使用的5.0VDC和3.3VDC电压电源;
所述电源检测电路(63)用于测试电源电压,防止对设备的伤害;
所述防浪涌保护电路(64)防止反接对电路的伤害,包括TVS二极管和自恢复保险丝;
所述TVS二极管其可防止浪涌和静电对电路的伤害,所述自恢复保险丝可防止后续电路出现故障时对电源电路以及控制电路的伤害。
4.根据权利要求3所述的扒谷机器人控制***,其特征在于,
所述控制***还包括继电器控制模块(7)和LED指示模块(8),所述继电器控制模块(7)主要用来控制外部需要电压供电的设备;
所述LED指示模块(8),用于判断控制***的工作是否正常,以及通过指示灯的亮灭判断控制***的故障;
所述控制***还留有冗余接口,用于后续功能的增加。
5.根据权利要求4所述的扒谷机器人控制***,其特征在于,
所述测距模块(21)为超声波探测器组件;
所述超声波探测器组件包括:超声波探测器模块、超声波探测器控制板、壳体以及转接件;所述转接件一端通过螺栓锁紧扒谷机,另一端连接壳体;所述超声波探测器模块焊接在所述超声波探测器控制板上,所述超声波探测器控制板固定在壳体内部。
6.一种扒谷机器人的控制方法,其特征在于,包括以下步骤:
S1搭建硬件:搭建权利要求1-5之一所述的扒谷机器人控制***;
S2设置传感器:在垂直于地面的同一条线上,在扒谷机器人机架上的高、低两个位置分别设置若干测距模块(21)和金属探测模块(23);主控制板(1)根据高、低位置的探测结果进行判断:
S3主控制板(1)控制扒谷机器人前进;
S4测距模块(21)与主控制板(1)共同避让障碍物:若测距模块(21)不同位置的传感器测距结果相等,则为墙壁,设置主控制板在此信号下输出避让指令;若所测距离不等,经计算得到是一个斜面,则为谷堆,设置主控制板在此信号下输出扒谷指令;
S5金属探测模块(23)与主控制板(1)共同避让金属地笼:根据金属探测器的测量确定是否接近金属地笼,如果接近地笼则设置主控制板输出避让指令;
S6若没有阻碍,则继续前进,直到机器到达粮堆,然后调整好机器的方向和位置,开始进行扒谷动作;
S7在完成一次扒谷任务之后,通过测距模块(21)的传感器判断附近是否还有粮食;若有,则根据传感器感知到的粮食位置和障碍物情况,计算扒谷机转弯的方向和角度,微调之后开始扒谷;若无,则采用传感器进行大范围的粮堆寻找,直至传感器探测不到谷堆。
7.根据权利要求6所述的控制方法,其特征在于,还包括以下步骤:
S8在步骤S3中,若没有找到粮堆,则主控制器(1)输出指令,使扒谷机器人先向左转弯90°,机器前进,继续寻找粮堆,若还没有找到粮堆,则再向右转弯180°,机器前进,继续寻找粮堆,若仍然没有找到粮堆,则认为粮仓没有粮食了,此处采用能够覆盖整个粮仓的传感器。
8.根据权利要求6所述的控制方法,其特征在于,还包括以下步骤:
S9在步骤S4和S5中,
若机器向着粮堆前进过程中,遇到阻碍,则对障碍物的类型进行识别;
若为墙壁,则直接开启避障操作,之后若机器能够移动,则利用传感器进行环境感知,如若机器不能移动,则停机;
若为地笼,则进行地笼预警,提醒工人可能需要进行地笼的拆除,同时对地笼预警的次数和时间进行记录;
设置相邻两次预警的时间间隔阈值,当地笼预警次数大于等于3次之后,对相邻两次预警的时间间隔进行计算,判断其是否小于阈值,时间间隔太短,则表明机器“卡死”在地笼中,则停机,并通过声光报警模块(24)提示需要人工进行处理,仓外人员在手持设备(3)上也可以收到报警提示;若地笼预警次数小于3次,或相邻两次预警时间间隔大于阈值,则继续工作。
9.根据权利要求8所述的控制方法,其特征在于,还包括以下步骤:
S10步骤S4与步骤S5中所述的避让指令为:避障过程中,若左侧无障碍,则对前方有无障碍物进行判断:若无,则进行左转弯,否则进行后退,重新进行障碍物方位感知;
在避障过程中,若左侧有障碍物,则判断右侧是否有障碍,若右侧无障碍,则同样判断前方是否有障碍:若无,则进行右转弯,否则后退,重新进行障碍物方位感知;
在避障过程中,若左侧和右侧均有障碍,则判断前方是否有障碍:若无,则可继续前进,若有,则表明机器前方和左、右侧均有障碍物,表示“卡死”,不能移动,主控制板输出报警命令。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610418330.1A CN105929828B (zh) | 2016-06-12 | 2016-06-12 | 一种扒谷机器人控制***及控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610418330.1A CN105929828B (zh) | 2016-06-12 | 2016-06-12 | 一种扒谷机器人控制***及控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105929828A CN105929828A (zh) | 2016-09-07 |
CN105929828B true CN105929828B (zh) | 2019-01-18 |
Family
ID=56833988
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610418330.1A Active CN105929828B (zh) | 2016-06-12 | 2016-06-12 | 一种扒谷机器人控制***及控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105929828B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110282449A (zh) * | 2019-06-05 | 2019-09-27 | 安徽跃锐智能设备有限公司 | 一种智能扒谷机控制*** |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106629097A (zh) * | 2017-01-24 | 2017-05-10 | 中储粮成都粮食储藏科学研究所 | 一种智能扒谷机 |
CN106842213A (zh) * | 2017-03-16 | 2017-06-13 | 中国电子科技集团公司第三十八研究所 | 一种用于散粮出仓设备的周围环境感知***与方法 |
CN107450433A (zh) * | 2017-08-15 | 2017-12-08 | 合肥横冲机械科技有限公司 | 一种粮食输送机的远程控制*** |
CN107484821A (zh) * | 2017-08-21 | 2017-12-19 | 安徽信息工程学院 | 具有远程遥控功能的翻晒收集机 |
CN108886976B (zh) * | 2018-08-03 | 2021-03-09 | 武汉轻工大学 | 平粮机器人及平粮机器人*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2665081Y (zh) * | 2003-11-10 | 2004-12-22 | 刘永起 | 移动式散粮出仓机 |
US20120163947A1 (en) * | 2010-12-22 | 2012-06-28 | Sukup Manufacturing Company | Variable speed sweep system |
US20150105915A1 (en) * | 2013-10-16 | 2015-04-16 | Chris Nelson | System and method for multiple sweep proximity sensing and control |
CN105469565A (zh) * | 2015-08-05 | 2016-04-06 | 富锦市立兴植保机械制造有限公司 | 扒粮输送机遥控*** |
CN205222149U (zh) * | 2015-12-14 | 2016-05-11 | 安徽理工大学 | 基于dsp控制的散粮装车装置 |
CN205880657U (zh) * | 2016-06-12 | 2017-01-11 | 安徽博微长安电子有限公司 | 一种扒谷机器人控制*** |
-
2016
- 2016-06-12 CN CN201610418330.1A patent/CN105929828B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN2665081Y (zh) * | 2003-11-10 | 2004-12-22 | 刘永起 | 移动式散粮出仓机 |
US20120163947A1 (en) * | 2010-12-22 | 2012-06-28 | Sukup Manufacturing Company | Variable speed sweep system |
US20150105915A1 (en) * | 2013-10-16 | 2015-04-16 | Chris Nelson | System and method for multiple sweep proximity sensing and control |
CN105469565A (zh) * | 2015-08-05 | 2016-04-06 | 富锦市立兴植保机械制造有限公司 | 扒粮输送机遥控*** |
CN205222149U (zh) * | 2015-12-14 | 2016-05-11 | 安徽理工大学 | 基于dsp控制的散粮装车装置 |
CN205880657U (zh) * | 2016-06-12 | 2017-01-11 | 安徽博微长安电子有限公司 | 一种扒谷机器人控制*** |
Non-Patent Citations (3)
Title |
---|
大产量移动式散粮进出仓设备的开发和应用;姜少云等;《粮食现代物流》;20081231;全文 * |
平房仓散粮组合式出仓机的研究与开发;赵祥涛等;《粮食储藏》;20041231;全文 * |
远程控制粮食出仓机的研制;王洪成;《粮食与饲料工业》;20111231(第3期);第23-24页 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110282449A (zh) * | 2019-06-05 | 2019-09-27 | 安徽跃锐智能设备有限公司 | 一种智能扒谷机控制*** |
Also Published As
Publication number | Publication date |
---|---|
CN105929828A (zh) | 2016-09-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105929828B (zh) | 一种扒谷机器人控制***及控制方法 | |
CN110917540B (zh) | 一种消防机器人***及方法 | |
CN201164675Y (zh) | 隧道消防应急智能机器人*** | |
CN102773921B (zh) | 混凝土搅拌车及其和混凝土泵送设备的匹配作业方法、*** | |
CN205992276U (zh) | 一种全自动巡视报警机器人 | |
CN105014654A (zh) | 智能巡检机器人 | |
CN206287145U (zh) | 一种小区安防机器人控制*** | |
CN203598398U (zh) | 一种自动循迹的火灾监控及定向灭火*** | |
CN104385274B (zh) | 用于应对地铁突发事件的应急处置机器人 | |
CN106817403A (zh) | 基于北斗一代卫星通信的危险品监控*** | |
CN107150342B (zh) | 一种工业机器人及其工业机器人避障*** | |
CN205880657U (zh) | 一种扒谷机器人控制*** | |
CN110421597A (zh) | 一种机器人控制的自动开关门***及其控制方法 | |
CN105297781B (zh) | 一种井盖异常报警装置 | |
CN104952204A (zh) | 一种智能安防移动监测平台 | |
CN109826661A (zh) | 电磁阀驱动器及液压支架控制*** | |
CN108628209A (zh) | 一种建筑工程检测安全装置 | |
CN104112337B (zh) | 输电线路通道保护报警*** | |
CN203600433U (zh) | 混凝土搅拌站粉料仓综合监控装置 | |
CN105480417A (zh) | 一种智能无人飞行器 | |
CN205647796U (zh) | 一种安防领域智能监控车 | |
CN205563905U (zh) | 具有自动巡检功能的电力仓库配送运输车 | |
CN104217519A (zh) | 变电站及易燃场所火灾报警机器人 | |
CN116238556A (zh) | 一种基于人工智能的车钩自动摘复方法 | |
CN201673396U (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 |