CN108513817A - 作业臂可伸缩且纵向弯曲的树障清理空中机器人和方法 - Google Patents

Abstract

本发明公开了一种作业臂可伸缩且纵向弯曲的树障清理空中机器人和方法，包括为空中机器人提供升力的多旋翼平台、固定连接在多旋翼平台正下方的机身、位于空中机器人左右对称面内且与机身纵向轴平行的中臂和后臂、通过内置驱动电机的纵向弯曲关节与中臂前端相连的前臂、固连于前臂前端的刀具组件、固连于后臂后端的电池组，前臂和后臂共轴活动嵌套。本发明在前臂与中臂间设置纵向弯曲关节，可使作业臂在纵向平面内弯曲，确保作业刀具垂直于待清理树枝，有效提升树障清理效率，减少刀具打滑，空中机器人通过作业刀具组件、提供飞行动力和进给动力的多旋翼平台，清理树障，效率高，避免操作人员靠近树障处的高压输电线，操作更加安全。

Description

作业臂可伸缩且纵向弯曲的树障清理空中机器人和方法

技术领域

本发明涉及一种作业臂可伸缩且纵向弯曲的树障清理空中机器人和方法，属于输电线路树障清理装置技术领域。

背景技术

树障是输电线路通道存在的一种安全隐患，表现为通道内树木的不断增生逐渐威胁到输电线路的运行安全。为此，各级电力部门每年都要投入大量的人力、物力与财力对辖区内的通道树障进行清理整治。目前的树障清理主要依赖于人工清理，存在着效率不高，安全风险大的不足，因此亟需一种电力线路通道树障自动清理空中机器人。

发明内容

本发明解决的技术问题是：提供一种作业臂可伸缩且纵向弯曲的树障清理空中机器人和方法，能够实现机器人前后方向重心位置的自动调节，清理效率高，安全性好，纵向弯曲关节适合于进入树障与导线密集相交区域实施清障作业，以解决现有技术中存在的人工清理效率不高和安全风险大的问题。

本发明采取的技术方案为：一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，包括为空中机器人提供飞行动力的多旋翼平台、固定连接在多旋翼平台正下方的机身、位于空中机器人左右对称面内且与机身纵向轴平行的中臂和后臂、通过内置驱动电机的纵向弯曲关节与中臂前端相连的前臂、固连于前臂前端的刀具组件、固连于后臂后端的电池组，前臂和后臂共轴活动嵌套。

优选的，上述中臂以前后滑动方式从机身的前方与其连接，后臂以前后滑动方式从机身的后方与其连接，机身内置驱动中臂前后滑动的中臂电机和驱动后臂前后滑动的后臂电机。

优选的，上述多旋翼平台包括左右对称布置的M个电动旋翼，M≥4且为偶数。

优选的，上述前臂为两段结构，并通过保护关节连接为一体，保护关节包括固定叉、十字轴、活动叉、圆柱套、弹簧和螺钉，固定叉、活动叉、圆柱套均为中空圆柱形，十字轴分别通过轴承与固定叉的前部、活动叉的后部连接，由此构成万向节，固定叉的后部与前臂的后段固连，圆柱套的前部与前臂的前段固连，圆柱套的后部以可轴向滑动、可相对旋转的套筒形式与活动叉的前部连接，弹簧为圆柱形，以包裹形式安装于固定叉、活动叉和圆柱套的外部，弹簧的两端通过两螺钉分别与固定叉和圆柱套固连。

优选的，上述机身为前后狭长结构。

优选的，上述电池组包括向刀具组件供电的电池和用于飞行控制器供电的电池。

优选的，上述空中机器人，其作业臂动态伸缩调节方法如下：

设左右对称的空中机器人重心为O，多旋翼平台旋翼布局的前后对称面为S0，过O点且平行于S0的面为S，则重心O的前后位置可根据悬停时所有旋翼的转速控制量综合计算获得，首先有俯仰力矩平衡方程

式中，F_i为面S前方旋翼i的升力，F_j为面S后方旋翼j的升力，L_i为面S前方旋翼i至面S的距离，L_j为面S后方旋翼j至面S的距离，m、n为偶数，且m+n＝M，设翼的转速控制量与旋翼升力成正比，则上式转化为

式中，N_i为面S前方旋翼i的转速控制量，N_j为面S后方旋翼j的转速控制量，将面S前方所有旋翼等效为一个前部等效旋翼，将面S后方所有旋翼等效为一个后部等效旋翼，则有

式中，L_F为前部等效旋翼至面S的距离，L_R为后部等效旋翼至面S的距离，计算重心偏移系数

