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

Abstract

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

Description

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

技术领域

本发明涉及一种用于电力线路树障清理空中机器人的双绳锯刀具结构和控制方法，属于输电线路树障清理装置技术领域。

背景技术

空中机器人在对电力线路通道树障进行清理时，所用刀具应能快速切割树枝，同时又能避免对空中机器人本体姿态的影响，并且具有防卡阻等安全保护措施。

目前园林修剪树枝多采用单锯类型的清理刀具，若将该类刀具直接安装于空中机器人上进行树障清理，刀具的水平受力不对称，易给空中机器人带来航向推斥力矩，一方面影响空中机器人力与力矩的平衡，另一方面造成刀具与树枝之间的打滑，导致切割效率不高。此外，常用的圆盘锯或链锯多为金属材质，结构较重，占用空间较大，空中机器人的续航能力影响较大。

发明内容

本发明解决的技术问题是：提供用于树障清理空中机器人的双绳锯刀具结构和控制方法，以解决现有技术中存在的问题。

本发明采取的技术方案为：用于树障清理空中机器人的双绳锯刀具结构，包括Y型刀具架、左右对称安装于刀具架前部末端的两个刀具电机、由两个刀具电机分别驱动且位于刀具架下方的两片中心盘，中心盘的四周呈辐射状对称固定有多条绳锯，绳锯的另一端为自由端，该自由端运动形成的回转圆的直径小于两个刀具电机转轴的中心距。

优选的，上述用于树障清理空中机器人的双绳锯刀具结构，还包括固定于或内置于刀具架的刀具控制器。

优选的，上述用于树障清理空中机器人的双绳锯刀具结构，还包括位于刀具架后部并与空中机器人机械臂连接的接头。

优选的，上述绳锯为钢丝绳锯、耐磨复合材料绳锯。

优选的，上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。

优选的，上述刀具电机内置感知绳锯转速的转速传感器。

优选的，上述转速传感器连接到刀具控制器，刀具控制器内置有检测刀具电机工作电流的电流传感器，刀具控制器连接到空中机器人的飞行控制器。

用于树障清理空中机器人的双绳锯刀具结构的控制方法，该方法为：刀具控制器通过采集刀具电机的转速和电流，①实时评估绳锯的过载与卡阻状态，一旦评估值超过预定门限，即向刀具电机输出刹车指令，然后驱动两条绳锯同时反转，以使被清理树枝退出刀具，同时向空中机器人的飞行控制器发送回退指令，从而对空中机器人及刀具实施保护性退避；②对双刀具的平衡作业状态进行检测并实施补偿保护。

优选的，上述评估绳锯运行状态的方法采用多传感器数据门限判定算法，算法如下：

1)若当前绳锯转速N≤其过载阈值N_overload，或电机电流I≥其过载阈值I_overload，判定绳锯处于过载状态，刀具控制器据此做出反旋回退控制；

2)若当前绳锯转速N≤其卡阻阈值N_blocking，且电机电流I≥其卡阻阈值I_blocking，判定绳锯处于卡阻状态，其中，N_blocking<N_overload，I_blocking≥I_overload，刀具控制器据此做出反旋回退控制；

3)若当前绳锯转速N≥其空切阈值N_empty，判定绳锯处于空切状态，其中，N_empty≤绳锯的给定转速，刀具控制器据此做出绳锯停转控制；

4)不属于上述情况时，判定绳锯当前工作在正常状态，刀具控制器据此做出正常的正旋进给控制。

优选的，上述评估绳锯运行状态的方法采用多传感器数据融合检测算法，算法如下：

设绳锯转速的下限阈值为N₁、上限阈值为N₂，电机电流的下限阈值为I₁、上限阈值为I₂，绳锯工作状态综合指数为：

其中，C_N、C_IT分别为绳锯的转速权重和电机电流权重；设置区间阈值f₁、f₂、f₃，且有0≤f₁<f₂<f₃；

当F≤f₁时，则判定绳锯工作于空切状态，刀具控制器据此做出绳锯停转控制；

当f₁＜F≤f₂时，则判定绳锯工作于正常状态，刀具控制器据此实施清障进给控制；

当f₂＜F≤f₃时，则判定绳锯工作于过载状态，刀具控制器据此做出反旋回退控制；

当F＞f₃时，则判定绳锯工作于卡阻状态，刀具控制器据此做出反旋回退控制。

优选的，上述双刀具平衡作业状态检测与补偿保护方法如下：

1)双刀具平衡作业状态的检测算法

设两个绳锯的平均转速分别为瞬时转速分别为N_a、N_b；设电机的平均电流分别为/>瞬时电流分别为I_a、I_b。

