CN108370745A - 一种用于树障清理空中机器人的推挡刀具结构和控制方法 - Google Patents
一种用于树障清理空中机器人的推挡刀具结构和控制方法 Download PDFInfo
- Publication number
- CN108370745A CN108370745A CN201810192093.0A CN201810192093A CN108370745A CN 108370745 A CN108370745 A CN 108370745A CN 201810192093 A CN201810192093 A CN 201810192093A CN 108370745 A CN108370745 A CN 108370745A
- Authority
- CN
- China
- Prior art keywords
- cutter
- circular saw
- push
- robot
- current
- 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
Links
Classifications
-
- 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
- A01G3/00—Cutting implements specially adapted for horticultural purposes; Delimbing standing trees
- A01G3/08—Other tools for pruning, branching or delimbing standing trees
- A01G3/085—Motor-driven saws for pruning or branching
- A01G3/088—Circular saws
-
- H—ELECTRICITY
- H02—GENERATION; CONVERSION OR DISTRIBUTION OF ELECTRIC POWER
- H02G—INSTALLATION OF ELECTRIC CABLES OR LINES, OR OF COMBINED OPTICAL AND ELECTRIC CABLES OR LINES
- H02G1/00—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines
- H02G1/02—Methods or apparatus specially adapted for installing, maintaining, repairing or dismantling electric cables or lines for overhead lines or cables
Landscapes
- Life Sciences & Earth Sciences (AREA)
- Biodiversity & Conservation Biology (AREA)
- Ecology (AREA)
- Forests & Forestry (AREA)
- Environmental Sciences (AREA)
- Sawing (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种用于树障清理空中机器人的推挡刀具结构和控制方法,包括Y型刀具架、安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片圆盘锯、位于圆盘锯的上方和刀具电机前方的推挡器、两根对称固定于刀具架两侧且端部向前向外伸展至圆盘锯下方的导向叉、固定于或内置于刀具架的刀具控制器、位于刀具架后部并与空中机器人机械臂连接的接头,推挡器为面向刀具切割方向的“Ω”形竖直挡板,其后部设有水平的加强板,上部设有弹性的活动推板,下部设有与圆盘锯同厚度且同水平面的水平板。本发明能够将切割后的树枝向前推挡,防止切割结束时上部树枝倒向空中机器人,提高机器人飞行稳定性和安全性。
Description
技术领域
本发明涉及一种用于树障清理空中机器人的推挡刀具结构和控制方法,属于输电线路树障清理装置技术领域。
背景技术
空中机器人在对电力线路通道树障进行清理时,所用刀具应能快速切割树枝,同时又能避免对空中机器人本体姿态的影响,并且具有防卡阻等安全保护措施。
目前园林修剪树枝多采用单锯类型的清理刀具,若将该类刀具直接安装于空中机器人上进行树障清理,刀具的水平受力不对称,给空中机器人带来航向推斥力矩,影响空中机器人力与力矩的平衡,且造成刀具与树枝之间的打滑;实际中的树障呈现各种形态,极易滑出刀具的有效作业区域,导致了刀具切割效率不高,而且切割结束后树枝易倒向机器人方向,造成机器人设备的姿态稳定性,甚至损坏机器人。
发明内容
本发明解决的技术问题是:提供一种用于树障清理空中机器人的推挡刀具结构和控制方法,以解决现有技术中存在的问题。
本发明采取的技术方案为:一种用于树障清理空中机器人的推挡刀具结构,包括Y型刀具架、安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片圆盘锯、位于圆盘锯的上方和刀具电机的前方的推挡器,推挡器与刀具架或刀具电机的底部固定连接。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括两根对称固定于刀具架两侧且端部向前向外伸展至圆盘锯下方的导向叉。
优选的,上述两根导向叉构成“Y”形的前导入槽和“一”字形的后导出槽,前导入槽用于收拢树枝并导向双圆盘锯的共同切割区域,后导出槽用于引导切割后的下方树枝自动向后移动并脱离刀具。
优选的,上述前导入槽的开放角为30-150度。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括固定于或内置于刀具架的刀具控制器。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括位于刀具架后部并与空中机器人机械臂连接的接头。
优选的,上述圆盘锯为金属、陶瓷或复合材料材质的薄片状圆盘锯。
优选的,上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。
优选的,上述推挡器为面向刀具切割方向的“Ω”形竖直挡板,后部设有水平的加强板。
优选的,上述推挡器的上部设有向前推挡树枝的弹性的活动推板。
优选的,上述推挡器的下部设有与圆盘锯厚度相同的水平板,水平板与圆盘锯处于同一水平面。
刀具架上安装有温度传感器,温度传感器探头正对圆盘锯的边缘,刀具电机内置感知圆盘锯转速的转速传感器;温度传感器和转速传感器连接到刀具控制器,刀具控制器内置有检测刀具电机工作电流的电流传感器,刀具控制器连接到空中机器人的飞行控制器。
优选的,上述一种用于树障清理空中机器人的导向刀具结构的控制方法,该方法为:刀具控制器通过采集刀具电机的转速与电流以及圆盘锯的温度,①实时评估圆盘锯的过载、卡阻及损伤状态,一旦评估值超过预定门限,即向刀具电机输出刹车指令,然后驱动两片圆盘锯同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。
优选的,上述评估圆盘锯运行状态的方法采用多传感器数据门限判定算法或多传感器数据融合检测算法,多传感器数据门限判定算法如下:
A)若当前圆盘锯转速N≤其过载阈值Noverload,或电机电流I≥其过载阈值Ioverload,或锯片温度T≥其过载阈值Toverload,判定圆盘锯处于过载状态,刀具控制器据此做出反旋回退控制;
B)若当前圆盘锯转速N≤其卡阻阈值Nblocking,且电机电流I≥其卡阻阈值Iblocking,判定圆盘锯处于卡阻状态,其中,Nblocking<Noverload,Iblocking≥Ioverload,刀具控制器据此做出反旋回退控制;
C)若当前圆盘锯转速N≥其空切阈值Nempty,判定圆盘锯处于空切状态,其中,Nempty≤圆盘锯的给定转速,刀具控制器据此做出圆盘锯停转控制;
D)若圆盘锯转速或电机电流出现周期性脉动,则判定圆盘锯存在损伤;
E)不属于上述情况时,判定圆盘锯当前工作在正常状态,刀具控制器据此做出正常的正旋进给控制;
多传感器数据融合检测算法:
设圆盘锯转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,锯片温度的下限阈值为T1、上限阈值为T2,圆盘锯工作状态综合指数为:
其中,CN、CI、CT分别为圆盘锯的转速权重、电机电流权重、锯片温度权重;设置区间阈值f1、f2、f3,且有0≤f1<f2<f3;
当F≤f1时,则判定圆盘锯工作于空切状态,刀具控制器据此做出圆盘锯停转控制;
当f1<F≤f2时,则判定圆盘锯工作于正常状态,刀具控制器据此实施清障进给控制;
当f2<F≤f3时,则判定圆盘锯工作于过载状态,刀具控制器据此做出反旋回退控制;
当F>f3时,则判定圆盘锯工作于卡阻状态,刀具控制器据此做出反旋回退控制。
优选的,上述双刀具平衡作业状态检测与补偿保护方法如下:
1)双刀具平衡作业状态的检测方法
设两个圆盘锯的平均转速分别为瞬时转速分别为Na、Nb;设电机的平均电流分别为瞬时电流分别为Ia、Ib;设锯片的平均温度分别为瞬时温度分别为Ta、Tb;
定义两个圆盘锯的平均转速差ΔN=Na-Nb,瞬时转速差ΔN=Na-Nb;电机的平均电流差瞬时电流差ΔI=Ia-Ib;锯片的平均温度差瞬时温度差ΔT=Ta-Tb;有:
A)若|ΔT|≥δT中任一成立,判定两个圆盘锯平衡作业失常,其中的δN、δI、δT均大于等于0,分别为各对应物理参数的平衡作业判定阈值;
B)若判定两个圆盘锯平衡作业失常,其中的δ≥0,为平衡作业综合判定阈值,k1~k6为权值系数。
2)双刀具平衡补偿及保护控制方法
将各圆盘锯的转速、电机电流、锯片温度及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个圆盘锯平衡作业失常,则
A)刀具控制器立即做出先刹车后反旋控制,使圆盘锯退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;
B)由飞行控制器控制空中机器人向转速高、电流小、温度低的一侧圆盘锯运动微调,实施双刀具平衡补偿。
本发明的有益效果:与现有技术相比,本发明的效果如下:
1)本发明在圆盘锯上方设置推挡器,能够对切割进行中与切割完成后的树枝进行推挡,有效防止上部树枝倒向空中机器人,提高机器人飞行的稳定性和安全性;
2)提出双锯刀具加导向叉的结构,在作业向前推进的同时,利用导向叉及双圆盘锯向内相向同速旋转,使树枝自动进入双圆盘锯的共同切割区域,从而有效降低作用于空中机器人上的水平不平衡力与力矩,避免刀具与树枝之间的打滑,提高树障清理的效率;
3)本发明提出双锯刀具结构,在作业向前推进的同时,利用双锯向内相向同速旋转,双锯刀具结构具有一定的自动聚拢树枝和切割导向作用,使树枝自动进入双锯共同切割区域,从而有效降低作用于空中机器人上的水平不平衡力与力矩,避免刀具与树枝之间的打滑,提高树障清理的效率;
4)本发明在推挡器的上部设有向前推挡树枝的弹性的活动推板,在切割时该活动推板始终向刀具上方的树枝施加前向推挡力,与双锯作用在树枝上的后向切割力相配合形成施加在树枝上的前倒力矩,一旦切割完成可自动将树枝推向空中机器人的前方,进一步提升了空中机器人作业的安全性;
5)本发明在推挡器的下部设有与圆盘锯厚度相同且处于同一水平面的水平板,能有效防止切割完成后刀具上部的树枝因惯性进入刀具-推挡器所构成的三角区域而造成刀具的卡阻;
5)刀具控制器通过采集刀具电机的转速与电流以及锯片温度,判断圆盘锯的过载、卡阻及损伤状态,有利于实现刀具与空中机器人的保护性退避,并实现双圆盘锯作业的动态平衡;
6)模块化的接头方式,可实现刀具的快速更换,且装卸收纳运输方便,而且接头起到机械连接和电气连接的双重作用,结构更加紧凑。
附图说明
图1为本发明的结构示意图;
图2为本发明的前部视角结构示意图;
图3为本发明的俯视结构示意图;
图4为本发明的仰视结构示意图;
图5为本发明的仰视立体结构示意图。
图中,1—刀具架,2—刀具电机,3—圆盘锯,4—刀具控制器,5—接头,6—温度传感器,7—导向叉,8—前导入槽,9—后导出槽,10—推挡器,11—活动推板,12—扭簧,13—水平板。
具体实施方式
下面结合附图及具体的实施例对本发明进行进一步介绍。
实施例1:如图1-图5示,一种用于树障清理空中机器人的推挡刀具结构,包括Y型刀具架1、安装于刀具架1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片圆盘锯3、位于圆盘锯3的上方和刀具电机2前方的推挡器10,推挡器10与刀具架1和/或刀具电机2的底部固定连接。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括两根对称固定于刀具架1两侧且端部向前向外伸展至圆盘锯3下方的导向叉7;两根导向叉7构成“Y”形的前导入槽8和“一”字形的后导出槽9,前导入槽8用于收拢树枝并导向双圆盘锯3的共同切割区域,后导出槽9用于引导切割后的下方树枝自动向后移动并脱离刀具,前导入槽8的开放角为30-150度。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括固定于或内置于刀具架1的刀具控制器4。
优选的,上述一种用于树障清理空中机器人的推挡刀具结构,还包括位于刀具架1后部并与空中机器人机械臂连接的接头5;接头5采用法兰盘连接或螺帽-螺杆快速连接,相应的连接部位设有电气接插头,因此接头5具有机械和电气双重连接功能,结构紧凑,可实现刀具的快速更换。
优选的,上述圆盘锯3为金属、陶瓷或复合材料材质的薄片状圆盘锯。
优选的,上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。
优选的,上述推挡器10为面向刀具切割方向的“Ω”形竖直挡板,后部设有水平的加强板,加强板具有加固“Ω”形竖直挡板、提高挡板刚性和强度的效用,并兼有将推挡器10固定在刀具架1和/或刀具电机2上作用;推挡器10中间凹陷及其后部的弧形结构拐角起到导向与推挡作用。
优选的,上述推挡器10的上部设有向前推挡树枝的弹性的活动推板11,活动推板11的上部为向后弯曲的圆弧状,以免前推树枝时与树枝卡阻,其下部通过铰接轴与推挡器10形成铰接,铰接轴穿套有扭簧12,由此形成活动推板11的自然前倾;切割时,随着树枝被双锯“抓取”并不断深入切割区域,活动推板11向刀具上方的树枝施加的前向推挡力不断增大,与双锯作用在树枝上的后向切割力相配合后,形成施加在树枝上的前倒力矩,一旦切割完成能自动将树枝推向空中机器人的前方,从而避免倒向空中机器人。
优选的,上述推挡器10的下部设有与圆盘锯3厚度相同且处于同一水平面的水平板13,能有效防止切割完成后刀具上部的树枝因惯性进入刀具-推挡器所构成的三角区域而造成刀具的卡阻。
优选的,上述刀具架1上安装有温度传感器6,温度传感器6的探头正对圆盘锯3的边缘,刀具电机2内置感知圆盘锯3转速的转速传感器,通过温度传感器6、转速传感器能够实时监控作业刀具的温度和转速情况,从而判断作业刀具的运行状态,提高操作安全性。
优选的,上述温度传感器6和转速传感器连接到刀具控制器4,刀具控制器4内置有检测刀具电机2工作电流的电流传感器,刀具控制器4连接到空中机器人的飞行控制器;通过温度传感器6、转速传感器与电流传感器,刀具控制器4可实时监控锯片温度、电机转速和电机电流,判断两个圆盘锯3的工作状态,做出正常进给或回退保护或双锯动态切割平衡的调整,同时将该状态信息发送到飞行控制器,飞行控制器据此实施空中机器人的进给或退出微调,自动实现刀具的切割保护和有效切割。
上述转速传感器可采用光电编码器或霍尔传感器,温度传感器6可选择非接触类型的红外测温传感器(如MLX90614),电流传感器可采用电流互感器;刀具控制器4定制设有针对上述具体类型传感器的模拟量(电压或电流)或数字量(包括总线)、脉冲量、频率量等类型接口。
双锯刀具结构通过接头5从空中机器人平台获取刀具控制指令与驱动电源,送入刀具控制器4,以驱动刀具电机2旋转并控制其转速;树障清理时,两片圆盘锯3向内相向等速旋转,以自动卷入被清理树枝并实施切割。
实施例2:一种用于树障清理空中机器人的双锯刀具结构的控制方法,该方法为:刀具控制器4通过采集刀具电机2的转速与电流以及圆盘锯3的温度,①实时评估圆盘锯3的过载、卡阻及损伤状态,一旦评估值超过预定门限,即向刀具电机2输出刹车指令,然后驱动两片圆盘锯3同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。
优选的,上述评估圆盘锯3运行状态的方法采用多传感器数据门限判定算法或多传感器数据融合检测算法,多传感器数据门限判定算法如下:
A)若当前圆盘锯3转速N≤其过载阈值Noverload,或电机电流I≥其过载阈值Ioverload,或锯片温度T≥其过载阈值Toverload,判定圆盘锯3处于过载状态,刀具控制器4据此做出反旋回退控制;
B)若当前圆盘锯3转速N≤其卡阻阈值Nblocking,且电机电流I≥其卡阻阈值Iblocking,判定圆盘锯3处于卡阻状态,其中,Nblocking<Noverload,Iblocking≥Ioverload,刀具控制器4据此做出反旋回退控制;
C)若当前圆盘锯3转速N≥其空切阈值Nempty,判定圆盘锯3处于空切状态,其中,Nempty≤圆盘锯3的给定转速,刀具控制器4据此做出圆盘锯3停转控制;
D)若圆盘锯3转速或电机电流出现周期性脉动,则判定圆盘锯3存在损伤,原因在于,往复工作的刀具若存在缺损,其动平衡失调及所受树障阻力的周期性变化,将引起刀具转速和电机电流的周期性脉动;
E)不属于上述情况时,判定圆盘锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制;
多传感器数据融合检测算法:
设圆盘锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,锯片温度的下限阈值为T1、上限阈值为T2,圆盘锯3工作状态综合指数为:
其中,CN、CI、CT分别为圆盘锯3的转速权重、电机电流权重、锯片温度权重;设置区间阈值f1、f2、f3,且有0≤f1<f2<f3;
当F≤f1时,则判定圆盘锯3工作于空切状态,刀具控制器4据此做出圆盘锯3停转控制;
当f1<F≤f2时,则判定圆盘锯3工作于正常状态,刀具控制器4据此实施清障进给控制;
当f2<F≤f3时,则判定圆盘锯3工作于过载状态,刀具控制器4据此做出反旋回退控制;
当F>f3时,则判定圆盘锯3工作于卡阻状态,刀具控制器4据此做出反旋回退控制。
优选的,上述其双刀具平衡作业状态检测与补偿保护方法如下:
1)双刀具平衡作业状态的检测方法
设两个圆盘锯3的平均转速分别为瞬时转速分别为Na、Nb;设电机的平均电流分别为瞬时电流分别为Ia、Ib;设锯片的平均温度分别为瞬时温度分别为Ta、Tb。
定义两个圆盘锯3的平均转速差瞬时转速差ΔN=Na-Nb;电机的平均电流差瞬时电流差ΔI=Ia-Ib;锯片的平均温度差瞬时温度差ΔT=Ta-Tb;有:
A)若|ΔN|≥δN、|ΔI|≥δI、|ΔT|≥δT中任一成立,判定两个圆盘锯3平衡作业失常,其中的δN、δI、δT均≥0,分别为各对应物理参数的平衡作业判定阈值;
B)若判定两个圆盘锯3平衡作业失常,其中的δ≥0,为平衡作业综合判定阈值,k1~k6为权值系数。
2)双刀具平衡补偿及保护控制方法
将各圆盘锯3的转速、电机电流、锯片温度及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个圆盘锯3平衡作业失常,则
A)刀具控制器4立即做出先刹车后反旋控制,使圆盘锯3退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;
B)由飞行控制器控制空中机器人向转速高、电流小、温度低的一侧圆盘锯3运动微调,实施双刀具平衡补偿。
以上阈值和权值系数的确定,可采用基于物理原理的理论计算、基于实验数据分析的经验统计、基于神经网络的建模训练等方法来完成。
以上所述,仅为本发明的具体实施方式实例,本发明的保护范围并不局限于此。熟悉该技术领域的技术人员在本发明揭露的技术范围内,可轻易找到变化或替换方式,这些都应涵盖在本发明的保护范围之内。为此,本发明的保护范围应以所述权利要求的保护范围为准。
Claims (10)
1.一种用于树障清理空中机器人的推挡刀具结构,其特征在于:包括Y型刀具架(1)、安装于刀具架(1)前部末端的两个刀具电机(2)、由两个刀具电机(2)分别驱动且位于刀具架(1)下方的两片圆盘锯(3)、位于圆盘锯(3)上方和刀具电机(2)前方的推挡器(10),推挡器(10)与刀具架(1)或刀具电机(2)的底部固定连接。
2.根据权利要求1所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:还包括两根对称固定于刀具架(1)两侧且端部向前向外伸展至圆盘锯(3)下方的导向叉(7);两根导向叉(7)构成“Y”形的前导入槽(8)和“一”字形的后导出槽(9),前导入槽(8)用于收拢树枝并导向双圆盘锯(3)的共同切割区域,后导出槽(9)用于引导切割后的下方树枝自动向后移动并脱离刀具。
3.根据权利要求2所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:还包括固定于或内置于刀具架(1)的刀具控制器(4)、位于刀具架(1)后部并与空中机器人机械臂连接的接头(5)。
4.根据权利要求1所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:推挡器(10)为面向刀具切割方向的“Ω”形竖直挡板,后部设有水平的加强板。
5.根据权利要求1所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:推挡器(10)的上部设有向前推挡树枝的弹性的活动推板(11)。
6.根据权利要求1所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:推挡器(10)的下部设有与圆盘锯(3)厚度相同的水平板(13),水平板(13)与圆盘锯(3)处于同一水平面。
7.根据权利要求1所述的一种用于树障清理空中机器人的推挡刀具结构,其特征在于:刀具架(1)上安装有温度传感器(6),温度传感器(6)的探头正对圆盘锯(3)的边缘,刀具电机(2)内置感知圆盘锯(3)转速的转速传感器;温度传感器(6)和转速传感器连接到刀具控制器(4),刀具控制器(4)内置有检测刀具电机(2)工作电流的电流传感器,刀具控制器(4)连接到空中机器人的飞行控制器。
8.根据权利要求1-7任一所述的一种用于树障清理空中机器人的推挡刀具结构的控制方法,其特征在于:该方法为:刀具控制器(4)通过采集刀具电机(2)的转速与电流以及圆盘锯(3)的温度,①实时评估圆盘锯(3)的过载、卡阻及损伤状态,一旦评估值超过预定门限,即向刀具电机(2)输出刹车指令,然后驱动两片圆盘锯(3)同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。
9.根据权利要求8所述的一种用于树障清理空中机器人的推挡刀具结构的控制方法,其特征在于:评估圆盘锯(3)运行状态方法采用多传感器数据门限判定算法或多传感器数据融合检测算法,多传感器数据门限判定算法如下:
A)若当前圆盘锯(3)转速N≤其过载阈值Noverload,或电机电流I≥其过载阈值Ioverload,或锯片温度T≥其过载阈值Toverload,判定圆盘锯(3)处于过载状态,刀具控制器(4)据此做出反旋回退控制;
B)若当前圆盘锯(3)转速N≤其卡阻阈值Nblocking,且电机电流I≥其卡阻阈值Iblocking,判定圆盘锯(3)处于卡阻状态,其中,Nblocking<Noverload,Iblocking≥Ioverload,刀具控制器(4)据此做出反旋回退控制;
C)若当前圆盘锯(3)转速N≥其空切阈值Nempty,判定圆盘锯(3)处于空切状态,其中,Nempty≤圆盘锯(3)的给定转速,刀具控制器(4)据此做出圆盘锯(3)停转控制;
D)若圆盘锯(3)转速或电机电流出现周期性脉动,则判定圆盘锯(3)存在损伤;
E)不属于A)-D)的情况时,判定圆盘锯(3)当前工作在正常状态,刀具控制器(4)据此做出正常的正旋进给控制;
多传感器数据融合检测算法如下:
设圆盘锯(3)转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,锯片温度的下限阈值为T1、上限阈值为T2,圆盘锯(3)工作状态综合指数为:
其中,CN、CI、CT分别为圆盘锯(3)的转速权重、电机电流权重、锯片温度权重;设置区间阈值f1、f2、f3,且有0≤f1<f2<f3;
当F≤f1时,则判定圆盘锯(3)工作于空切状态,刀具控制器(4)据此做出圆盘锯(3)停转控制;
当f1<F≤f2时,则判定圆盘锯(3)工作于正常状态,刀具控制器(4)据此实施清障进给控制;
当f2<F≤f3时,则判定圆盘锯(3)工作于过载状态,刀具控制器(4)据此做出反旋回退控制;
当F>f3时,则判定圆盘锯(3)工作于卡阻状态,刀具控制器(4)据此做出反旋回退控制。
10.根据权利要求8所述的一种用于树障清理空中机器人的推挡刀具结构的控制方法,其特征在于:双刀具平衡作业状态检测与补偿保护方法如下:
1)双刀具平衡作业状态的检测方法
设两个圆盘锯(3)的平均转速分别为瞬时转速分别为Na、Nb;设电机的平均电流分别为瞬时电流分别为Ia、Ib;设锯片的平均温度分别为瞬时温度分别为Ta、Tb;
定义两个圆盘锯(3)的平均转速差瞬时转速差ΔN=Na-Nb;电机的平均电流差瞬时电流差ΔI=Ia-Ib;锯片的平均温度差瞬时温度差ΔT=Ta-Tb;有:
A)若|ΔN|≥δN、|ΔI|≥δI、|ΔT|≥δT中任一成立,判定两个圆盘锯(3)平衡作业失常,其中的δN、δI、δT均大于等于0,分别为各对应物理参数的平衡作业判定阈值;
B)若判定两个圆盘锯(3)平衡作业失常,其中的δ≥0,为平衡作业综合判定阈值,k1~k6为权值系数;
2)双刀具平衡补偿及保护控制方法
将各圆盘锯(3)的转速、电机电流、锯片温度及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个圆盘锯(3)平衡作业失常,则
A)刀具控制器(4)立即做出先刹车后反旋控制,使圆盘锯(3)退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;
B)由飞行控制器控制空中机器人向转速高、电流小、温度低的一侧圆盘锯(3)运动微调,实施双刀具平衡补偿。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810192093.0A CN108370745B (zh) | 2018-03-08 | 2018-03-08 | 一种用于树障清理空中机器人的推挡刀具结构和控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810192093.0A CN108370745B (zh) | 2018-03-08 | 2018-03-08 | 一种用于树障清理空中机器人的推挡刀具结构和控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108370745A true CN108370745A (zh) | 2018-08-07 |
CN108370745B CN108370745B (zh) | 2023-10-20 |
Family
ID=63018724
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810192093.0A Active CN108370745B (zh) | 2018-03-08 | 2018-03-08 | 一种用于树障清理空中机器人的推挡刀具结构和控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108370745B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2002058457A1 (en) * | 2001-01-25 | 2002-08-01 | Emidio Di Marco | Double-saw pruning apparatus |
CN202635183U (zh) * | 2012-04-05 | 2013-01-02 | 汝阳县电业局 | 一种简易式电动树枝锯 |
CN204433059U (zh) * | 2015-01-30 | 2015-07-01 | 马鞍山市赛迪智能科技有限公司 | 一种搭载机械手电锯的飞行器 |
CN104823730A (zh) * | 2015-04-30 | 2015-08-12 | 芜湖新达园林绿化集团有限公司 | 一种园林树木剪枝装置 |
EP3014975A1 (de) * | 2014-10-31 | 2016-05-04 | Robert Bosch Gmbh | Gartengerätevorrichtung und verfahren zu deren betrieb |
CN205336966U (zh) * | 2016-01-23 | 2016-06-29 | 国网山东省电力公司高唐县供电公司 | 一种可调高度的充电锯枝工具 |
CN206851439U (zh) * | 2017-05-03 | 2018-01-09 | 薛傅龙 | 一种用于线路修枝的无人机 |
US20180048252A1 (en) * | 2016-08-10 | 2018-02-15 | Makita Corporation | Electric working machine, and method of detecting overload operation thereof |
-
2018
- 2018-03-08 CN CN201810192093.0A patent/CN108370745B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2002058457A1 (en) * | 2001-01-25 | 2002-08-01 | Emidio Di Marco | Double-saw pruning apparatus |
CN202635183U (zh) * | 2012-04-05 | 2013-01-02 | 汝阳县电业局 | 一种简易式电动树枝锯 |
EP3014975A1 (de) * | 2014-10-31 | 2016-05-04 | Robert Bosch Gmbh | Gartengerätevorrichtung und verfahren zu deren betrieb |
CN204433059U (zh) * | 2015-01-30 | 2015-07-01 | 马鞍山市赛迪智能科技有限公司 | 一种搭载机械手电锯的飞行器 |
CN104823730A (zh) * | 2015-04-30 | 2015-08-12 | 芜湖新达园林绿化集团有限公司 | 一种园林树木剪枝装置 |
CN205336966U (zh) * | 2016-01-23 | 2016-06-29 | 国网山东省电力公司高唐县供电公司 | 一种可调高度的充电锯枝工具 |
US20180048252A1 (en) * | 2016-08-10 | 2018-02-15 | Makita Corporation | Electric working machine, and method of detecting overload operation thereof |
CN206851439U (zh) * | 2017-05-03 | 2018-01-09 | 薛傅龙 | 一种用于线路修枝的无人机 |
Also Published As
Publication number | Publication date |
---|---|
CN108370745B (zh) | 2023-10-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN208113427U (zh) | 一种用于树障清理空中机器人的推挡刀具结构 | |
CN101439519B (zh) | 一种自动切割机 | |
CN208242302U (zh) | 一种用于树障清理空中机器人的导向刀具结构 | |
CN108419520B (zh) | 一种高效果实采摘末端执行器、果实采摘器及采摘车 | |
CN201109130Y (zh) | 一种自动切割机 | |
CN205275056U (zh) | 一种面粉吊送装置 | |
CN203181570U (zh) | 多功能切割机械臂 | |
CN108568863A (zh) | 一种用于树障清理空中机器人的双锯刀具结构和控制方法 | |
CN107855583A (zh) | 一种用于五金电器的切割设备 | |
CN108370745A (zh) | 一种用于树障清理空中机器人的推挡刀具结构和控制方法 | |
CN208113426U (zh) | 一种用于树障清理空中机器人的双锯刀具结构 | |
CN108370746A (zh) | 一种用于树障清理空中机器人的导向刀具结构和控制方法 | |
CN202963597U (zh) | 管线的脚踏切断装置 | |
CN207369642U (zh) | 一种饲草分段切割装置 | |
CN106416588B (zh) | 打草机及其控制方法 | |
CN108406954A (zh) | 用于树障清理空中机器人的双绳锯刀具结构和控制方法 | |
CN103991744A (zh) | 一种数控剪切机的自动集料机构 | |
CN108556068A (zh) | 一种树障清理空中机器人的双锯刀具控制装置和控制方法 | |
CN207011270U (zh) | 一种自动摆动的果园除草机 | |
CN211630902U (zh) | 一种适用于果蔬的自动采摘装置 | |
CN208438463U (zh) | 一种树障清理空中机器人的双锯刀具控制装置 | |
CN209185056U (zh) | 便携式菠萝采摘装置 | |
CN209676878U (zh) | 一种便于进行打捞收集的河草清理设备 | |
CN203922237U (zh) | 一种数控剪切机的自动集料机构 | |
CN209185068U (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 |