首页 专利交易 科技果 科技人才 科技服务 商标交易 会员权益 IP管家助手 需求市场 关于龙图腾
 /  免费注册
到顶部 到底部
清空 搜索

用于树障清理空中机器人的双绳锯刀具结构和控制方法 

申请/专利权人:贵州电网有限责任公司

申请日:2018-03-08

公开(公告)日:2024-04-05

公开(公告)号:CN108406954B

主分类号:B27B17/00

分类号:B27B17/00;B27G19/00;H02G1/02;A01G3/08

优先权:

专利状态码:有效-授权

法律状态:2024.04.05#授权;2018.09.11#实质审查的生效;2018.08.17#公开

摘要:本发明公开了用于树障清理空中机器人的双绳锯刀具结构和控制方法,包括Y型刀具架、安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片中心盘,中心盘的四周呈辐射状对称固定有多条绳锯,绳锯的另一端为自由端,该自由端运动形成的回转圆的直径小于两个刀具电机转轴的中心距。本发明双绳锯刀具结构,结构轻,占用空间小;作业时,双绳锯刀具结构使树枝自动进入双绳锯的共同切割区域,有效降低作用于空中机器人的水平不平衡力与力矩,避免刀具与树枝之间的打滑,提高树障清理的效率,相比圆盘锯或链锯切割,绳锯在切割过程中不容易出现过载与卡阻,使用更加安全,更便于空中机器人的姿态稳定与控制。

主权项:1.用于树障清理空中机器人的双绳锯刀具结构,其特征在于:包括Y型刀具架1、左右对称安装于刀具架1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片中心盘6,中心盘6的四周呈辐射状对称固定有多条绳锯3,绳锯3的另一端为自由端,该自由端运动形成的回转圆的直径小于两个刀具电机2转轴的中心距;还包括固定于或内置于刀具架1的刀具控制器4;用于树障清理空中机器人的双绳锯刀具结构的控制方法为:刀具控制器4通过采集刀具电机2的转速和电流,①实时评估绳锯3的过载与卡阻状态,一旦评估值超过预定门限,即向刀具电机2输出刹车指令,然后驱动两条绳锯3同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护;评估绳锯运行状态的方法采用多传感器数据门限判定算法,算法如下:1若当前绳锯3转速N≤其过载阈值Noverload,或电机电流I≥其过载阈值Ioverload,判定绳锯3处于过载状态,刀具控制器4据此做出反旋回退控制;2若当前绳锯3转速N≤其卡阻阈值Nblocking,且电机电流I≥其卡阻阈值Iblocking,判定绳锯3处于卡阻状态,其中,NblockingNoverload,Iblocking≥Ioverload,刀具控制器4据此做出反旋回退控制;3若当前绳锯3转速N≥其空切阈值Nempty,判定绳锯3处于空切状态,其中,Nempty≤绳锯3的给定转速,刀具控制器4据此做出绳锯3停转控制;4不属于1-3的情况时,判定绳锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制;评估绳锯运行状态的方法采用多传感器数据融合检测算法,算法如下:设绳锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,绳锯3工作状态综合指数为: 其中,CN、CIT分别为绳锯3的转速权重和电机电流权重;设置区间阈值f1、f2、f3,且有0≤f1f2f3;当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;定义两个绳锯3的平均转速差瞬时转速差ΔN=Na-Nb;电机的平均电流差瞬时电流差ΔI=Ia-Ib;有:A若|ΔN|≥δN、|ΔI|≥δI中任一成立,判定两个绳锯3平衡作业失常,其中的δN、δI均大于等于0,分别为各对应物理参数的平衡作业判定阈值;B若判定两个绳锯3平衡作业失常,其中的δ≥0,为平衡作业综合判定阈值,k1~k4为权值系数;2双刀具平衡补偿及保护控制方法将各绳锯3的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个绳锯3平衡作业失常,则A刀具控制器4立即做出先刹车后反旋控制,使绳锯3退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;B由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯3运动微调,实施双刀具平衡补偿。

