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

【发明授权】一种用于树障清理空中机器人的双锯刀具结构和控制方法_贵州电网有限责任公司_201810192081.8 

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

申请日:2018-03-08

公开(公告)日:2023-12-12

公开(公告)号:CN108568863B

主分类号:B27B5/02

分类号:B27B5/02;B27B5/29;H02G1/02;A01G3/08

优先权:

专利状态码:有效-授权

法律状态:2023.12.12#授权;2018.10.26#实质审查的生效;2018.09.25#公开

摘要:本发明公开了一种用于树障清理空中机器人的双锯刀具结构和控制方法,包括Y型刀具架、安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片圆盘锯。本发明提出双锯刀具结构,在作业向前推进的同时,利用双锯向内相向同速旋转,双锯刀具结构具有一定的自动聚拢树枝和切割导向作用,使树枝自动进入双锯共同切割区域,从而有效降低作用于空中机器人上的水平不平衡力与力矩,避免刀具与树枝之间的打滑,提高树障清理的效率。

主权项:1.一种用于树障清理空中机器人的双锯刀具结构,其特征在于:包括Y型刀具架1、安装于刀具架1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片圆盘锯3;还包括固定于或内置于刀具架1的刀具控制器4;刀具架1上安装有温度传感器6,温度传感器6的探头正对圆盘锯3的边缘,刀具电机2内置感知圆盘锯3转速的转速传感器;温度传感器6和转速传感器连接到刀具控制器4,刀具控制器4内置有检测刀具电机2工作电流的电流传感器,刀具控制器4连接到空中机器人的飞行控制器;用于树障清理空中机器人的双锯刀具结构的控制方法为:刀具控制器4通过采集刀具电机2的转速与电流以及圆盘锯3的温度,①实时评估圆盘锯3的过载、卡阻及损伤状态,一旦评估值超过预定门限,即向刀具电机2输出刹车指令,然后驱动两片圆盘锯3同时反转,被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护;评估圆盘锯3运行状态的方法采用多传感器数据门限判定算法,算法如下:1若当前圆盘锯3转速N≤其过载阈值Noverload,或电机电流I≥其过载阈值Ioverload,或锯片温度T≥其过载阈值Toverload,判定圆盘锯3处于过载状态,刀具控制器4据此做出反旋回退控制;2若当前圆盘锯3转速N≤其卡阻阈值Nblocking,且电机电流I≥其卡阻阈值Iblocking,判定圆盘锯3处于卡阻状态,其中,NblockingNoverload,Iblocking≥Ioverload,刀具控制器4据此做出反旋回退控制;3若当前圆盘锯3转速N≥其空切阈值Nempty,判定圆盘锯3处于空切状态,其中,Nempty≤圆盘锯3的给定转速,刀具控制器4据此做出圆盘锯3停转控制;4若圆盘锯3转速或电机电流出现周期性脉动,则判定圆盘锯3存在损伤;5不属于1-4的情况时,判定圆盘锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制;评估圆盘锯3运行状态的方法采用多传感器数据融合检测算法,算法如下:设圆盘锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为I2,锯片温度的下限阈值为T1、上限阈值为T2,圆盘锯3工作状态综合指数为: 其中,CN、CI、CT分别为圆盘锯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据此做出反旋回退控制。

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

