【技术实现步骤摘要】
一种树障清理空中机器人的双锯刀具控制装置和控制方法
本专利技术涉及一种树障清理空中机器人的双锯刀具控制装置和控制方法,属于输电线路树障清理装置
技术介绍
树障是输电线路通道存在的一种安全隐患,表现为树木的增生极大地影响了输电线路的运行安全。各级电力部门每年都要投入大量的人力、物力对辖区内的树障进行清理整治,目前主要依赖于人工清理,效率不高,安全风险大,因此需要一种电力线路通道树障自动清理空中机器人。当空中机器人进行树障清理时,前端刀具会受到树木的轴向反作用力以及上下俯仰、左右偏航、滚转等反作用力矩,不利于空中机器人的飞行姿态稳定与控制。此外,目前园林修剪树枝多采用单锯类型的清理刀具,若将该类刀具直接安装于空中机器人上进行树障清理,刀具的水平受力不对称,易给空中机器人带来航向推斥力矩,一方面影响空中机器人力与力矩的平衡,另一方面造成刀具与树枝之间的打滑,导致切割效率不高。
技术实现思路
本专利技术解决的技术问题是:提供一种树障清理空中机器人的双锯刀具控制装置和控制方法,能够实现空中机器人及其双锯刀具的安全保护,以解决现有技术中存在的的问题。本专利技术采取的技术方案为:一种树障清理空中机器人的双锯刀具控制装置,包括连接在飞行平台和作业刀具间的作业臂上的保护关节,保护关节内置有感知树障作用于双圆盘锯的轴向力、俯仰力矩、航向力矩和滚转力矩的轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器,轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器连接到飞行平台内的飞行控制器,飞行控制器连接到刀具控制器和飞行平台内的飞行动力装置,刀具控制器连接着 ...
【技术保护点】
1.一种树障清理空中机器人的双锯刀具控制装置,其特征在于:包括连接在飞行平台(1)和双圆盘锯(8)间的作业臂上的保护关节(3),保护关节(3)内置有感知树障作用于双圆盘锯(8)的轴向力、俯仰力矩、航向力矩和滚转力矩的轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器,轴向力传感器、俯仰力矩传感器、航向力矩传感器和滚转力矩传感器连接到飞行平台(1)内的飞行控制器,飞行控制器连接到刀具控制器(5)和飞行平台(1)内的飞行动力装置,刀具控制器(5)连接着驱动双圆盘锯(8)的两个刀具电机(7)、感知双圆盘锯(8)转速与温度的两个转速传感器与两个温度传感器(9)、感知两个刀具电机(7)工作电流的两个电流传感器。
【技术特征摘要】
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≥0,有:若|N|>δN,飞行控制器控制飞行平台(1)向使|N|减小的方向进行航向微调,实现左右自动平衡调整;若|N|≤δN,飞行控制器控制飞行平台(1)保持当前航向;C)...
【专利技术属性】
技术研发人员:杨忠,徐浩,高承贵,袁正梅,王炜,陶坤,李捷文,王少辉,常乐,
申请(专利权)人:南京太司德智能科技有限公司,
类型:发明
国别省市:江苏,32
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。