本发明涉及一种用于树障清理空中机器人的折叠关节，属于输电线路树 障清理装置技术领域。
背景技术：
树障是输电线路通道存在的一种安全隐患，表现为通道内树木的不断增 生逐渐威胁到输电线路的运行安全。为此，各级电力部门每年都要投入大量 的人力、物力与财力对辖区内的通道树障进行清理整治。目前的树障清理主 要依赖于人工清理，存在着效率不高，安全风险大的不足，因此亟需一种电 力线路通道树障自动清理空中机器人。
用于树障清理的空中机器人，其携带作业刀具的作业臂一般较长，需要 设计一种兼顾伸展与收纳两种状态且具有锁定能力的折叠关节，使作业臂既 能达到伸展作业时的高强度标准，又能满足折叠收纳状态下的小体积、抗振 动、抗冲击及便于运输的要求。
技术实现要素：
本发明解决的技术问题是：提供一种用于树障清理空中机器人的折叠关 节，以解决现有技术中存在的占用空间大和不便运输的问题。
本发明采取的技术方案为：一种用于树障清理空中机器人的折叠关节， 包括设置在前臂后端的前拐臂、设置在后臂前端的后拐臂和伸展锁定装置， 前拐臂与后拐臂通过铰接轴铰接，并在折叠关节伸展时通过伸展锁定装置锁 定。
优选的，上述伸展锁定装置包括固连在后臂前端并与后臂共轴的台阶轴 一、固连在前臂后端并与前臂共轴的螺杆一和套接在台阶轴一上的锁定螺母 一，锁定螺母一的内孔后端设有内凸台阶，台阶轴一的前端设有防止锁定螺 母一脱落的外凸台阶，锁定螺母一可将台阶轴一与螺杆一共轴对接并锁定。
优选的，上述台阶轴一通过螺纹部连接到后臂并采用锁紧螺帽一锁紧。
优选的，上述前拐臂与后拐臂在折叠关节收纳时通过收纳锁定装置锁定。
优选的，上述收纳锁定装置包括固连在后臂底部并与后臂垂直的台阶轴 二、固连在前臂底部并与前臂垂直的螺杆二和套接在台阶轴二上的锁定螺母 二，锁定螺母二的内孔后端设有内凸台阶，台阶轴二的前端设有防止锁定螺 母二脱落的外凸台阶，锁定螺母二可将台阶轴二与螺杆二共轴对接并锁定。
优选的，上述台阶轴二和螺杆二分别通过可拆卸的螺纹连接方式连接到 后臂和前臂。
优选的，上述台阶轴二的螺纹部连接到后臂后采用锁紧螺帽二锁紧。
本发明的有益效果：与现有技术相比，本发明的效果如下：
1)本发明的折叠关节结构简单，可对机器人的作业臂进行快速伸展锁定 或收纳锁定，具有成本低廉、易于实现和操作方便的特点；收纳时占用空间 小，便于运输和放置，解决了现有技术中收纳放置占用空间大的问题；
2)采用螺纹部的台阶轴一长度可调并采用锁紧螺帽一锁紧，便于与螺杆 一抵靠紧密；采用锁定螺母一锁定后，折叠关节的伸展连接更可靠，能有效 避免振动导致的锁定松脱，并且操作方便快捷；
3)采用收纳锁定装置将折叠收纳后的作业臂及作业刀具固定，避免运输 过程中振动、冲击和摇晃导致作业臂、作业刀具乃至飞行平台的损坏，有效 提高了运输安全性；
4)该收纳锁定装置结构简单，固定和松开方便，而且采用可拆卸的螺杆 二和台阶轴二，在作业臂伸展后将其拆卸，可减轻空中机器人的重量，降低 能耗；需要收纳时再将其安装进行收纳锁定。
附图说明
图1为应用本发明的空中机器人结构示意图；
图2为减振装置结构示意图；
图3为折叠关节结构示意图(伸展锁定状态)；
图4为折叠关节结构示意图(收纳锁定状态)；
图5为保护关节结构示意图。
图中，1—旋翼，2—旋翼电机，3—平台支架，4—机体，5—电池组，6 —纵向推进器，7—涵道螺旋桨，8—减振装置，9—后臂，10—折叠关节，11 —前臂，12—保护关节，13—刀具杆，14—刀具电机，15—作业刀具，16— 接头，17—摄像头，19—机械臂，20—作业臂；
801—上板，802—弹簧-阻尼器，803—下板；
1001—前拐臂，1002—后拐臂，1003—铰接轴，1004—台阶轴一，1005 —锁定螺母一，1006—螺杆一，1007—锁紧螺帽一，1008—台阶轴二，1009 —锁定螺母二，1010—螺杆二，1011—锁紧螺帽二；
1201—固定叉，1202—十字轴，1203—活动叉，1204—圆柱套，1205— 弹簧，1206—螺钉。
具体实施方式
下面，结合附图及具体的实施例对本发明进行进一步介绍。
实施例1：如图3-图4所示，一种用于树障清理空中机器人的折叠关节， 该折叠关节10包括设置在前臂11后端的前拐臂1001、设置在后臂9前端的 后拐臂1002和伸展锁定装置，前拐臂1001与后拐臂1002通过铰接轴1003 铰接，并在折叠关节10伸展时采用伸展锁定装置锁定。
优选的，上述伸展锁定装置包括固连在后臂9前端并与后臂9共轴的台 阶轴一1004、固连在前臂11后端并与前臂11共轴的螺杆一1006和套接在台 阶轴一1004上的锁定螺母一1005，锁定螺母一1005的内孔后端设有内凸台 阶，台阶轴一1004的前端设有防止锁定螺母一1005脱落的外凸台阶，锁定 螺母一1005可将台阶轴一1004与螺杆一1006共轴对接并锁定。
优选的，上述台阶轴一1004通过螺纹部连接到后臂9并采用锁紧螺帽一 1007锁紧。
该伸展锁定装置可实现台阶轴一1004相对后臂9的长度伸缩，便于将台 阶轴一1004与螺杆一1006抵靠紧密；采用锁定螺母一1005锁定后，装置的 连接更可靠，能有效避免振动导致的锁定松脱；台阶轴一1004通过锁紧螺帽 一1007进行长度锁紧，操作方便快捷。此外，伸展锁定时，通过调整台阶轴 一1004的长度可调节前臂11与后臂9的同轴度(缺省为同轴)。
优选的，上述前拐臂1001与后拐臂1002在折叠关节10收纳时通过收纳 锁定装置锁定。
优选的，上述收纳锁定装置包括固连在后臂9底部并与后臂9垂直的台 阶轴二1008、固连在前臂11底部并与前臂11垂直的螺杆二1010和套接在台 阶轴二1008上的锁定螺母二1009，锁定螺母二1009的内孔后端设有内凸台 阶，台阶轴二1008的前端设有防止锁定螺母二1009脱落的外凸台阶，锁定 螺母二1009可将台阶轴二1008与螺杆二1010共轴对接并锁定。
优选的，上述台阶轴二1008和螺杆二1010均分别通过可拆卸的螺纹连 接方式连接到后臂9和前臂11。因此，在折叠关节10伸展时，台阶轴二1008 和螺杆二1010可被拆卸，以减轻重量并降低能耗。
优选的，上述台阶轴二1008的螺纹部连接到后臂9后采用锁紧螺帽二 1011锁紧。
该收纳锁定装置可实现台阶轴二1008相对后臂9的长度伸缩，便于将台 阶轴二1008与螺杆二1010抵靠紧密；采用锁定螺母二1009锁定后，装置的 连接更可靠，能有效避免振动导致的锁定松脱；台阶轴二1008通过锁紧螺帽 二1011进行长度锁紧，操作方便快捷。此外，折叠收纳时，通过调整台阶轴 二1008的长度可调节前臂11与后臂9的平行度(缺省为平行)。
实施例2：如图1-图5所示，上述折叠关节用于树障清理空中机器人， 该机器人包括平台支架3和作业刀具15，平台支架3对称连接在机体4上， 机体4位于平台支架3的中心部位，平台支架3上连接有多个旋翼组件，机 体4上安装有提供前后推进动力且左右对称的两个纵向推进器6，纵向推进器 6为涵道构型，内置可正反旋转以提供正反推力的涵道螺旋桨7，机体4的前 端通过作业臂20连接到作业刀具15，纵向推进器6朝向作业刀具15方向安 装，作业刀具15连接有刀具电机14，刀具电机14固定连接在作业臂20的前 端；还包括安装于平台支架3或机体4上用于空中机器人姿态稳定与轨迹控 制的飞行控制器、用于传输飞行数据与机载图像的通信模块，其中飞行控制 器与现有的多旋翼无人机飞行控制器硬件相似，包括惯性测量单元(IMU)、 气压高度计、卫星导航接收机、飞行控制计算机。
优选的，上述作业臂20包括机械臂19和刀具杆13，机械臂19一端固定 连接在机体4上，另一端通过接头16固定连接刀具杆13，接头16具有机械 与电气连接功能，便于快速装卸或更换，收纳更方便；接头16采用法兰盘连 接或螺帽-螺杆快速连接，相应的连接部位设有电气接插头。
优选的，上述平台支架3或机体4或作业臂20上安装有摄像头17，摄像 头17的镜头朝向作业刀具15方向；摄像头17安装在作业臂20上时采用套 接架；摄像头17用于监视前方树障的外部形态、树障的被清理状况、作业刀 具15的工作状态，便于进行作业刀具15的进给或退出控制。
优选的，刀具电机14连接有驱动其旋转的刀具控制器，刀具控制器内置 于作业臂20或机体4内，并与飞行控制器连接；刀具控制器设有电机驱动接 口，以及用于刀具相关传感器信号输入的模拟量或数字量、脉冲量、频率量 等类型接口，所述传感器包括感知电机电流、感知刀具转速和感知刀具温度 的传感器。
优选的，上述机械臂19采用折叠结构，包括相互连接的前臂11和后臂9； 前臂11和后臂9为多边形截面管或圆管。
优选的，上述后臂9的前端通过折叠关节10连接在前臂11的后端，折 叠关节10可对作业臂20进行快速伸展锁定或折叠收纳。
优选的，上述作业臂20为两段结构，并通过保护关节12连接为一体； 如图1、图5所示，保护关节12具有受力缓冲与作业力度感知功能，包括固 定叉1201、十字轴1202、活动叉1203、圆柱套1204、弹簧1205和螺钉1206， 固定叉1201、活动叉1203、圆柱套1204均为中空圆柱形，十字轴1202分别 通过轴承与固定叉1201的前部、活动叉1203的后部连接，由此构成具有上 下旋转(俯仰)和左右旋转(航向)自由度的万向节，固定叉1201的后部与 作业臂20的后段固连，圆柱套1204的前部与作业臂20的前段固连，圆柱套 1204的后部以可轴向滑动、可相对旋转(滚转)的套筒形式与活动叉1203的 前部连接，弹簧1205为圆柱形，以包裹形式安装于固定叉1201、活动叉1203 和圆柱套1204的外部，弹簧1205的两端通过两螺钉1206分别与固定叉1201 和圆柱套1204固连。保护关节12拥有四个方向的机械缓冲自由度，可有效 减弱树障反作用力或力矩以及作业刀具15的振动对空中机器人飞行姿态的影 响。
十字轴1202与固定叉1201之间设有感知二者相对左右旋转(航向)幅 度的航向角度传感器，十字轴1202与活动叉1203之间设有感知二者相对上 下旋转(俯仰)幅度的俯仰角度传感器，圆柱套1204与活动叉1203之间设 有感知二者轴向相对运动(轴向)幅度的轴向位移传感器、感知二者相对旋 转运动(滚转)幅度的滚转角度传感器，因此保护关节12可感知作业刀具15 所受四个方向的树障反作用力或力矩，并作为刀具进给或退出、空中机器人 运动微调的控制输入，使清障控制更加精确。其中，上述各角度传感器可采 用光电编码器或电位器，上述位移传感器可采用滑动变阻器或光栅尺，作用 力或力矩的计算：通过各位移传感器和角度传感器测得的位移与弹簧的拉伸 刚度、弯曲刚度以及扭转刚度，进行计算获得各个作用力(拉伸或压缩)或 力矩(俯仰力矩、航向力矩、扭转力矩)。
采用标定方法标定保护关节12的两端(圆柱套1204与固定叉1201)相 对受力-位移或受力矩-角度的曲线，从而得出保护关节12的轴向刚度曲线、 俯仰刚度曲线、航向刚度曲线和扭转刚度曲线，通过各刚度曲线和对应的位 移或角度，即可求得保护关节12两端的受力或力矩。
所述飞行控制器针对上述角度传感器和位移传感器，设有相应的模拟量 (电压或电流)或数字量(包括总线)、脉冲量、频率量等类型接口，还针对 旋翼组件设置PWM或总线接口，针对通信模块和刀具控制器设置总线接口。 所述总线包括CAN、RS-485/422/232、以太网或机载总线等类型。
优选的，上述纵向推进器6的推力轴线与作业刀具15的旋转平面重合， 使得纵向推进器6的进给推力正向施加在作业刀具15上，避免对空中机器人 的俯仰姿态产生附加力矩，从而有利于空中机器人的稳定与控制。
优选的，上述旋翼组件包括旋翼1和旋翼电机2以及电机调速器，旋翼1 固定连接在旋翼电机2的输出轴上，旋翼电机2固定连接在平台支架3上， 相邻旋翼组件的旋翼1转向相反；电机调速器接收飞行控制器的转速指令， 并依此驱动旋翼电机2转动；旋翼组件的数量为≥4的偶数。
旋翼组件还可采用如下共轴双桨方式：旋翼组件中的旋翼1、旋翼电机2 和电机调速器各有一对，两个旋翼电机2尾部相对、转轴向外、上下共轴安 装于平台支架3的外端，两个旋翼1为正反旋向配对，分别安装于两个旋翼 电机2的转轴上，通过调整电机调速器与旋翼电机2连线的极性使同一旋翼 组件的两个旋翼1的升力均为向上。该方式下旋翼组件的数量≥3。
优选的，上述机体4的下端设置有减振装置8，作业臂20通过减振装置 8连接到机体4的下端。如图2所示，减振装置8包括上板801、下板803和 弹簧-阻尼器802，上板801与机体4固连，下板803通过一组或多组左右对 称分布的弹簧-阻尼器802连接到上板801，后臂9与下板803连接。
优选的，上述作业臂20活动地穿过减振装置8的下板803并在其后端固 定连接电池组5，通过锁紧螺栓可将作业臂20锁紧在减振装置8上，由此可 对空中机器人的整体重心进行调节。
优选的，减振装置8后端通过伸缩杆固定连接电池组5，并采用锁紧螺栓 对伸缩杆进行锁定，由此可对空中机器人的整体重心进行调节。
优选的，电池组5包括向旋翼组件供电、向纵向推进器6供电、向刀具 电机14和刀具控制器供电、向飞行控制器和机载传感器供电的电池。
优选的，刀具结构的外侧设有防止枝叶飞溅或锯片碎裂后飞射的安全保 护罩。
优选的，机体4底部还设置有起落架。
优选的，机体4中设置有飞行控制器，实现的功能包括：
1)实时采集空中机器人的姿态角、角速率、加速度、卫星定位、高度信 息，结合地面遥控指令(通过飞行控制器与地面遥控器的无线连接)，计算所 有旋翼的转速指令并输出给上述旋翼组件，以实现空中机器人姿态与位置的 稳定与控制；
2)根据地面遥控指令生成纵向推进器6的输出控制指令，实现树障清理 时空中机器人水平姿态下的向前进给或向后退出控制；
3)通过保护关节12感知的作业刀具15所受树障轴向反作用力或俯仰、 航向、滚转反作用力矩，一旦达到或超过预定的保护门限，可判定作业刀具 15处于过载状态，即令刀具控制器和飞行控制器自动同步进入保护模式：控 制作业刀具15先刹车后反转，同时控制空中机器人向后运动退出作业；若上 述反作用力或力矩小于预定的保护门限，将作为空中机器人运动微调的控制 输入，具体的控制方法如下：
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，飞行控制器控制空中机器人保持当前高度；
4)根据刀具控制器采集的电机电流与刀具转速信息，实时评估作业刀具 15的过载、卡阻及损伤状态，评估方法如下：
——若电机电流超过电流预定门限，可判定作业刀具15过载或卡阻；
——若刀具转速低于转速预定门限，可判定作业刀具15过载或卡阻；
——若电机电流或刀具转速出现周期性的脉动，可判定作业刀具15有损 伤。原因在于，往复工作的作业刀具15若存在缺损，其所受树障的阻力将呈 现周期性的脉动现象，由此引起电机电流或刀具转速的周期性脉动。
一旦出现上述任一情况即快速通过刀具控制器向刀具电机14输出先刹车 后反转指令、向纵向推进器6输出反向推力指令，以实现空中机器人保护性 退避，同时通过所述通信模块向地面人员发送安全报警信息。
上述空中机器人具有如下优点：
1)本发明通过在机体上安装旋翼组件、纵向推进器以及作业刀具，能够 实现输电线路树障的空中快速清理，避免操作人员靠近树障处的高压输电线， 操作更加安全，可有效提升清理作业的效率并降低操作风险，解决了现有技 术中存在的人工清理效率不高和安全风险大的问题；
2)空中机器人前臂与后臂之间采用折叠方式或伸缩方式连接，有效缩小 了整机尺寸，便于收纳与携带，伸缩方式也便于重心位置的调整；
3)空中机器人由旋翼组件提供机器人升力并实施姿态稳定与位置控制， 由纵向推进器实施清障的作业刀具进给与退出控制，这种组合驱动的控制方 式解耦，十分有利于工程实现；
4)空中机器人总体结构扁平，适合于进入树障密集或与导线相交区域实 施清障作业；
5)通过摄像头可对树障的外部形态、树障清理的效果进行近距离观察， 实时监视作业刀具的工作状态；
6)所设置的保护关节具有四个方向的机械缓冲自由度，可有效减弱树障 反作用力或力矩对空中机器人飞行姿态的影响；
7)将纵向推进器的推力轴线设置与作业刀具的旋转平面重合，使得纵向 推进器的进给推力正向施加在作业刀具上，避免对空中机器人的俯仰姿态产 生附加力矩，从而有利于空中机器人的稳定与控制；
8)通过减振装置可有效滤除作业刀具的振动对机体的影响；
9)电池组置于空中机器人的后部，起到良好的配重作用，同时作业臂相 对机体可前后调节或电池组通过伸缩杆连接到机体后部，可实现空中机器人 重心快速调节；
10)本空中机器人可用于对大型设备与建筑物进行高空安装、清洁或维 修等作业。
以上所述，仅为本发明的具体实施方式实例，本发明的保护范围并不局 限于此。熟悉该技术领域的技术人员在本发明披露的技术范围内，可轻易找 到变化或替换方式，这些都应涵盖在本发明的保护范围之内。为此，本发明 的保护范围应以所述权利要求的保护范围为准。