权利要求:1.一种用于树障清理空中机器人的双锯刀具结构,其特征在于:包括Y型刀具架(I、安装于刀具架(1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片圆盘锯3。2.根据权利要求1所述的一种用于树障清理空中机器人的双锯刀具结构,其特征在于:还包括固定于或内置于刀具架(1的刀具控制器⑷。3.根据权利要求1所述的一种用于树障清理空中机器人的双锯刀具结构,其特征在于:还包括位于刀具架1后部并与空中机器人机械臂连接的接头5。4.根据权利要求1所述的一种用于树障清理空中机器人的双锯刀具结构,其特征在于:双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。5.根据权利要求1所述的一种用于树障清理空中机器人的双锯刀具结构,其特征在于:刀具架⑴上安装有温度传感器6,温度传感器6的探头正对圆盘锯3的边缘,刀具电机⑵内置感知圆盘锯⑶转速的转速传感器。6.根据权利要求5所述的一种用于树障清理空中机器人的双锯刀具结构,其特征在于:温度传感器6和转速传感器连接到刀具控制器4,刀具控制器4内置有检测刀具电机2工作电流的电流传感器,刀具控制器⑷连接到空中机器人的飞行控制器。7.根据权利要求1-6任一所述的一种用于树障清理空中机器人的双锯刀具结构的控制方法,其特征在于:该方法为:刀具控制器4通过采集刀具电机2的转速与电流以及圆盘锯⑶的温度,①实时评估圆盘锯⑶的过载、卡阻及损伤状态,一旦评估值超过预定门限,即向刀具电机⑵输出刹车指令,然后驱动两片圆盘锯⑶同时反转,被清理树枝退出刀具,同时向空中机器人的飞行控制器发送回退指令,对空中机器人及刀具实施保护性退避;②对双刀具的平衡作业状态进行检测并实施补偿保护。8.根据权利要求7所述的一种用于树障清理空中机器人的双锯刀具结构的控制方法,其特征在于:评估圆盘锯3运行状态的方法采用多传感器数据门限判定算法,算法如下:1若当前圆盘锯⑶转速N彡其过载阈值Ncive3rIciad,或电机电流I多其过载阈值I_ri〇ad,或锯片温度T彡其过载阈值T_rlciad,判定圆盘锯⑶处于过载状态,刀具控制器⑷据此做出反旋回退控制;2若当前圆盘锯⑶转速N彡其卡阻阈值Nblc^king,且电机电流I多其卡阻阈值Iblc^king,判定圆盘锯⑶处于卡阻状态,其中,!^。。!^!^〈!^^—,!^。。!^!^^!^^^,刀具控制器⑷据此做出反旋回退控制;3若当前圆盘锯(3转速N多其空切阈值Ne3mpty,判定圆盘锯(3处于空切状态,其中,NemptyS圆盘锯3的给定转速,刀具控制器4据此做出圆盘锯3停转控制;4若圆盘锯⑶转速或电机电流出现周期性脉动,则判定圆盘锯⑶存在损伤;5不属于1-4的情况时,判定圆盘锯3当前工作在正常状态,刀具控制器4据此做出正常的正旋进给控制。9.根据权利要求7所述的一种用于树障清理空中机器人的双锯刀具结构的控制方法,其特征在于:评估圆盘锯3运行状态的方法采用多传感器数据融合检测算法,算法如下:设圆盘锯3转速的下限阈值为N1、上限阈值为N2,电机电流的下限阈值为I1、上限阈值为12,锯片温度的下限阈值为!\、上限阈值为T2,圆盘锯3工作状态综合指数为:其中,CnXiXt分别为圆盘锯3的转速权重、电机电流权重、锯片温度权重;设置区间阈值fi、、f3,且有O彡fl〈f2〈f3;当F彡心时,则判定圆盘锯⑶工作于空切状态,刀具控制器4据此做出圆盘锯⑶停转控制;当AfFSf2时,则判定圆盘锯3工作于正常状态,刀具控制器4据此实施清障进给控制;当f2f3时,则判定圆盘锯3工作于卡阻状态,刀具控制器4据此做出反旋回退控制。10.根据权利要求7所述的一种用于树障清理空中机器人的双锯刀具结构的控制方法,其特征在于:双刀具平衡作业状态检测与补偿保护方法如下:1双刀具平衡作业状态的检测方法设两个圆盘锯3的平均转速分别为,瞬时转速分别为Na、Nb;设电机的平均电流分别为,瞬时电流分别为Ia、Ib;设锯片的平均温度分别为,瞬时温度分别为Ta、Tb;定义两个圆盘锯3的平均转速差,瞬时转速差ΔN=Na-Nb;电机的平均电流差,瞬时电流差AI=Ia-Ib;锯片的平均温度差,瞬时温度差AT=Ta-Tb,有:A若,|ΔΝ|δΝ.、|ΔΙ|彡δ〗、、IΔΤ|彡δτ中任一成立,判定两个圆盘锯3平衡作业失常,其中的,:δτ均大于等于〇,分别为各对应物理参数的平衡作业判定阈值;Β若,判定两个圆盘锯(3平衡作业失常,其中的δ多0,为平衡作业综合判定阈值,la〜k6为权值系数;2双刀具平衡补偿及保护控制方法将各圆盘锯3的转速、电机电流、锯片温度及平衡作业状态信息反馈给空中机器人的飞行控制器,若判定两个圆盘锯3平衡作业失常,则A刀具控制器4立即做出先刹车后反旋控制,使圆盘锯(3退出作业,同时向空中机器人的飞行控制器发送保护性回退指令;B由飞行控制器控制空中机器人向转速高、电流小、温度低的一侧圆盘锯(3运动微调,实施双刀具平衡补偿。

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

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