若Q＝1，说明重心O与多旋翼平台的几何中心水平投影重合，即回中，前臂与后臂的长度不需调整；若Q<1，说明重心偏前，可调短前臂或调长后臂使重心后移回中；若Q>1，说明重心偏后，可调长前臂或调短后臂使重心前移回中。

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

1)本发明在前臂与中臂之间设置纵向弯曲关节，通过在纵向平面内弯曲作业臂，使作业刀具尽可能垂直于待清理树枝进行作业，从而有效提升树障清理效率，减少刀具打滑；该空中机器人整合了树障清理专用刀具组件与提供飞行动力和进给动力的多旋翼平台，清理树障效率高，避免操作人员靠近树障处的高压输电线，有效降低风险提高作业安全性，解决了现有技术中存在的人工清理效率不高和安全风险大的问题；

2)本发明采用同步伸展或收缩的中臂与后臂结构，便于空中机器人重心位置的前后自动调节，确保空中机器人的姿态稳定，且有利于工程实现；

3)中臂与后臂收缩后，有效缩小了整机尺寸，便于收纳与携带；

4)电池组置于空中机器人的后臂上，起到良好的配重作用，同时中臂与后臂相对机体均可前后动态伸缩，方便空中机器人重心的快速调节，相对单边调节，调节更加快速；

5)本发明采用中臂电机和后臂电机分别带动中臂与后臂进行伸缩，重心调节更加精确；

6)空中机器人由多旋翼平台提供升力并实施姿态稳定与位置控制，作业时结合纵向弯曲关节的同步控制以实现清障进给，系统结构与控制方式简单，易于工程实现；狭长扁平机构的空中机器人，配合纵向弯曲关节，适合于进入树障密集或与导线相交区域实施清障作业；

7)所设置的保护关节具有四个方向的机械缓冲自由度，可有效减弱树障反作用力或力矩以及刀具组件的振动对空中机器人飞行姿态的影响。

附图说明

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

图2为保护关节结构示意图。

图中，1—多旋翼平台，2—机身，3—前臂，4—中臂，5—后臂，6—刀具组件，7—纵向弯曲关节，8—电池组，12—保护关节。

1201—固定叉，1202—十字轴，1203—活动叉，1204—圆柱套，1205—弹簧，1206—螺钉。

具体实施方式

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

实施例1：如图1-图2所示，一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，包括为空中机器人提供飞行动力的多旋翼平台1、固定连接在多旋翼平台1正下方的机身2、位于空中机器人左右对称面内且与机身2纵向轴平行的中臂4和后臂5、通过内置驱动电机的纵向弯曲关节7与中臂4前端相连的前臂3、固连于前臂3前端的刀具组件6、固连于后臂5后端的电池组8，中臂4和后臂5共轴活动嵌套；纵向弯曲关节7类似于现有的机器人的机械臂，通过电机与减速器驱动机械臂弯曲，刀具组件6通过可拆卸的接头连接到前臂3的前端，接头具有机械与电气双重连接功能，采用法兰盘连接或螺帽-螺杆快速连接，相应的连接部位设有电气接插头，便于快速装卸或更换；多旋翼平台1内置用于空中机器人姿态稳定与轨迹控制的飞行控制器、用于传输飞行数据与机载图像的通信模块，其中飞行控制器与现有的多旋翼无人机飞行控制器硬件相似。

优选的，上述中臂4以前后滑动方式从机身2的前方与其连接，后臂5以前后滑动方式从机身2的后方与其连接，机身2内置驱动中臂4前后滑动的中臂电机和驱动后臂5前后滑动的后臂电机。当空中机器人悬停时，通过中臂电机驱动的中臂4与通过后臂电机驱动的后臂5，两者的伸展或收缩保持比例同步，以确保整机重心始终与多旋翼平台1的几何中心水平投影重合；中臂电机固定连接在机身2上，中臂电机的输出轴固定连接中臂齿轮，与中臂齿轮相啮合的中臂齿条固定连接在中臂4上，后臂电机固定连接在机身2上，后臂电机的输出轴固定连接后臂齿轮，与后臂齿轮相啮合的后臂齿条固定连接在后臂5上。

优选的，上述多旋翼平台1包括左右对称布置的M个电动旋翼，M≥4且为偶数。

优选的，上述空中机器人，其作业臂动态伸缩调节方法如下：

设左右对称的空中机器人重心为O，多旋翼平台1上左旋旋翼与右旋旋翼的数量、尺寸及材质相同，定义旋翼布局的前后对称面为S0，过O点的S0的平行面为S，则重心O的前后位置可根据悬停时所有旋翼的转速控制量综合计算获得，首先有俯仰力矩平衡方程