全文数据:用于树障清理空中机器人的双绳锯刀具结构和控制方法技术领域[0001]本发明涉及一种用于电力线路树障清理空中机器人的双绳锯刀具结构和控制方法,属于输电线路树障清理装置技术领域。背景技术[0002]空中机器人在对电力线路通道树障进行清理时,所用刀具应能快速切割树枝,同时又能避免对空中机器人本体姿态的影响,并且具有防卡阻等安全保护措施。[0003]目前园林修剪树枝多采用单锯类型的清理刀具,若将该类刀具直接安装于空中机器人上进行树障清理,刀具的水平受力不对称,易给空中机器人带来航向推斥力矩,一方面影响空中机器人力与力矩的平衡,另一方面造成刀具与树枝之间的打滑,导致切割效率不高。此外,常用的圆盘锯或链锯多为金属材质,结构较重,占用空间较大,空中机器人的续航能力影响较大。发明内容[0004]本发明解决的技术问题是:提供用于树障清理空中机器人的双绳锯刀具结构和控制方法,以解决现有技术中存在的问题。[0005]本发明采取的技术方案为:用于树障清理空中机器人的双绳锯刀具结构,包括Y型刀具架、左右对称安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片中心盘,中心盘的四周呈辐射状对称固定有多条绳锯,绳锯的另一端为自由端,该自由端运动形成的回转圆的直径小于两个刀具电机转轴的中心距。[0006]优选的,上述用于树障清理空中机器人的双绳锯刀具结构,还包括固定于或内置于刀具架的刀具控制器。[0007]优选的,上述用于树障清理空中机器人的双绳锯刀具结构,还包括位于刀具架后部并与空中机器人机械臂连接的接头。[0008]优选的,上述绳锯为钢丝绳锯、耐磨复合材料绳锯。[0009]优选的,上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。[0010]优选的,上述刀具电机内置感知绳锯转速的转速传感器。[0011]优选的,上述转速传感器连接到刀具控制器,刀具控制器内置有检测刀具电机工作电流的电流传感器,刀具控制器连接到空中机器人的飞行控制器。[0012]用于树障清理空中机器人的双绳锯刀具结构的控制方法,该方法为:刀具控制器通过采集刀具电机的转速和电流,①实时评估绳锯的过载与卡阻状态,一旦评估值超过预定门限,即向刀具电机输出刹车指令,然后驱动两条绳锯同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。[0013]优选的,上述评估绳锯运行状态的方法采用多传感器数据门限判定算法,算法如下:[0014]1若当前绳锯转速NS其过载阈值N_ri〇ad,或电机电流I多其过载阈值I_ri〇ad,判定绳锯处于过载状态,刀具控制器据此做出反旋回退控制;[0015]2若当前绳锯转速NS其卡阻阈值Nblc^king,且电机电流I多其卡阻阈值Iblc^king,判定绳锯处于卡阻状态,其中,Nblocking〈N〇verload,Iblocking彡Ioverload,刀具控制器据此做出反旋回退控制;[0016]3若当前绳锯转速N多其空切阈值Ne3mpty,判定绳锯处于空切状态,其中,Ne3mptyS绳锯的给定转速,刀具控制器据此做出绳锯停转控制;[0017]4不属于上述情况时,判定绳锯当前工作在正常状态,刀具控制器据此做出正常的正旋进给控制。[0018]优选的,上述评估绳锯运行状态的方法采用多传感器数据融合检测算法,算法如下:[0019]设绳锯转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,绳锯工作状态综合指数为:[0021]其中,Cn、Cit分别为绳锯的转速权重和电机电流权重;设置区间阈值负、f2、f3,且有0^fif3时,则判定绳锯工作于卡阻状态,刀具控制器据此做出反旋回退控制。[0026]优选的,上述双刀具平衡作业状态检测与补偿保护方法如下:[0027]1双刀具平衡作业状态的检测算法[0028]设两个绳锯的平均转速分别为,瞬时转速分别为Na、Nb;设电机的平均电流分别为,瞬时电流分别为Ia、Ib。[0029]定义两个绳锯的平均转速差.,瞬时转速差AN=Na-Nb;电机的平均电流差瞬时电流差△I=Ia-Ib;有:[0030]A若中任一成立,判定两个绳锯平衡作业失常,其中的均大于等于〇,分别为各对应物理参数的平衡作业判定阈值;[0031]B若,判定两个绳锯平衡作业失常,其中的δ多0,为平衡作业综合判定阈值,la〜k4为权值系数;[0032]2双刀具平衡补偿及保护控制方法[0033]将各绳锯的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个绳锯平衡作业失常,则[0034]A刀具控制器立即做出先刹车后反旋控制,使绳锯退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;[0035]B由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯运动微调,实施双刀具平衡补偿。[0036]本发明的有益效果:与现有技术相比,本发明的效果如下:[0037]1本发明双绳锯刀具结构,结构轻,占用空间小;作业时,刀具整体一边向树障推进,一边驱动双绳锯向内相向同速旋转,使树枝自动进入双绳锯的共同切割区域,从而有效降低作用于空中机器人的水平不平衡力与力矩,避免刀具与树枝之间的打滑,提高树障清理的效率,相比圆盘锯或链锯切割,绳锯具有一定的柔性,具备自动退让功能,切割过程中更加不容易出现过载、卡阻及损伤状态,使用更加安全,重量更轻,更便于控制空中机器人的姿态和稳定性;[0038]2采用转速监测,能够实时判断刀具运行状态是否良好,提高作业安全性,刀具控制器通过采集刀具电机的转速和电流,判断绳锯的过载与卡阻状态,有利于实现刀具与空中机器人的保护性退避,并实现双绳盘锯作业的动态平衡;[0039]3模块化的接头方式,可实现刀具的快速更换,且装卸收纳运输方便,而且接头起到机械连接和电气连接的双重作用,结构更加紧凑。附图说明[0040]图1为本发明的结构示意图;[0041]图2为本发明的俯视结构示意图;[0042]图3为本发明的三片绳锯结构示意图。[0043]图中,丨一刀具架,2一刀具电机,3一绳锯,4一刀具控制器,5—接头,6—中心盘。具体实施方式[0044]下面,结合附图及具体的实施例对本发明进行进一步介绍。[0045]实施例1:如图1-图3所示,用于树障清理空中机器人的双绳锯刀具结构,包括Y型刀具架1、左右对称安装于刀具架1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片中心盘6,中心盘6的四周呈辐射状对称固定有多条绳锯3,绳锯3的另一端为自由端,该自由端运动形成的回转圆的直径小于两个刀具电机2转轴的中心距。[0046]优选的,上述用于树障清理空中机器人的双绳锯刀具结构,还包括固定于或内置于刀具架1的刀具控制器4。[0047]优选的,上述用于树障清理空中机器人的双绳锯刀具结构,还包括位于刀具架1后部并与空中机器人机械臂连接的接头5;接头5采用法兰盘连接或螺帽-螺杆快速连接,相应的连接部位设有电气接插头,因此接头5具有机械和电气双重连接功能,结构紧凑,可实现刀具的快速更换。[0048]优选的,上述绳锯3为钢丝绳锯、耐磨复合材料绳锯。[0049]优选的,上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。[0050]优选的,上述刀具电机2内置感知绳锯3转速的转速传感器,通过转速传感器能够实时监控作业刀具的转速情况,从而判断作业刀具的运行状态,提高操作安全性。[0051]优选的,上述转速传感器连接到刀具控制器4,刀具控制器4内置有检测刀具电机2工作电流的电流传感器,刀具控制器4连接到空中机器人的飞行控制器;通过转速传感器以及电流传感器,刀具控制器4可实时监控绳锯3的转速和电机电流,判断两个绳锯3的工作状态,做出正常进给或回退保护或双锯动态切割平衡的调整,同时将该状态信息发送到飞行控制器,飞行控制器据此实施空中机器人的进给或退出微调,自动实现刀具的切割保护和有效切割。[0052]上述转速传感器可采用光电编码器或霍尔传感器,电流传感器可采用电流互感器;刀具控制器4定制设有针对上述具体类型传感器的模拟量(电压或电流或数字量包括总线)、脉冲量、频率量等类型接口。[0053]双绳刀具结构通过接头5从空中机器人平台获取刀具控制指令与驱动电源,送入刀具控制器4,以驱动刀具电机2旋转并控制其转速;树障清理时,两条绳锯3向内相向等速旋转,以自动卷入被清理树枝并实施切割。[0054]实施例2:—种用于树障清理空中机器人的双绳锯刀具结构的控制方法,该方法为:刀具控制器4通过采集刀具电机2的转速和电流,①实时评估绳锯3的过载与卡阻状态,一旦评估值超过预定门限,即向刀具电机2输出刹车指令,然后驱动两条绳锯3同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。[0055]优选的,上述评估绳锯运行状态的方法采用多传感器数据门限判定算法,算法如下:[0056]1若当前绳锯3转速N彡其过载阈值N_ri〇ad,或电机电流I彡其过载阈值I_ri〇ad,判定绳锯3处于过载状态,刀具控制器4据此做出反旋回退控制;[0057]2若当前绳锯3转速N彡其卡阻阈值Nblc^king,且电机电流I彡其卡阻阈值Iblc^king,判定绳锯3处于卡阻状态,其中,!^。。!^!^〈!^^^,!^。。!^!^^^。^^!!^,刀具控制器財居此做出反旋回退控制;[0058]3若当前绳锯3转速N彡其空切阈值Nempty,判定绳锯3处于空切状态,其中,Nempty彡绳锯3的给定转速,刀具控制器4据此做出绳锯3停转控制;[0059]4不属于上述情况时,判定绳锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制。[0060]优选的,上述评估绳锯运行状态的方法采用多传感器数据融合检测算法,算法如下:[0061]设绳锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,绳锯3工作状态综合指数为:[0063]其中,Cn、Cit分别为绳锯3的转速权重和电机电流权重;设置区间阈值h、f2、f3,且有0f3时,则判定绳锯3工作于卡阻状态,刀具控制器4据此做出反旋回退控制。[0068]优选的,上述双刀具平衡作业状态检测与补偿保护方法如下:[0069]1双刀具平衡作业状态的检测算法[0070]设两个绳锯3的平均转速分别为,瞬时转速分别为Na、Nb;设电机的平均电流分别为,瞬时电流分别为Ia、Ib;[0071]定义两个绳锯3的平均转速差,瞬时转速差AN=Na-Nb;电机的平均电流差.,瞬时电流差△I=Ia-Ib;有:[0072]A若中任一成立,判定两个绳锯3平衡作业失常,其中的均大于等于〇,分别为各对应物理参数的平衡作业判定阈值;[0073]B若,判定两个绳锯3平衡作业失常,其中的δ多0,为平衡作业综合判定阈值,la〜k4为权值系数;[0074]2双刀具平衡补偿及保护控制方法[0075]将各绳锯3的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个绳锯3平衡作业失常,则[0076]A刀具控制器4立即做出先刹车后反旋控制,使绳锯3退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;[0077]B由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯3运动微调,实施双刀具平衡补偿。[0078]以上阈值和权值系数的确定,可采用基于物理原理的理论计算、基于实验数据分析的经验统计、基于神经网络的建模训练等方法来完成。[0079]本发明的优点如下:[0080]1双绳锯设计,向内相向同速旋转,可自动卷入树枝并实施切割,树障清理效率高,作用于空中机器人上的水平不平衡力与力矩相对较小;[0081]2刀具控制器4通过采集刀具电机2的转速和电流,判断绳锯的过载与卡阻状态,有利于实现刀具与空中机器人的保护性退避,并实现保双绳盘锯作业的动态平衡;[0082]3模块化设计与接头方式,可实现刀具的快速更换;[0083]4本发明整体重量较轻,占用空间较小,有利于空中机器人携带作业。[0084]以上所述,仅为本发明的具体实施方式实例,本发明的保护范围并不局限于此。熟悉该技术领域的技术人员在本发明揭露的技术范围内,可轻易找到变化或替换方式,这些都应涵盖在本发明的保护范围之内。为此,本发明的保护范围应以所述权利要求的保护范围为准。

