CN115009791B - 山地果园单轨运输机智能控制***及其控制方法 - Google Patents
山地果园单轨运输机智能控制***及其控制方法 Download PDFInfo
- Publication number
- CN115009791B CN115009791B CN202210787119.2A CN202210787119A CN115009791B CN 115009791 B CN115009791 B CN 115009791B CN 202210787119 A CN202210787119 A CN 202210787119A CN 115009791 B CN115009791 B CN 115009791B
- Authority
- CN
- China
- Prior art keywords
- conveyor
- direct current
- main controller
- current motor
- rotating speed
- 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
Images
Classifications
-
- 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
- B65G35/00—Mechanical conveyors not otherwise provided for
-
- 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
- B65G43/00—Control devices, e.g. for safety, warning or fault-correcting
Landscapes
- Engineering & Computer Science (AREA)
- Mechanical Engineering (AREA)
- Electric Propulsion And Braking For Vehicles (AREA)
Abstract
本发明公开了一种山地果园单轨运输机智能控制***及其控制方法,***包括:运输机、运输轨道和控制子***;控制子***包括:主控制器、防溜车检测组件、姿态传感器、直流电机、执行器和失电制动器;防溜车检测组件包括第一霍尔传感器和第一磁钢;第一磁钢均匀安装在直流电机的旋转轴外周;第一霍尔传感器检测直流电机实际的转速和转动方向;主控制器根据直流电机的实际转动方向和操作指令的行驶方向是否一致,确定是否存在溜车情况,并根据运输机的行驶姿态,判断其处于上坡段、下坡段或平路段,按路段不同以不同的制动模式通过执行器控制失电制动器的制动情况。本发明能够实现上坡溜车检测、下坡稳定控速和能量回收功能。
Description
技术领域
本发明涉及山地运输机控制技术领域,更具体的说是涉及一种山地果园单轨运输机智能控制***及其控制方法。
背景技术
目前,山地果园农资运送大多依靠人工作业,生产效率低,劳动强度大,生产安全难以保障。以轨道运输机为代表的无人运送装备能够适应复杂地形环境,具有结构简单、爬坡能力强、安全易用等特点,适合丘陵山地果园的生产作业。
但是传统的齿轮传动***不具备自锁功能,这使得采用齿轮传动装置的单轨运输机在满载上下坡时容易出现溜车和飞车现象,存在一定的安全隐患。同时,不具备能量回收功能。
因此,如何提供一种兼具下坡稳定控速、上坡溜车检测以及能量回收功能的山地果园单轨运输机智能控制***及其控制方法,是本技术领域人员亟需解决的问题。
发明内容
有鉴于此,本发明提供了一种山地果园单轨运输机智能控制***及其控制方法,能够实现上坡溜车检测、下坡稳定控速和能量回收功能。
为了实现上述目的,本发明采用如下技术方案:
一种山地果园单轨运输机智能控制***,包括:运输机、运输轨道和控制子***;
所述控制子***包括:主控制器、防溜车检测组件、姿态传感器、直流电机、执行器和失电制动器;
所述防溜车检测组件包括第一霍尔传感器和第一磁钢;所述第一磁钢均匀安装在所述直流电机的旋转轴外周;所述第一霍尔传感器安装在所述直流电机旋转轴的正上方,用于感应所述第一磁钢的磁场信号,并根据磁场信号检测所述直流电机实际的转速和转动方向;所述主控制器根据所述直流电机的实际转动方向和操作指令的行驶方向是否一致,确定是否存在溜车情况,并在存在溜车情况时,通过所述执行器控制所述失电制动器进行制动;
所述姿态传感器用于检测所述运输机在所述运输轨道上的行驶姿态;
所述主控制器根据所述运输机的行驶姿态,判断其处于上坡段、下坡段或平路段,按路段不同以不同的制动模式通过所述执行器控制所述失电制动器的制动情况。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:电机控制器和锂电池;
所述电机控制器用于切换所述直流电机处于驱动模式或发电模式;
所述主控制器用于在所述运输机处于下坡段且满足发电条件时,通过所述执行器控制所述电机控制器将所述直流电机的工作模式由驱动模式切换为发电模式,且使发电电能回收至所述锂电池。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:发电模式控速模块;
所述发电模式控速模块用于在所述直流电机处于发电模式,且转速超出安全转速时,采用能耗电阻将未被所述锂电池回收的部分电能进行消耗,使转速维持在安全转速上下预设范围内。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:自动停车检测组件;所述自动停车检测组件包括:第二霍尔传感器和第二磁钢;所述第二霍尔传感器安装在所述运输机机头的下侧;所述第二磁钢设置有两个,分别吸附在所述运输轨道的始末两端的侧面;所述第二霍尔传感器和所述第二磁钢均位于所述运输轨道的同一侧;
所述主控制器用于判断所述第二霍尔传感器检测到的所述第二磁钢的磁场信号是否达到阈值,并在达到阈值时,通过所述执行器控制所述失电制动器进行制动。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:多组控制按键;所述控制按键与所述主控制器连接,其用于控制所述运输机的前进、后退和停止。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:信号接收器和远程遥控器;所述信号接收器分别与多组所述控制按键并联;所述远程遥控器与所述信号接收器无线连接。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:称重传感器;所述称重传感器与所述主控制器连接,其用于测量所述运输机的实际装载重量;所述主控制器结合所述运输机的行驶姿态和实际装载质量,判断是否存在侧翻风险,并在存在侧翻风险时,通过所述执行器控制所述失电制动器制动。
进一步的,在上述一种山地果园单轨运输机智能控制***中,所述控制子***还包括:声光报警器;所述声光报警器与所述主控制器连接;所述主控制器用于在存在超载、驾驶姿态异常时,控制所述声光报警器发出声光警报。
本发明还提供一种山地果园单轨运输机智能控制***的控制方法,其适用于一种山地果园单轨运输机智能控制***,包括:分段式制动控制方法,包括以下步骤:
S1、主控制器根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处在上坡段或下坡段,若是,执行S2,否则,执行S5;
S2、若运输机处于上坡段,且主控制器检测到存在触发制动信号,则执行S7;
S3、若运输机处于下坡段,且主控制器检测到存在触发制动信号,则主控制器开启500ms的计时器计时,并通过第一霍尔传感器检测电机转速,判断计时器是否完成500ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7;
S4、若运输机处于上坡段,但主控制器未检测到触发制动信号,则根据第一霍尔传感器检测的电机实际转动方向和操作指令的行驶方向判断运输机是否发生溜车,若第一霍尔传感器检测的电机转动方向和操作指令的行驶方向不一致,则发生溜车,执行S7;
S5、根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处于平路段制动,若是,则主控制器开启1000ms计时器计时,并通过第一霍尔传感器检测电机转速;
S6、判断计时器是否完成1000ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7;
S7、失电制动器制动停车。
进一步的,在上述一种山地果园单轨运输机智能控制***的控制方法中,还包括:运输机处于下坡段时,进行能量回收,包括以下步骤:
S1'、设定直流电机的发电条件:运输机姿态满足:水平面倾斜角α>α0,直流电机的实际转速N满足:N0<N<N1;设定发电模式下直流电机的安全转速N2;
S2'、通过姿态传感器获取运输机所处的姿态信息,通过第一霍尔传感器检测直流电机的实际转速和转动方向;
S3'、判断是否满足发电条件,若是,则执行S4',否则,保持直流电机驱动模式;
S4'、主控制器通过执行器控制电机控制器将直流电机的工作模式由驱动模式切换为发电模式,进行能量回收;
S5'、通过第一霍尔传感器检测直流电机的转速和转动方向;
S6'、判断在发电模式下直流电机实际转速是否超出设定的安全转速N2,若是,则执行S7',否则,执行S8';
S7'、接入能耗电阻,计算主控制器所需输出PWM波占空比的大小,将直流电机的实际转速控制在发电模式下的安全转速N2上下预设范围内;
S8'、判断在发电模式下直流电机的实际转速是否低于设定下坡驱动模式下的直流电机转速N0,若是,则主控制器通过执行器控制电机控制器将直流电机的工作模式由发电模式切换为驱动模式,为运输机提供动力。
经由上述的技术方案可知,与现有技术相比,本发明公开提供了一种一种山地果园单轨运输机智能控制***及其控制方法,具备以下有益效果:
1、本发明通过姿态传感器检测运输机在运输轨道上的姿态信息,确定坡度信息,并将路段划分为上坡段、下坡段和平路段,主控制器根据不同的路段对失电制动器分段式制动。在当运输机处于上坡段进行制动时,为防止发生溜车,上坡制动失电制动器立即采取制动;当运输机处于下坡段进行制动时,立即制动会对运输机冲击较大,下坡制动失电制动器延迟制动能够有效减少下坡制动冲击;当运输机处于平路段进行制动时,为使得运输机平缓停车,减少对果品等冲击损伤,失电动器延迟制动,实现平路缓停车。
2、本发明在电机旋转轴上安装双向霍尔传感器,通过双向霍尔传感器实时采集运输机的行驶速度和行驶方向,实现运输机下坡过程中能量回收,且能够准确判断运输机是否发生溜车,使得运输机具备能量回收和防止溜车的功能,提升了运输机的续航里程和安全性。
3、本发明采用霍尔传感器非接触式的感应方式替代了采用首尾安装机械触发式行程开关的方式实现自动停车,极大地降低了运输机在行驶过程中由于山地果园荒草杂物误触发导行程开关导致停车的情况,提升了用户使用体验。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明的实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据提供的附图获得其他的附图。
图1为本发明提供的山地果园单轨运输机智能控制***的结构框图;
图2为本发明提供的运输机的结构示意图;
图3为本发明提供的运输机机头局部示意图;
图4为本发明提供的防溜车检测组件的结构示意图;
图5为本发明提供的第一霍尔传感器脉冲信号相位示意图;
图6为本发明提供的自动停车检测组件的结构示意图;
图7为本发明提供的霍尔信号处理电路图;
图8为本发明提供的信号输入、输出隔离电路图;
图9为本发明提供的直流电机驱动模式与发电模式切换框图;
图10为本发明提供的发电模式下控速原理图;
图11为本发明提供的分段式制动控制方法的流程图;
图12为本发明提供的能量回收步骤的流程图;
图13为本发明提供的运输机运行过程的总控流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
如图1-4所示,本发明实施例公开了一种山地果园单轨运输机智能控制***,包括:运输机1、运输轨道2和控制子***3;
控制子***3包括:主控制器301、防溜车检测组件、姿态传感器302、直流电机303、执行器304和失电制动器305;
防溜车检测组件包括第一霍尔传感器306和第一磁钢307;第一磁钢307均匀安装在直流电机303的旋转轴外周,具体可由8个圆饼磁钢组成阵列式结构,在电机旋转轴上均匀安装与电机旋转轴同步旋转;第一霍尔传感器306安装在直流电机303旋转轴的正上方,用于感应第一磁钢307的磁场信号,并根据磁场信号检测直流电机303实际的转速和转动方向;主控制器301根据直流电机303的实际转动方向和操作指令的行驶方向是否一致,确定是否存在溜车情况,并在存在溜车情况时,通过执行器304控制失电制动器305进行制动;
姿态传感器302用于检测运输机1在运输轨道上的行驶姿态;
主控制器301根据运输机1的行驶姿态,判断其处于上坡段、下坡段或平路段,按路段不同以不同的制动模式通过执行器304控制失电制动器305的制动情况。
其中,主控制器301采用ATMEGA328单片机,第一霍尔传感器306采用双向霍尔传感器;主控制器301分别与第一霍尔传感器306、姿态传感器302和执行器304连接;执行器304与失电制动器305连接;执行器304为继电器执行器;失电制动器305安装直流电动机尾部,采用DC48V电源供电,主控制器301通过继电器执行器304控制失电制动器305的导通与关断,为运输机1提供制动力矩。
如图5所示,第一霍尔传感器306输出两路信号,即A相、B相。当直流电机303正转时,输出脉冲信号A相超前于B相;当直流电机303反转时,输出脉冲信号B相超前于A相。主控制器301通过读取双向霍尔传感器的相位信息,计算出运输机的运行速度和行驶方向,通过与操作指令输入的执行信号进行比对判断运输机是否出现溜车。
具体而言,姿态传感器302固定安装在运输机1机头内部中间位置,可以检测运输机X轴、Y轴和Z轴方向上的角度信息和加速度信息,以确定运输机1的行驶姿态,通过串口通信向的方式向主控制器301发送姿态信息,主控制器301根据采集到的X轴角度信息进行路况分段制动,通过Y轴采集到的角度信息对运输机进行防侧翻控制。通过检测到的坡度信息进行路段的划分,划分为上坡段、下坡段和平路段,主控制器根据不同的路段对运输机进行分段式制动:①当运输机处于上坡段进行制动时,为防止发生溜车,失电制动器立即采取制动;②当运输机处于下坡段进行制动时,由于运输机具有一定的动能和重力,立即制动会对运输机冲击较大,此时,失电制动器延迟制动,能够有效减少下坡制动冲击;③当运输机处于平路段进行制动时,为使得运输机平缓停车,减少对果品等冲击损伤,制失电动器延迟制动,实现平路缓停车的功能。
在一个具体实施例中,如图2所示,运输机1包括:机头101、拖车连接件102、运输拖车103和电池箱104,运输机1骑跨在运输轨道2上,运输拖车103通过拖车连接件102与机头101,连接并由机头101拖动或推动。
在一个实施例中,控制子***还包括:电机控制器308和锂电池309;锂电池安装在电池箱104内;
电机控制器308用于切换直流电机303处于驱动模式或发电模式;
主控制器301用于在运输机1处于下坡段且满足发电条件时,通过执行器304控制电机控制器308将直流电机303的工作模式由驱动模式切换为发电模式,且使发电电能回收至锂电池309。
更有利的,控制子***3还包括:发电模式控速模块310;
发电模式控速模块310用于在直流电机303处于发电模式,且转速超出安全转速时,采用能耗电阻将未被锂电池309回收的部分电能进行消耗,使转速维持在安全转速上下预设范围内。
如图9所示,主控制器301通过脉宽调制的方法进行直流电机303在驱动模式下和发电模式下转速的调节,根据调整PWM波占空比输出的大小来实现直流电机303驱动模式下转速的控制,实现无级调速和发电模式下下坡稳定控速的功能。主控制器301通过第一霍尔传感器306和姿态传感器307检测到的数据,判断运输机1是否处于下坡段,当处于下坡段,且满足发电条件时,电机控制器308通过切换电路完成直流电机303由驱动模式到电机发电模式的切换,发电的能量通过锂电池309进行回收。
当运输机1处于下坡行驶发电模式时,由于齿轮传动装置不具备自锁功能,重力作用在坡面方向上的分力做功会使其加速运行,而锂电池309的充电效率有限,通过发电模式控速模块310对未能回收的部分电能采取能耗制动的方式消耗掉,以保证下坡直流电机303发电模式下的稳定控速,防止飞车事故的发生和防止反向充电电流过大损坏锂电池309。
具体的,如图10所示,当直流电机303处于发电模式下时,直流电机303作为发电机发电,其中M为直流电机,Ra为电机电枢绕组的内阻,La为电枢电感,发电机以恒流模式给锂电池反向充电,由于重力持续做功,重力势能不断转化为动能,电机发电的能量回收达到最大效率时,且直流电机转速仍持续增加,为保护锂电池和防止飞车事故发生需稳定控制下坡速度,通过切换开关K在发电回路中接入能耗电阻Rz,主控制器通过脉宽调制的方法调整PWM波占空比的输出大小来实现对晶体管Q1的导通,以达到发电模式下对运输机下坡稳定控速的目的,该电路设计实现了运输机在下坡行驶过程中具备能量回收和稳定控速的功能,提升了运输的续航里程和安全性。
在一个实施例中,如图6所示,控制子***3还包括:自动停车检测组件;自动停车检测组件包括:第二霍尔传感器311和第二磁钢312;第二霍尔传感器311安装在运输机1机头101的下侧;第二磁钢312设置有两个,分别吸附在运输轨道2的始末两端的侧面;第二霍尔传感器311和第二磁钢312均位于运输轨道2的同一侧;
主控制器301用于判断第二霍尔传感器311检测到的第二磁钢312的磁场信号是否达到阈值,并在达到阈值时,通过执行器304控制失电制动器305进行制动。
当运输机1行走至运输轨道2始末两端时,安装在运输机上的第二霍尔传感器311检测到第二磁钢312产生的磁场信号,并向主控制器301发送停车信号,主控制器301控制对应的继电器执行器304自锁,使失电制动器305制动停车,此时运输机1停止行驶且不能再次向原来行驶方向继续启动行驶,只允许操纵运输机往反方向行驶,以防止运输机在轨道始末两端冲出轨道,现自动停车的功能,采用第二霍尔传感器非接触式的感应方式替代了采用首尾安装机械触发式行程开关的方式实现自动停车,极大地降低了运输机在行驶过程中由于山地果园荒草杂物误触发导行程开关导致停车的情况,第二磁钢312可以根据用户实际应用需求吸附安装在任意路段的运输轨道侧面,实现运输机在该路段自动停车功能,极大地增加运输机使用的灵活性。
在一个具体实施例中,主控制器301连接有信号输入、输出隔离电路和霍尔信号处理电路。
具体的,如图7所示,为霍尔信号处理电路,以下将第一霍尔传感器和第二霍尔传感器统称为霍尔传感器,将第一磁钢和第二磁钢统称为磁钢。霍尔信号处理电路用于将霍尔传感器采集到的原始信号进行放大和转换为单片机能够读取的电压信号。当磁钢触发霍尔传感器产生A、B两路脉冲信号,A信号经过电阻R1上拉至5V,并通过电容C1进行滤波处理后经双路反相器U1的输出端D2与主控制器连接,B信号经过电阻R4上拉至5V,并通过电容C3进行滤波处理后经双路反相器U1的输出端D3与主控制器连接,VF为双路反相器U1的参考电压端,通过电阻R2和电阻R3分压的作用,该参考电压为2.5V,当霍尔传感器输入的电压高于参考电压,则双路反相器对应输出端输出高电平5V,反之输出低电平0V。霍尔传感器采集到的信号经过霍尔信号处理电路的放大和滤波处理变为单片机能够稳定读取的电压信号。
如图8所示,信号输入、输出隔离电路用于将输入到主控制器的信号和主控制器输出的信号进行隔离,起到保护主控制器的作用。隔离电路主要包含光耦U2、U4,反相器U3,当输入信号IN1输入低电平时,光耦U2引脚C、E导通,主控制器输入端同步输入低电平,实现输入信号隔离的作用;主控制器输出端输出的信号经过反相器的反相作用后连接到光耦U4,当主控制器输出高电平时,光耦U4引脚C、E导通,OUT1输出端输出高电平。
在其他实施例中,控制子***还包括:多组控制按键313;控制按键313与主控制器301连接,其用于控制运输机1的前进、后退和停止。
具体而言,包括三组常开型点动开关,其固定安装在运输机机头101的控制面板上,用于手动控制运输机的前进、后退和停止。
更有利的,控制子***3还包括:信号接收器314和远程遥控器315;信号接收器314分别与多组控制按键313并联;远程遥控器315与信号接收器314无线连接。
信号接收器314固定安装在运输机1的内部,用户通过远程遥控器315遥控端可实现远程无线控制运输机1的前进、后退和停止。
在一个实施例中,控制子***3还包括:称重传感器316;称重传感器316与主控制器301连接,其用于测量运输机1的实际装载重量;主控制器301结合运输机的行驶姿态和实际装载质量,判断是否存在侧翻风险,并在存在侧翻风险时,通过执行器304控制失电制动器305制动。
称重传感器316分别固定安装在运输拖车前、后两端的承重机构105上,用于测量运输机的实际装载重量,防止超载运输带来的安全隐患。
运输机与运输轨道是通过压紧轮和承重轮配合锁紧固定在轨道上,由机头驱动轮采以齿合的方式拖动或推动前后行驶,当载重货物超过最大的装置质量时且货物往一遍偏离会导致运输车沿轨道两边的质量不对称而发生倾斜严重者会导致侧翻,所以需要通过称重传感器检测装载的质量防止超载运行,另外由于使用久了机械松动的问题也有可能或导致运输机侧翻,正常行驶状态下姿态传感器检测到运输机在水平面是在一定安全的范围内,当姿态传感器检测到超出这个安全范围仍继续运行的话就会有侧翻风险,所以此时要控制失电制动器停车并报警给用户进行检查固定,防止继续运行导致侧翻。
更有利的,控制子***3还包括:声光报警器317;声光报警器317与主控制器301连接;主控制器301用于在存在超载、驾驶姿态异常时,控制声光报警器317发出声光警报。
当运输机1出现超载或姿态传感器检测到姿态异常时,主控制器301通过控制对应的继电器执行器304控制失电制动器305,制动运输机1并开启声光报警器317,故障灯闪烁与报警器蜂鸣,提示***出现问题,以便工作人员及时处理。
本发明实施例还提供一种山地果园单轨运输机智能控制***的控制方法,包括:分段式制动控制方法,包括以下步骤:
S1、主控制器根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处在上坡段或下坡段,若是,执行S2,否则,执行S5;
S2、若运输机处于上坡段,且主控制器检测到存在触发制动信号,则执行S7;
S3、若运输机处于下坡段,且主控制器检测到存在触发制动信号,则主控制器开启500ms的计时器计时,并通过第一霍尔传感器检测电机转速,判断计时器是否完成500ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7,否则继续计时和检测电机转速;
S4、若运输机处于上坡段,但主控制器未检测到触发制动信号,则根据第一霍尔传感器检测的电机实际转动方向和操作指令的行驶方向判断运输机是否发生溜车,若第一霍尔传感器检测的电机转动方向和操作指令的行驶方向不一致,则发生溜车,执行S7;
S5、根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处于平路段制动,若是,则主控制器开启1000ms计时器计时,并通过第一霍尔传感器检测电机转速;
S6、判断计时器是否完成1000ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7,否则继续计时和检测电机转速;
S7、失电制动器制动停车。
在另一个实施例中,还包括:运输机处于下坡段时,进行能量回收,包括以下步骤:
S1'、设定直流电机的发电条件:运输机姿态满足:水平面倾斜角α>α0,直流电机的实际转速N满足:N0<N<N1;设定发电模式下直流电机的安全转速N2;
S2'、通过姿态传感器获取运输机所处的姿态信息,通过第一霍尔传感器检测直流电机的实际转速和转动方向;
S3'、判断是否满足发电条件,若是,则执行S4',否则,保持直流电机驱动模式;
S4'、主控制器通过执行器控制电机控制器将直流电机的工作模式由驱动模式切换为发电模式,进行能量回收;
S5'、通过第一霍尔传感器检测直流电机的转速和转动方向;
S6'、判断在发电模式下直流电机实际转速是否超出设定的安全转速N2,若是,则执行S7',否则,执行S8';
S7'、接入能耗电阻,计算主控制器所需输出PWM波占空比的大小,将直流电机的实际转速控制在发电模式下的安全转速N2上下预设范围内;
S8'、判断在发电模式下直流电机的实际转速是否低于设定下坡驱动模式下的直流电机转速N0,若是,则主控制器通过执行器控制电机控制器将直流电机的工作模式由发电模式切换为驱动模式,为运输机提供动力。
如图13所示,本发明主控制器对运输机运行过程的整体控制流程为:
***初始化,并开启串口通信;
读取输入信号;
判断是否有按键按下信号,若是,则判断依次判断是否为前进信号、后退信号和停止信号,若为前进信号,则松开失电制动器,运输机前进;若为后退信号,则松开失电制动器,运输机后退;若为停止信号,则失电制动器制动,运输机停止运行;否则,返回继续读取输入信号;
判断是否存在异常信号,若是,则声光报警器报警,且失电制动器制动,运输机停止运行,否则继续返回读取输入信号。
本说明书中各个实施例采用递进的方式描述,每个实施例重点说明的都是与其他实施例的不同之处,各个实施例之间相同相似部分互相参见即可。对于实施例公开的装置而言,由于其与实施例公开的方法相对应,所以描述的比较简单,相关之处参见方法部分说明即可。
对所公开的实施例的上述说明,使本领域专业技术人员能够实现或使用本发明。对这些实施例的多种修改对本领域的专业技术人员来说将是显而易见的,本文中所定义的一般原理可以在不脱离本发明的精神或范围的情况下,在其它实施例中实现。因此,本发明将不会被限制于本文所示的这些实施例,而是要符合与本文所公开的原理和新颖特点相一致的最宽的范围。
Claims (9)
1.一种山地果园单轨运输机智能控制***,其特征在于,包括:运输机、运输轨道和控制子***;
所述控制子***包括:主控制器、防溜车检测组件、姿态传感器、直流电机、执行器和失电制动器;
所述防溜车检测组件包括第一霍尔传感器和第一磁钢;所述第一磁钢均匀安装在所述直流电机的旋转轴外周;所述第一霍尔传感器安装在所述直流电机旋转轴的正上方,用于感应所述第一磁钢的磁场信号,并根据磁场信号检测所述直流电机实际的转速和转动方向;所述主控制器根据所述直流电机的实际转动方向和操作指令的行驶方向是否一致,确定是否存在溜车情况,并在存在溜车情况时,通过所述执行器控制所述失电制动器进行制动;
所述姿态传感器用于检测所述运输机在所述运输轨道上的行驶姿态;
所述主控制器根据所述运输机的行驶姿态,判断其处于上坡段、下坡段或平路段,按路段不同以不同的制动模式通过所述执行器控制所述失电制动器的制动情况;
所述山地果园单轨运输机智能控制***的控制方法包括:分段式制动控制方法,包括以下步骤:
S1、主控制器根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处在上坡段或下坡段,若是,执行S2,否则,执行S5;
S2、若运输机处于上坡段,且主控制器检测到存在触发制动信号,则执行S7;
S3、若运输机处于下坡段,且主控制器检测到存在触发制动信号,则主控制器开启500ms的计时器计时,并通过第一霍尔传感器检测电机转速,判断计时器是否完成500ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7;
S4、若运输机处于上坡段,但主控制器未检测到触发制动信号,则根据第一霍尔传感器检测的电机实际转动方向和操作指令的行驶方向判断运输机是否发生溜车,若第一霍尔传感器检测的电机转动方向和操作指令的行驶方向不一致,则发生溜车,执行S7;
S5、根据姿态传感器采集的运输机的行驶姿态,判断运输机是否处于平路段制动,若是,则主控制器开启1000ms计时器计时,并通过第一霍尔传感器检测电机转速;
S6、判断计时器是否完成1000ms计时或第一霍尔传感器检测到电机转速降为零,若是,则执行S7;
S7、失电制动器制动停车。
2.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:电机控制器和锂电池;
所述电机控制器用于切换所述直流电机处于驱动模式或发电模式;
所述主控制器用于在所述运输机处于下坡段且满足发电条件时,通过所述执行器控制所述电机控制器将所述直流电机的工作模式由驱动模式切换为发电模式,且使发电电能回收至所述锂电池。
3.根据权利要求2所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:发电模式控速模块;
所述发电模式控速模块用于在所述直流电机处于发电模式,且转速超出安全转速时,采用能耗电阻将未被所述锂电池回收的部分电能进行消耗,使转速维持在安全转速上下预设范围内。
4.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:自动停车检测组件;所述自动停车检测组件包括:第二霍尔传感器和第二磁钢;所述第二霍尔传感器安装在所述运输机机头的下侧;所述第二磁钢设置有两个,分别吸附在所述运输轨道的始末两端的侧面;所述第二霍尔传感器和所述第二磁钢均位于所述运输轨道的同一侧;
所述主控制器用于判断所述第二霍尔传感器检测到的所述第二磁钢的磁场信号是否达到阈值,并在达到阈值时,通过所述执行器控制所述失电制动器进行制动。
5.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:多组控制按键;所述控制按键与所述主控制器连接,其用于控制所述运输机的前进、后退和停止。
6.根据权利要求5所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:信号接收器和远程遥控器;所述信号接收器分别与多组所述控制按键并联;所述远程遥控器与所述信号接收器无线连接。
7.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:称重传感器;所述称重传感器与所述主控制器连接,其用于测量所述运输机的实际装载重量;所述主控制器结合所述运输机的行驶姿态和实际装载质量,判断是否存在侧翻风险,并在存在侧翻风险时,通过所述执行器控制所述失电制动器制动。
8.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,所述控制子***还包括:声光报警器;所述声光报警器与所述主控制器连接;所述主控制器用于在存在超载、驾驶姿态异常时,控制所述声光报警器发出声光警报。
9.根据权利要求1所述的一种山地果园单轨运输机智能控制***,其特征在于,其特征在于,所述山地果园单轨运输机智能控制***的控制方法还包括:运输机处于下坡段时,进行能量回收;包括以下步骤:
S1'、设定直流电机的发电条件:运输机姿态满足:水平面倾斜角α>α0,直流电机的实际转速N满足:N0<N<N1;设定发电模式下直流电机的安全转速N2;
S2'、通过姿态传感器获取运输机所处的姿态信息,通过第一霍尔传感器检测直流电机的实际转速和转动方向;
S3'、判断是否满足发电条件,若是,则执行S4',否则,保持直流电机驱动模式;
S4'、主控制器通过执行器控制电机控制器将直流电机的工作模式由驱动模式切换为发电模式,进行能量回收;
S5'、通过第一霍尔传感器检测直流电机的转速和转动方向;
S6'、判断在发电模式下直流电机实际转速是否超出设定的安全转速N2,若是,则执行S7',否则,执行S8';
S7'、接入能耗电阻,计算主控制器所需输出PWM波占空比的大小,将直流电机的实际转速控制在发电模式下的安全转速N2上下预设范围内;
S8'、判断在发电模式下直流电机的实际转速是否低于设定下坡驱动模式下的直流电机转速N0,若是,则主控制器通过执行器控制电机控制器将直流电机的工作模式由发电模式切换为驱动模式,为运输机提供动力。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210787119.2A CN115009791B (zh) | 2022-07-04 | 2022-07-04 | 山地果园单轨运输机智能控制***及其控制方法 |
PCT/CN2023/079512 WO2024007603A1 (zh) | 2022-07-04 | 2023-03-03 | 山地果园单轨运输机智能控制***及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210787119.2A CN115009791B (zh) | 2022-07-04 | 2022-07-04 | 山地果园单轨运输机智能控制***及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115009791A CN115009791A (zh) | 2022-09-06 |
CN115009791B true CN115009791B (zh) | 2023-03-28 |
Family
ID=83078103
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210787119.2A Active CN115009791B (zh) | 2022-07-04 | 2022-07-04 | 山地果园单轨运输机智能控制***及其控制方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN115009791B (zh) |
WO (1) | WO2024007603A1 (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115009791B (zh) * | 2022-07-04 | 2023-03-28 | 华南农业大学 | 山地果园单轨运输机智能控制***及其控制方法 |
CN115593871B (zh) * | 2022-11-25 | 2023-03-07 | 山东协和学院 | 一种康养医院实验室设备运输机器人及其控制方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4352925B2 (ja) * | 2004-02-17 | 2009-10-28 | アシスト テクノロジーズ ジャパン株式会社 | 無人搬送車のセンサ制御装置及び無人搬送システム |
CN106364495B (zh) * | 2016-10-14 | 2019-11-19 | 华东交通大学 | 一种带自动停车功能的山地果园单轨运输机 |
CN106680530A (zh) * | 2017-02-23 | 2017-05-17 | 北京惠达智农科技有限公司 | 一种非接触式的转速测量装置 |
CN113844470B (zh) * | 2021-09-24 | 2022-10-28 | 华南农业大学 | 一种山地果园自走式电动单轨运输装备及控制方法 |
CN115009791B (zh) * | 2022-07-04 | 2023-03-28 | 华南农业大学 | 山地果园单轨运输机智能控制***及其控制方法 |
-
2022
- 2022-07-04 CN CN202210787119.2A patent/CN115009791B/zh active Active
-
2023
- 2023-03-03 WO PCT/CN2023/079512 patent/WO2024007603A1/zh unknown
Also Published As
Publication number | Publication date |
---|---|
CN115009791A (zh) | 2022-09-06 |
WO2024007603A1 (zh) | 2024-01-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115009791B (zh) | 山地果园单轨运输机智能控制***及其控制方法 | |
CN109229222B (zh) | 一种可自动调整转向的爬楼方法及装置 | |
US8825240B2 (en) | Control device for electric rolling stock | |
CN103273852B (zh) | 一种电动田间搬运车分布式驱动***及其控制方法 | |
JP4723612B2 (ja) | 定位置自動停止制御手段を備えた電気車両の制御装置 | |
CN207790922U (zh) | 智能车辆、智能半挂车及智能半挂车的控制*** | |
CN104079054B (zh) | 一种用于高压输电线路巡线机器人的能量回收***及方法 | |
CN102442290B (zh) | 智能驻车制动及辅助起步控制装置 | |
CN105799550A (zh) | 纯电动汽车防溜坡控制方法 | |
CN107215240A (zh) | 一种电动车的驻坡控制*** | |
CN111775718A (zh) | 一种电动搬运车及其电机制动停车方法 | |
US20150231971A1 (en) | Inverted vehicle and its control method | |
CN109383508A (zh) | 一种智能斜坡行车控制方法及其使用该控制方法的车辆 | |
CN102717801B (zh) | 电动轮非公路自卸车坡起自动防倒滑*** | |
CN207725416U (zh) | 矿车自动刹车及速度控制装置 | |
CN211447972U (zh) | 一种循环式立体车库 | |
CN102874310A (zh) | 一种推土机差速转向的控制方法和*** | |
CN108327578A (zh) | 一种电动车监控***及其控制方法 | |
CN110723653A (zh) | 一种门式起重机突遇大风紧急停车装置以及停车方法 | |
CN2416940Y (zh) | 电驱动滑道车 | |
CN110614920B (zh) | 一种基于重力传感器的智能型电动车 | |
CN106080557A (zh) | 一种遥控自动刹车辅助***和方法 | |
CN105539401B (zh) | 电动车行驶断电防倒滑装置的防倒滑控制方法 | |
CN102501857B (zh) | 一种基于负荷畸变的客运索道安全装置 | |
CN202743236U (zh) | 电动轮非公路自卸车坡起自动防倒滑*** |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
EE01 | Entry into force of recordation of patent licensing contract | ||
EE01 | Entry into force of recordation of patent licensing contract |
Application publication date: 20220906 Assignee: GUANGDONG ZHENSHENG INTELLIGENT EQUIPMENT CO.,LTD. Assignor: SOUTH CHINA AGRICULTURAL University Contract record no.: X2023980042574 Denomination of invention: Intelligent Control System and Its Control Method for Monorail Transporters in Mountain Orchards Granted publication date: 20230328 License type: Exclusive License Record date: 20230927 |