式中，F_i为面S前方旋翼i的升力，F_j为面S后方旋翼j的升力，L_i为面S前方旋翼i至面S的距离，L_j为面S后方旋翼j至面S的距离，m、n为偶数，分别为面S前方旋翼和后方旋翼的数量，且m+n＝M，设旋翼的转速控制量与其旋翼升力成正比，则上式转化为

式中，N_i为面S前方旋翼i的转速控制量，N_j为面S后方旋翼j的转速控制量。将面S前方所有旋翼等效为一个前部等效旋翼，将面S后方所有旋翼等效为一个后部等效旋翼，则有

式中，L_F为前部等效旋翼至面S的距离，L_R为后部等效旋翼至面S的距离，计算重心偏移系数

若Q＝1，说明重心O与多旋翼平台1的几何中心水平投影重合，即回中，中臂4与后臂5的长度不需调整；若Q<1，说明重心偏前，可调短中臂4或调长后臂5使重心后移回中；若Q>1，说明重心偏后，可调长中臂4或调短后臂5使重心前移回中。

优选的，上述前臂3为两段结构，并通过保护关节12连接为一体；如图2所示，保护关节12具有受力缓冲与作业力度感知功能，包括固定叉1201、十字轴1202、活动叉1203、圆柱套1204、弹簧1205和螺钉1206，固定叉1201、活动叉1203、圆柱套1204均为中空圆柱形，十字轴1202分别通过轴承与固定叉1201的前部、活动叉1203的后部连接，由此构成具有上下旋转(俯仰)和左右旋转(航向)自由度的万向节，固定叉1201的后部与前臂3的后段固连，圆柱套1204的前部与前臂3的前段固连，圆柱套1204的后部以可轴向滑动、可相对旋转(滚转)的套筒形式与活动叉1203的前部连接，弹簧1205为圆柱形，以包裹形式安装于固定叉1201、活动叉1203和圆柱套1204的外部，弹簧1205的两端通过两螺钉1206分别与固定叉1201和圆柱套1204固连。保护关节12拥有四个方向的机械缓冲自由度，可有效减弱树障反作用力或力矩以及刀具组件6的振动对空中机器人飞行姿态的影响。

十字轴1202与固定叉1201之间设有感知二者相对左右旋转(航向)幅度的航向角度传感器，十字轴1202与活动叉1203之间设有感知二者相对上下旋转(俯仰)幅度的俯仰角度传感器，圆柱套1204与活动叉1203之间设有感知二者轴向相对运动(轴向)幅度的轴向位移传感器、感知二者相对旋转运动(滚转)幅度的滚转角度传感器，因此保护关节12可感知刀具组件6所受四个方向的树障反作用力或力矩，并作为刀具清障进给或保护退出、空中机器人运动微调的控制输入，使清障控制更加精确。

上述角度传感器可采用光电编码器或电位器，位移传感器可采用滑动变阻器或光栅尺，所述飞行控制器针对以上两种传感器，设有相应的模拟量(电压或电流)或数字量(包括总线)、脉冲量、频率量等类型接口，还针对多旋翼平台1的动力装置设置PWM或总线接口，针对通信模块和刀具组件6内置的刀具控制器设置总线接口。所述总线包括CAN、RS-485/422/232、以太网或机载总线等类型。

采用标定方法标定保护关节12的两端(圆柱套1204与固定叉1201)相对受力-位移或受力矩-角度的曲线，从而得出保护关节12的轴向刚度曲线、俯仰刚度曲线、航向刚度曲线和扭转刚度曲线，通过各刚度曲线和对应的位移或角度，即可求得保护关节12两端的受力或力矩。

优选的，基于保护关节12的空中机器人控制方法如下：

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

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

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

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

——若X＜λ_X-δ_X，飞行控制器控制空中机器人沿刀具平面向前运动微调，使轴向力增大，实现轴向自动作业进给；

——若|X-λ_X|≤δ_X，飞行控制器控制空中机器人保持悬停，轴向进给量为零；

——若X＞λ_X+δ_X，飞行控制器控制空中机器人沿刀具平面向后运动微调，使轴向力减小，实现轴向自动保护回退。

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

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

——若||N|-λ_N|≤δ_N，飞行控制器控制空中机器人保持当前航向，水平侧向进给量为零；

——若|N|＞λ_N+δ_N，飞行控制器控制空中机器人向使|N|减小的方向运动微调航向，实现水平侧向自动保护回退。

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

