[发明专利]一种树障清理空中机器人的刀具保护装置和方法

权利要求书

1.一种树障清理空中机器人的刀具保护装置，其特征在于：包括连接在飞行平台(1)和作业刀具(8)间的作业臂上的保护关节(3)，保护关节(3)内置有感知树障作用于作业刀具(8)的轴向力、俯仰力矩、航向力矩和滚转力矩的轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器，轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器连接到飞行平台(1)内的飞行控制器，飞行控制器连接到刀具控制器(5)和飞行平台(1)内的飞行动力装置，刀具控制器(5)连接着驱动作业刀具(8)的刀具电机(7)、感知作业刀具(8)转速与温度的转速传感器与温度传感器(9)、感知刀具电机(7)工作电流的电流传感器。

2.根据权利要求1所述的一种树障清理空中机器人的刀具保护装置的保护方法，其特征在于：该方法如下：

1)通过保护关节(3)感知的作业刀具(8)所受树障轴向反作用力或俯仰、航向、滚转反作用力矩，一旦达到或超过预定的保护门限，判定刀具处于过载状态，即令刀具控制器(5)和飞行控制器自动同步进入保护模式：控制作业刀具(8)先刹车后反转，同时控制空中机器人向后运动退出作业。

2)步骤1)中反作用力或力矩若小于预定的保护门限，将作为空中机器人运动微调的控制输入，具体控制方法如下：

A)设清理树障时保护关节(3)感知的轴向力为X，向后为正，相应的作业门限为λ_X、不灵敏区为δ_X，其中，λ_X＞0，0≤δ_X＜λ_X，有：

若X<0，判定空中机器人受到树障的前向拉力，飞行控制器可采取如下方法之一：①控制飞行平台(1)向前运动微调，若X正向增加则继续当前清障作业，若X不变或负向增加则转到②；②控制飞行平台(1)进入悬停状态，同时通过飞行平台(1)内的通信模块向地面人员发送安全报警信息，以求人工干预；

若X＜λ_X-δ_X，飞行控制器控制飞行平台(1)向前运动微调，使轴向力增大，实现轴向自动作业进给；

若|X-λ_X|≤δ_X，飞行控制器控制飞行平台(1)保持悬停，轴向进给量为零；

若X＞λ_X+δ_X，飞行控制器控制飞行平台(1)向后运动微调，使轴向力减小，实现轴向自动保护回退；

B)设清理树障时保护关节(3)感知的航向力矩为N，俯视向右为正，相应的作业门限为λ_N、不灵敏区为δ_N，其中，λ_N＞0，0≤δ_N＜λ_N，有：

若|N|＜λ_N-δ_N，飞行控制器控制飞行平台(1)向使|N|增大的方向运动微调航向，实现水平侧向自动作业进给；

若||N|-λ_N|≤δ_N，飞行控制器控制飞行平台(1)保持当前航向，水平侧向进给量为零；

若|N|＞λ_N+δ_N，飞行控制器控制飞行平台(1)向使|N|减小的方向运动微调航向，实现水平侧向自动保护回退；

C)设清理树障时保护关节(3)感知的俯仰力矩为M，向上为正，相应的不灵敏区为δ_M，其中，δ_M≥0，有：

若|M|＞δ_M，飞行控制器控制飞行平台(1)向使|M|减小的方向运动微调高度；

若|M|≤δ_M，飞行控制器控制飞行平台(1)保持当前高度。

3.根据权利要求1所述的一种树障清理空中机器人的刀具保护装置的保护方法，其特征在于：该方法如下：

在树障清理过程中，根据刀具控制器(5)所感知的刀具转速、刀具温度和电机电流，可对刀具的过载、卡阻及损伤状态进行评估：

1)若电机电流超过电流预定门限，判定刀具过载或卡阻；

2)若刀具转速低于转速预定门限，判定刀具过载或卡阻；

3)若刀具温度超过温度预定门限，判定刀具过载或卡阻；

4)若电机电流或刀具转速出现周期性的脉动，判定刀具有损伤；

一旦出现1)-4)中任一情况，即快速通过刀具控制器(5)向刀具电机(7)输出先刹车后反转指令、通过飞行控制器向飞行动力装置输出反向回退指令，以实现空中机器人保护性退避，同时通过飞行平台(1)内的通信模块向地面人员发送安全报警信息。