权利要求:1.用于树障清理空中机器人的双绳锯刀具结构,其特征在于:包括Y型刀具架(I、左右对称安装于刀具架(1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架⑴下方的两片中心盘6,中心盘⑹的四周呈辐射状对称固定有多条绳锯3,绳锯⑶的另一端为自由端,该自由端运动形成的回转圆的直径小于两个刀具电机⑵转轴的中心距。2.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构,其特征在于:还包括固定于或内置于刀具架⑴的刀具控制器⑷。3.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构,其特征在于:还包括位于刀具架⑴后部并与空中机器人机械臂连接的接头5。4.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构,其特征在于:双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。5.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构,其特征在于:刀具电机⑵内置感知绳锯⑶转速的转速传感器。6.根据权利要求5所述的用于树障清理空中机器人的双绳锯刀具结构,其特征在于:转速传感器连接到刀具控制器4,刀具控制器⑷内置有检测刀具电机2工作电流的电流传感器,刀具控制器⑷连接到空中机器人的飞行控制器。7.根据权利要求1-6任一所述的用于树障清理空中机器人的双绳锯刀具结构的控制方法,其特征在于:该方法为:刀具控制器⑷通过采集刀具电机⑵的转速和电流,①实时评估绳锯⑶的过载与卡阻状态,一旦评估值超过预定门限,即向刀具电机2输出刹车指令,然后驱动两条绳锯3同时反转,以使被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,从而对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。8.根据权利要求7所述的用于树障清理空中机器人的双绳锯刀具结构的控制方法,其特征在于:评估绳锯运行状态的方法采用多传感器数据门限判定算法,算法如下:1若当前绳锯⑶转速其过载阈值Ncive3rIciad,或电机电流I其过载阈值Imi—,判定绳锯3处于过载状态,刀具控制器⑷据此做出反旋回退控制;2若当前绳锯⑶转速其卡阻阈值Nblc^king,且电机电流I其卡阻阈值Ibkking,判定绳锯⑶处于卡阻状态,其中,Nblocking〈NcVerlcad,Iblccking_刀具控制器⑷据此做出反旋回退控制;3若当前绳锯3转速:其空切阈值Ne3mpty,判定绳锯3处于空切状态,其中:绳锯⑶的给定转速,刀具控制器⑷据此做出绳锯⑶停转控制;4不属于1-3的情况时,判定绳锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制。9.根据权利要求7所述的用于树障清理空中机器人的双绳锯刀具结构的控制方法,其特征在于:评估绳锯运行状态的方法采用多传感器数据融合检测算法,算法如下:设绳锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,绳锯⑶工作状态综合指数为:其中,CN、CIT分别为绳锯⑶的转速权重和电机电流权重;设置区间阈值心、54,且有0当时,则判定绳锯⑶工作于空切状态,刀具控制器⑷据此做出绳锯⑶停转控制;当:‘2时,则判定绳锯3工作于正常状态,刀具控制器4据此实施清障进给控制;当13时,则判定绳锯3工作于过载状态,刀具控制器4据此做出反旋回退控制;当Ff3时,则判定绳锯3工作于卡阻状态,刀具控制器4据此做出反旋回退控制。10.根据权利要求7所述的用于树障清理空中机器人的双绳锯刀具结构的控制方法,其特征在于:双刀具平衡作业状态检测与补偿保护方法如下:1双刀具平衡作业状态的检测算法设两个绳锯⑶的平均转速分别为,瞬时转速分别为Na、Nb;设电机的平均电流分别为,瞬时电流分别为Ia、Ib;定义两个绳锯⑶的平均转速差.....,瞬时转速差ΔN=Na-Nb;电机的平均电流差.,瞬时电流差△I=Ia-Ib;有:A若,,,中任一成立,判定两个绳锯⑶平衡作业失常,其中的。均大于等于〇,分别为各对应物理参数的平衡作业判定阈值;B若i,判定两个绳锯3平衡作业失常,其中的δ多0,为平衡作业综合判定阈值,la〜k4为权值系数;2双刀具平衡补偿及保护控制方法将各绳锯3的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个绳锯3平衡作业失常,则A刀具控制器4立即做出先刹车后反旋控制,使绳锯(3退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;B由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯3运动微调,实施双刀具平衡补偿。

百度查询: 贵州电网有限责任公司 用于树障清理空中机器人的双绳锯刀具结构和控制方法

免责声明
1、本报告根据公开、合法渠道获得相关数据和信息,力求客观、公正,但并不保证数据的最终完整性和准确性。
2、报告中的分析和结论仅反映本公司于发布本报告当日的职业理解,仅供参考使用,不能作为本公司承担任何法律责任的依据或者凭证。