——若|M|＞δ_M，飞行控制器控制空中机器人向使|M|减小的方向运动微调高度；

——若|M|≤δ_M，飞行控制器控制空中机器人保持当前高度。

优选的，上述机身2为前后狭长结构。

优选的，上述电池组8包括向刀具组件6供电的电池和用于飞行控制器供电的电池。

多旋翼平台1包括平台支架、固定连接在平台支架上的多个电动旋翼(数量为≥4的偶数)，电动旋翼包括旋翼和旋翼电机，旋翼固定连接在旋翼电机的输出轴上，旋翼电机固定连接在平台支架上。

刀具组件6包括刀具杆和连接在刀具杆上的作业刀具，作业刀具连接有驱动电机，驱动电机固定连接在刀具杆上，刀具杆通过前述接头连接在前臂3的前端。

优选的，空中机器人机身2的下方设有起落架。

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

Claims (7)

1.一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：包括为空中机器人提供飞行动力的多旋翼平台(1)、固定连接在多旋翼平台(1)正下方的机身(2)、位于空中机器人左右对称面内且与机身(2)纵向轴平行的中臂(4)和后臂(5)、通过内置驱动电机的纵向弯曲关节(7)与中臂(4)前端相连的前臂(3)、固连于前臂(3)前端的刀具组件(6)、固连于后臂(5)后端的电池组(8)，中臂(4)和后臂(5)共轴活动嵌套。

2.根据权利要求1所述的一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：中臂(4)以前后滑动方式从机身(2)的前方与其连接，后臂(5)以前后滑动方式从机身(2)的后方与其连接，机身(2)内置驱动中臂(4)前后滑动的中臂电机和驱动后臂(5)前后滑动的后臂电机。

3.根据权利要求1所述的一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：多旋翼平台(1)包括左右对称布置的M个电动旋翼，M≥4且为偶数。

4.根据权利要求1所述的一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：前臂(3)为两段结构，并通过保护关节(12)连接为一体，保护关节(12)包括固定叉(1201)、十字轴(1202)、活动叉(1203)、圆柱套(1204)、弹簧(1205)和螺钉(1206)，固定叉(1201)、活动叉(1203)、圆柱套(1204)均为中空圆柱形，十字轴(1202)分别通过轴承与固定叉(1201)的前部、活动叉(1203)的后部连接，由此构成万向节，固定叉(1201)的后部与前臂(3)的后段固连，圆柱套(1204)的前部与前臂(3)的前段固连，圆柱套(1204)的后部以可轴向滑动、可相对旋转的套筒形式与活动叉(1203)的前部连接，弹簧(1205)为圆柱形，以包裹形式安装于固定叉(1201)、活动叉(1203)和圆柱套(1204)的外部，弹簧(1205)的两端通过两螺钉(1206)分别与固定叉(1201)和圆柱套(1204)固连。

5.根据权利要求1所述的一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：机身(2)为前后狭长结构。

6.根据权利要求1所述的一种作业臂可伸缩且纵向弯曲的树障清理空中机器人，其特征在于：电池组(8)包括向刀具组件(6)供电的电池和用于飞行控制器供电的电池。

7.根据权利要求1-6任一所述的一种作业臂可动态伸缩的树障清理空中机器人的伸缩调节方法，其特征在于：该方法如下：

设左右对称的空中机器人重心为O，多旋翼平台(1)旋翼布局的前后对称面为S0，过O点且平行于S0的面为S，则重心O的前后位置根据悬停时所有旋翼的转速控制量综合计算获得，首先有俯仰力矩平衡方程

式中，F_i为面S前方旋翼i的升力，F_j为面S后方旋翼j的升力，L_i为面S前方旋翼i至面S的距离，L_j为面S后方旋翼j至面S的距离，m、n为偶数，且m+n＝M，设旋翼的转速控制量与旋翼升力成正比，则上式转化为

式中，N_i为面S前方旋翼i的转速控制量，N_j为面S后方旋翼j的转速控制量，将面S前方所有旋翼等效为一个前部等效旋翼，将面S后方所有旋翼等效为一个后部等效旋翼，则有

式中，L_F为前部等效旋翼至面S的距离，L_R为后部等效旋翼至面S的距离，计算重心偏移系数

若Q＝1，说明重心O与多旋翼平台(1)的几何中心水平投影重合，即回中，中臂(4)与后臂(5)的长度不需调整；若Q<1，说明重心偏前，可调短中臂(4)或调长后臂(5)使重心后移回中；若Q>1，说明重心偏后，可调长中臂(4)或调短后臂(5)使重心前移回中。