定义两个绳锯的平均转速差瞬时转速差ΔN＝N_a-N_b；电机的平均电流差/>瞬时电流差ΔI＝I_a-I_b；有：

A)若中任一成立，判定两个绳锯平衡作业失常，其中的/>均大于等于0，分别为各对应物理参数的平衡作业判定阈值；

B)若判定两个绳锯平衡作业失常，其中的δ≥0，为平衡作业综合判定阈值，k₁～k₄为权值系数；

2)双刀具平衡补偿及保护控制方法

将各绳锯的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器，若判定两个绳锯平衡作业失常，则

A)刀具控制器立即做出先刹车后反旋控制，使绳锯退出作业，同时向空中机器人的飞行控制器发送保护性回退指令；

B)由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯运动微调，实施双刀具平衡补偿。

本发明的有益效果：与现有技术相比，本发明的效果如下：

1)本发明双绳锯刀具结构，结构轻，占用空间小；作业时，刀具整体一边向树障推进，一边驱动双绳锯向内相向同速旋转，使树枝自动进入双绳锯的共同切割区域，从而有效降低作用于空中机器人的水平不平衡力与力矩，避免刀具与树枝之间的打滑，提高树障清理的效率，相比圆盘锯或链锯切割，绳锯具有一定的柔性，具备自动退让功能，切割过程中更加不容易出现过载、卡阻及损伤状态，使用更加安全，重量更轻，更便于控制空中机器人的姿态和稳定性；

2)采用转速监测，能够实时判断刀具运行状态是否良好，提高作业安全性，刀具控制器通过采集刀具电机的转速和电流，判断绳锯的过载与卡阻状态，有利于实现刀具与空中机器人的保护性退避，并实现双绳盘锯作业的动态平衡；

3)模块化的接头方式，可实现刀具的快速更换，且装卸收纳运输方便，而且接头起到机械连接和电气连接的双重作用，结构更加紧凑。

附图说明

图1为本发明的结构示意图；

图2为本发明的俯视结构示意图；

图3为本发明的三片绳锯结构示意图。

图中，1—刀具架，2—刀具电机，3—绳锯，4—刀具控制器，5—接头，6—中心盘。

具体实施方式

下面，结合附图及具体的实施例对本发明进行进一步介绍。

实施例1：如图1-图3所示，用于树障清理空中机器人的双绳锯刀具结构，包括Y型刀具架1、左右对称安装于刀具架1前部末端的两个刀具电机2、由两个刀具电机2分别驱动且位于刀具架1下方的两片中心盘6，中心盘6的四周呈辐射状对称固定有多条绳锯3，绳锯3的另一端为自由端，该自由端运动形成的回转圆的直径小于两个刀具电机2转轴的中心距。

优选的，上述用于树障清理空中机器人的双绳锯刀具结构，还包括固定于或内置于刀具架1的刀具控制器4。

优选的，上述用于树障清理空中机器人的双绳锯刀具结构，还包括位于刀具架1后部并与空中机器人机械臂连接的接头5；接头5采用法兰盘连接或螺帽-螺杆快速连接，相应的连接部位设有电气接插头，因此接头5具有机械和电气双重连接功能，结构紧凑，可实现刀具的快速更换。

优选的，上述绳锯3为钢丝绳锯、耐磨复合材料绳锯。

优选的，上述双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。

优选的，上述刀具电机2内置感知绳锯3转速的转速传感器，通过转速传感器能够实时监控作业刀具的转速情况，从而判断作业刀具的运行状态，提高操作安全性。

优选的，上述转速传感器连接到刀具控制器4，刀具控制器4内置有检测刀具电机2工作电流的电流传感器，刀具控制器4连接到空中机器人的飞行控制器；通过转速传感器以及电流传感器，刀具控制器4可实时监控绳锯3的转速和电机电流，判断两个绳锯3的工作状态，做出正常进给或回退保护或双锯动态切割平衡的调整，同时将该状态信息发送到飞行控制器，飞行控制器据此实施空中机器人的进给或退出微调，自动实现刀具的切割保护和有效切割。

上述转速传感器可采用光电编码器或霍尔传感器，电流传感器可采用电流互感器；刀具控制器4定制设有针对上述具体类型传感器的模拟量(电压或电流)或数字量(包括总线)、脉冲量、频率量等类型接口。

双绳刀具结构通过接头5从空中机器人平台获取刀具控制指令与驱动电源，送入刀具控制器4，以驱动刀具电机2旋转并控制其转速；树障清理时，两条绳锯3向内相向等速旋转，以自动卷入被清理树枝并实施切割。

实施例2：一种用于树障清理空中机器人的双绳锯刀具结构的控制方法，该方法为：刀具控制器4通过采集刀具电机2的转速和电流，①实时评估绳锯3的过载与卡阻状态，一旦评估值超过预定门限，即向刀具电机2输出刹车指令，然后驱动两条绳锯3同时反转，以使被清理树枝退出刀具，同时向空中机器人的飞行控制器发送回退指令，从而对空中机器人及刀具实施保护性退避；②对双刀具的平衡作业状态进行检测并实施补偿保护。

优选的，上述评估绳锯运行状态的方法采用多传感器数据门限判定算法，算法如下：

1)若当前绳锯3转速N≤其过载阈值N_overload，或电机电流I≥其过载阈值I_overload，判定绳锯3处于过载状态，刀具控制器4据此做出反旋回退控制；

2)若当前绳锯3转速N≤其卡阻阈值N_blocking，且电机电流I≥其卡阻阈值I_blocking，判定绳锯3处于卡阻状态，其中，N_blocking<N_overload，I_blocking≥I_overload，刀具控制器4据此做出反旋回退控制；

3)若当前绳锯3转速N≥其空切阈值N_empty，判定绳锯3处于空切状态，其中，N_empty≤绳锯3的给定转速，刀具控制器4据此做出绳锯3停转控制；

4)不属于上述情况时，判定绳锯3当前工作在正常状态，刀具控制器4据此做出正常的正旋进给控制。

优选的，上述评估绳锯运行状态的方法采用多传感器数据融合检测算法，算法如下：

设绳锯3转速的下限阈值为N₁、上限阈值为N₂，电机电流的下限阈值为I₁、上限阈值为I₂，绳锯3工作状态综合指数为：

其中，C_N、C_IT分别为绳锯3的转速权重和电机电流权重；设置区间阈值f₁、f₂、f₃，且有0≤f₁<f₂<f₃；

当F≤f₁时，则判定绳锯3工作于空切状态，刀具控制器4据此做出绳锯3停转控制；

当f₁＜F≤f₂时，则判定绳锯3工作于正常状态，刀具控制器4据此实施清障进给控制；

当f₂＜F≤f₃时，则判定绳锯3工作于过载状态，刀具控制器4据此做出反旋回退控制；

当F＞f₃时，则判定绳锯3工作于卡阻状态，刀具控制器4据此做出反旋回退控制。

优选的，上述双刀具平衡作业状态检测与补偿保护方法如下：

1)双刀具平衡作业状态的检测算法

设两个绳锯3的平均转速分别为瞬时转速分别为N_a、N_b；设电机的平均电流分别为/>瞬时电流分别为I_a、I_b；

定义两个绳锯3的平均转速差瞬时转速差ΔN＝N_a-N_b；电机的平均电流差/>瞬时电流差ΔI＝I_a-I_b；有：

A)若中任一成立，判定两个绳锯3平衡作业失常，其中的/>均大于等于0，分别为各对应物理参数的平衡作业判定阈值；

B)若判定两个绳锯3平衡作业失常，其中的δ≥0，为平衡作业综合判定阈值，k₁～k₄为权值系数；

2)双刀具平衡补偿及保护控制方法

将各绳锯3的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器，若判定两个绳锯3平衡作业失常，则

A)刀具控制器4立即做出先刹车后反旋控制，使绳锯3退出作业，同时向空中机器人的飞行控制器发送保护性回退指令；

B)由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯3运动微调，实施双刀具平衡补偿。

以上阈值和权值系数的确定，可采用基于物理原理的理论计算、基于实验数据分析的经验统计、基于神经网络的建模训练等方法来完成。

本发明的优点如下：

1)双绳锯设计，向内相向同速旋转，可自动卷入树枝并实施切割，树障清理效率高，作用于空中机器人上的水平不平衡力与力矩相对较小；

2)刀具控制器4通过采集刀具电机2的转速和电流，判断绳锯的过载与卡阻状态，有利于实现刀具与空中机器人的保护性退避，并实现保双绳盘锯作业的动态平衡；

3)模块化设计与接头方式，可实现刀具的快速更换；

4)本发明整体重量较轻，占用空间较小，有利于空中机器人携带作业。

以上所述，仅为本发明的具体实施方式实例，本发明的保护范围并不局限于此。熟悉该技术领域的技术人员在本发明揭露的技术范围内，可轻易找到变化或替换方式，这些都应涵盖在本发明的保护范围之内。为此，本发明的保护范围应以所述权利要求的保护范围为准。

Claims (5)

1.用于树障清理空中机器人的双绳锯刀具结构，其特征在于：包括Y型刀具架(1)、左右对称安装于刀具架(1)前部末端的两个刀具电机(2)、由两个刀具电机(2)分别驱动且位于刀具架(1)下方的两片中心盘(6)，中心盘(6)的四周呈辐射状对称固定有多条绳锯(3)，绳锯(3)的另一端为自由端，该自由端运动形成的回转圆的直径小于两个刀具电机(2)转轴的中心距；还包括固定于或内置于刀具架(1)的刀具控制器(4)；

用于树障清理空中机器人的双绳锯刀具结构的控制方法为：刀具控制器(4)通过采集刀具电机(2)的转速和电流，①实时评估绳锯(3)的过载与卡阻状态，一旦评估值超过预定门限，即向刀具电机(2)输出刹车指令，然后驱动两条绳锯(3)同时反转，以使被清理树枝退出刀具，同时向空中机器人的飞行控制器发送回退指令，从而对空中机器人及刀具实施保护性退避；②对双刀具的平衡作业状态进行检测并实施补偿保护；

评估绳锯运行状态的方法采用多传感器数据门限判定算法，算法如下：

1)若当前绳锯(3)转速N≤其过载阈值N_overload，或电机电流I≥其过载阈值I_overload，判定绳锯(3)处于过载状态，刀具控制器(4)据此做出反旋回退控制；

2)若当前绳锯(3)转速N≤其卡阻阈值N_blocking，且电机电流I≥其卡阻阈值I_blocking，判定绳锯(3)处于卡阻状态，其中，N_blocking<N_overload，I_blocking≥I_overload，刀具控制器(4)据此做出反旋回退控制；

3)若当前绳锯(3)转速N≥其空切阈值N_empty，判定绳锯(3)处于空切状态，其中，N_empty≤绳锯(3)的给定转速，刀具控制器(4)据此做出绳锯(3)停转控制；

4)不属于1)-3)的情况时，判定绳锯(3)当前工作在正常状态，刀具控制器(4)据此做出正常的正旋进给控制；

评估绳锯运行状态的方法采用多传感器数据融合检测算法，算法如下：

设绳锯(3)转速的下限阈值为N₁、上限阈值为N₂，电机电流的下限阈值为I₁、上限阈值为I₂，绳锯(3)工作状态综合指数为：

其中，C_N、C_IT分别为绳锯(3)的转速权重和电机电流权重；设置区间阈值f₁、f₂、f₃，且有0≤f₁<f₂<f₃；

当F≤f₁时，则判定绳锯(3)工作于空切状态，刀具控制器(4)据此做出绳锯(3)停转控制；

当f₁＜F≤f₂时，则判定绳锯(3)工作于正常状态，刀具控制器(4)据此实施清障进给控制；

当f₂＜F≤f₃时，则判定绳锯(3)工作于过载状态，刀具控制器(4)据此做出反旋回退控制；

当F＞f₃时，则判定绳锯(3)工作于卡阻状态，刀具控制器(4)据此做出反旋回退控制；

双刀具平衡作业状态检测与补偿保护方法如下：

1)双刀具平衡作业状态的检测算法

设两个绳锯(3)的平均转速分别为瞬时转速分别为N_a、N_b；设电机的平均电流分别为/>瞬时电流分别为I_a、I_b；

定义两个绳锯(3)的平均转速差瞬时转速差ΔN＝N_a-N_b；电机的平均电流差/>瞬时电流差ΔI＝I_a-I_b；有：

A)若|ΔN|≥δ_N、/>|ΔI|≥δ_I中任一成立，判定两个绳锯(3)平衡作业失常，其中的/>δ_N、/>δ_I均大于等于0，分别为各对应物理参数的平衡作业判定阈值；

B)若判定两个绳锯(3)平衡作业失常，其中的δ≥0，为平衡作业综合判定阈值，k₁～k₄为权值系数；

2)双刀具平衡补偿及保护控制方法

将各绳锯(3)的转速、电机电流及平衡作业状态信息反馈给空中机器人的飞行控制器，若判定两个绳锯(3)平衡作业失常，则

A)刀具控制器(4)立即做出先刹车后反旋控制，使绳锯(3)退出作业，同时向空中机器人的飞行控制器发送保护性回退指令；

B)由飞行控制器控制空中机器人向转速高、电流小的一侧绳锯(3)运动微调，实施双刀具平衡补偿。

2.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构，其特征在于：还包括位于刀具架(1)后部并与空中机器人机械臂连接的接头(5)。

3.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构，其特征在于：双锯刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保护罩。

4.根据权利要求1所述的用于树障清理空中机器人的双绳锯刀具结构，其特征在于：刀具电机(2)内置感知绳锯(3)转速的转速传感器。

5.根据权利要求4所述的用于树障清理空中机器人的双绳锯刀具结构，其特征在于：转速传感器连接到刀具控制器(4)，刀具控制器(4)内置有检测刀具电机(2)工作电流的电流传感器，刀具控制器(4)连接到空中机器人的飞行控制器。