CN105794502B - 一种全自动树枝修剪机器人及修剪方法 - Google Patents

Abstract

本发明涉及一种全自动树枝修剪机器人，由全地形底盘移动平台、电控单元、可分离末端执行单元、机械臂、执行单元释放和回收机构、视觉导航机构、大容量锂电池组成。本发明不仅设计了全新的针对树干高度较高的树枝修剪机器人，实现了对树木枝干的自动识别、计算、测量和自动修剪，还提出了相对应的该发明机械结构和电气连接相关的修剪步骤和方法，填补了当前市场上全自动修剪机器人、高空树木修剪机器人的空白，提高了树枝修剪的效率，降低了工作人员的劳动强度，减少了社会公共服务的运营成本。

Description

一种全自动树枝修剪机器人及修剪方法

技术领域

本发明涉及一种针对杨树、梧桐等树木的树枝进行修剪的机器人，还涉及与机械和电气结构配套的修剪方法，属于机械、自动化及机器人技术领域。

背景技术

园林树木修剪是园林建设中的一项极为重要的技术措施，树木修剪的作用是：调节树体结构，促进生长平衡，消除树体隐患，恢复树木生机。另外，修剪还可以保持树木的健康生长和良好树形，便于管理和具有更高的观赏价值，防止对人们生命财产的损害，收到艺术上的美学效果。

随着中国城镇化建设的发展，各城镇的绿化面积不断增加，因此由大量的树枝需要进行修剪。然而，要修剪高度较高的树枝难度较大，目前，主要借助可移动的升降工具，由多名树枝修剪工人手持切割工具进行修剪。这样修剪树枝对工人的劳动强度较大，效率不高，且工人作业时存在一定的安全隐患。

目前大多数果树修剪器为手持式修剪器，手持式果树修剪机一般由手柄、电机、圆盘锯片和电源线组成，所述的手柄一端通过电机外壳与电机连接，另一端设有电源线，手柄外侧设有控制开关，这样的结构不能对高出维护人员臂长范围内的枝干进行修剪，需要借用爬梯来完成，增强了劳动的强度，而且需要电源线来供电，使用空间有局限，而且电源线容易被损坏，导致安全性差。当然国内还有一些修剪车，但是修剪车一般并没有配备专门的修剪刀头，仍然需要人工进行辅助操作，实现对高空树木的树枝修剪工作。

例如，实用新型专利201420539702.2公布了一种用于树木修剪的移动机器人，包括：滚轮式车体行进机构，所述滚轮式车体行进机构的行进方式采用调整两个独立电机轮转速实现转弯；所述电机可控制圆盘锯的旋转，所述控制系统可控制横杆的旋转。该树木修剪机器人动力充沛、操作简单、运行稳定，而且节约人力成本、灵活度高。但是该实用新型专利仍旧需要人工进行操作，且并不能对树木枝干较高的杨树等树木进行修剪，存在一定弊端。

发明专利201410512605.9则公开了一种枝条修剪粉碎机器人及方法，包括机械手臂、安装在机械手臂前端的修剪末端执行器、控制单元、摄像机；该发明集对枝条进行选择性剪枝与粉碎为一体，减少了为了枝条粉碎进行的枝条搬运环节，可以进行实时粉碎。而且利用枝条和树叶就地粉碎的碎末作为有机肥料，返回到土壤中，降低了生产成本，减少了作物对化学合成肥料的使用量，促进了有机水果产业的发展。但是该发明专利存在一个致命弱点，即：树木的枝条可修剪范围受机械手长度的制约，对于那些高大的树木树枝或树木较高位置的树枝的修剪无能为力。

发明专利201310046491.9公布了一种杨树自动修枝装置，包括：攀爬机构、旋转机构和修枝锯执行机构。攀爬机构集驱动与压紧功能于一体，在保证车轮压紧树干的同时，为机器爬升提供所需动力；旋转机构通过连接支撑杆固定在攀爬机构的上部，实现绕树干的整周转动；修枝锯执行机构固定在旋转机构上，修枝锯电机及圆盘锯在电动推杆的作用下可在径向方向进给，到达所需剪枝位置，修枝锯高速旋转沿树枝侧向锯切，完成修枝操作。该杨树自动修枝装置结构简单、操作方便、定位准确，并且修枝自动化程度高，无需人工直接参与，安全性好。能够实现贴近主干进行修枝，有利于减小枝桩长度，减少死节，提高木材质量。但是该发明专利的压紧功能由于弹簧弹力和行程有限，只能对某一直径范围内的树干有效，对于过粗、过细的树干并不适用。更重要的，如果树干的上下部分直径不同，则该装置失效。另外，该装置的自动化程度不高，仍然需要人工的操作，浪费人力和物力。

为了提高树枝修剪的效率，尽可能的适用高低树木树枝的修剪，降低工人劳动强度，因此设计一种全自动的树木修剪机器人非常必要。

发明内容

本发明的目的在于针对现有技术的不足，提供一种全自动树枝修剪机器人，可以实现对杨树、梧桐等高度较高的树木进行树枝修剪，本发明还提供该机器人的修剪方法。

本发明解决其技术问题所采用的技术方案是：

一种全自动树枝修剪机器人，包括全地形底盘移动平台、电控单元、可分离末端执行单元、机械臂、执行单元释放和回收机构、视觉导航机构、大容量锂电池，所述电控单元、机械臂、视觉导航机构、大容量锂电池安装于全地形底盘移动平台上，所述机械臂的顶部通过执行单元释放和回收机构与可分离末端执行单元连接，所述大容量锂电池与机器人用电器件连接并为其供电。

所述电控单元由控制柜、微型工控机、底盘移动平台驱动器、导航摄像机三维云台驱动器、电磁吸盘驱动器、绕线辊驱动器、爬高步进电机驱动器、抱紧伸缩电机驱动器、刀距伸缩步进电机驱动器、直流电机驱动器、转向减速电机驱动器组成。

所述可分离末端执行单元由执行单元本体、张合机构、爬高抱紧转向机构、刀距调节机构、刀体及驱动机构组成，执行单元本体为筒形支架，分为左半圆柱支撑体、右半圆柱支撑体，张合机构包括张合支架、张合伺服电机，爬高抱紧转向机构由爬高轮组、抱紧伸缩电机、爬高齿轮组、爬高步进电机、转向减速电机、压力传感器组成，刀距调节机构包括刀距伸缩步进电机、刀距调节载体平台，刀体及驱动机构包括刀体、直流电机。

所述执行单元释放和回收机构由环形钢叉、电磁吸盘、电动绕线辊组成，环形钢叉为本体支架结构，上端面安装固定电磁吸盘，电动绕线辊固定在环形钢叉的侧面。

所述视觉导航机构由道路导航摄像机、双目立体视觉摄像机、导航摄像机三维云台、立体视觉摄像机支架组成，道路导航摄像机通过导航摄像机三维云台固定在全地形底盘移动平台前方，立体视觉摄像机支架底部通过螺栓结构固定在全地形底盘移动平台的前端，双目立体视觉摄像机固定于立体视觉摄像机支架的顶部。

上述全自动树枝修剪机器人的修剪方法，其特征在于，包括以下步骤：

St1：道路导航摄像机通过导航摄像机三维云台固定在全地形底盘移动平台前方，导航摄像机三维云台驱动器的驱动下，导航摄像机三维云台可以实现空间三维的运动，进而带动道路导航摄像机三维运动，实现对全地形底盘移动平台周围环境状况及前方道路状况的监控和自主导航运动；同时，微型工控机控制底盘移动平台驱动器驱动全地形底盘移动平台前进；

St2：当发现需要修剪的树枝时，全地形底盘移动平台放慢速度前进，慢慢靠近需要修剪的树木，进入可控范围内，最终实现树木处于全地形底盘移动平台的前方或侧前方；

St3：此后双目立体视觉摄像机开始工作，实现对树木的空间三维坐标定位，定位完毕后，微型工控机控制机械臂带动可分离末端执行单元、执行单元释放和回收机构靠近树干；在该过程中，微型工控机通过驱动张合伺服电机控制张合支架的打开，进而带动左半圆柱支撑体和右半圆柱支撑体的打开，最终带动执行单元本体的打开，实现对执行单元本体对树干的进入；执行单元本体进入树干后，微型工控机通过驱动张合伺服电机带动执行单元本体闭合，实现对树干的全方位包裹；在上述过程的开端，双目立体视觉摄像机还需要确定树干的粗细、需要修剪树枝的高度及树枝的分布等信息；

St4：此后为可分离末端执行单元和执行单元释放和回收机构分离过程，过程为：微型工控机控制电磁吸盘驱动器掉电操作，从而使得电磁吸盘和可分离末端执行单元之间没有吸合力，从而为下一步的分离提供电气控制条件；

St5：所述爬高抱紧转向机构开始工作，过程为：由于所述爬高轮组为橡胶轮子和支架结构，轮子主要用来实现与树干的摩擦压紧作用，微型工控机通过控制爬高步进电机驱动器进而实现对爬高步进电机的驱动，通过爬高齿轮组的传动作用，实现对爬高轮组的驱动，此时爬高轮组上橡胶轮子开始在树干上旋转，进而带动整套可分离末端执行单元沿树干上升；在该过程中，由于可分离末端执行单元与执行单元释放和回收机构开始分离，距离变长，因此需要通过微型工控机控制绕线辊驱动器驱动电动绕线辊进行放线；同时，在该过程中，所述压力传感器安装在爬高轮组上，可以实时监测轮组与树干的压力，发送至控制器，供控制器分析处理后，控制抱紧伸缩电机的运动，实现执行单元本体与爬高轮组的距离可调，从而控制爬高轮组与树干的压力值恒定；

St6：爬高抱紧转向机构继续上升到需要修剪的树枝高度后停止运动，由于在步骤St3中已经由双目立体视觉摄像机确定了树干的粗细、需要修剪树枝的高度及树枝的分布等信息，此时开始进入刀距调整过程，具体过程为：微型工控机通过控制刀距伸缩步进电机驱动器驱动刀距伸缩步进电机实现转轴的伸缩，进而带动刀体及驱动机构的前进和后退，进而实现刀体和执行单元本体轴心处距离的调整，当调整到位后，爬高抱紧转向机构停止工作；

St7：该过程为刀体旋转和切割过程，当然旋转和切割过程为同时进行的，具体步骤为：

①旋转过程：所述转向减速电机的本体安装在抱紧伸缩电机的伸缩机构上，转向减速电机的转轴则安装爬高轮组的本体上，通过转向减速电机的运动，可以带动爬高轮组的转向，从而实现爬高轮组任意角度的转向；当爬高轮组的轴线与树干的轴线垂直时，爬高轮组可以带动整套执行单元本体沿树干外周的切线方向转动，即实现了围绕树干的圆周运动，如果此时执行单元本体上设置有树枝修剪机构，则可以实现对树干上树枝的修剪；由于爬高轮组的任意角度可调，此时可以带动爬高轮组沿任意角度实现对树干的攀爬，不受树枝的影响；

②切割过程：在上述旋转过程中，由于整套刀体及驱动机构会触碰到需要修剪的树枝，因此该过程中，微型工控机控制直流电机驱动器驱动直流电机高速旋转，进而带动刀体的铝合金锯片高速旋转，实现对待修剪树枝的修剪作用；

St8：当上述过程中的旋转过程和切割过程进行一个周期后，则该树干区域内的多余树枝已经被修剪、清楚干净，如果需要继续修剪上部的树枝，此时重复St5-St7过程；

St9：当一颗树干上的所有需要修剪的树枝被修剪完毕后，修剪机器人上的可分离末端执行单元开始进入回收阶段，具体的为：像步骤St5过程一样，只是爬高抱紧转向机构开始向下工作，进入下降阶段，下降到较低的高度时，此时爬高抱紧转向机构所在的高度与修剪机器人上所在的执行单元释放和回收机构的上端面一致或者稍高于执行单元释放和回收机构时，开始进入对可分离末端执行单元的回收工作；在爬高抱紧转向机构下降过程中，由于可分离末端执行单元与执行单元释放和回收机构开始靠近，距离变短，因此需要通过微型工控机控制绕线辊驱动器驱动电动绕线辊进行收线操作；

St10：在该过程中，进入可分离末端执行单元与树干的分离过程，具体为：微型工控机通过驱动张合伺服电机，从而控制张合支架的打开，进而带动左半圆柱支撑体和右半圆柱支撑体的打开，最终带动执行单元本体的打开，实现对执行单元本体对树干的可分离；

St11：此后，由于可分离末端执行单元与树干已经分离，此后为可分离末端执行单元和执行单元释放和回收机构的回收过程，过程为：微型工控机控制电磁吸盘驱动器得电操作，从而使得电磁吸盘和可分离末端执行单元之间产生吸合力，从而可分离末端执行单元被执行单元释放和回收机构回收，至此，全自动树枝修剪机器人完成一棵树干的树枝修剪工作。

本发明的有益效果是：

(1)本发明不仅设计了全新的针对树干高度较高的树枝修剪机器人，实现了对树木枝干的自动识别、计算、测量和自动修剪，还提出了相对应的该发明机械结构和电气连接相关的修剪步骤和方法，填补了当前市场上全自动修剪机器人、高空树木修剪机器人的空白，提高了树枝修剪的效率，降低了工作人员的劳动强度，减少了社会公共服务的运营成本。

(2)本发明通过加入视觉导航机构，实现对树干的粗细、需要修剪树枝的高度及树枝的分布等信息的无接触式测量，为后续的全自动修剪机器人的自动修剪功能奠定了基础，对于促进提高我国树枝修剪机械的现代化、智能化和无人化具有不可估量的意义。

(3)本发明通过设计全新的执行单元释放和回收机构，利用环形钢叉、电磁吸盘、电动绕线辊的作用，并配合机械臂，实现对特定金属部件或机构回收和释放工作，当然，该结构不仅可以与本发明中的可分离末端执行单元配合使用，还可以应用到其它类似结构的机构回收和释放结构中去，通用性广，结构简单，实用程度高。

(4)本发明通过设计的可分离末端执行单元和执行单元释放和回收机构的配合动作，并且利用电动绕线辊的收线和放线作用，用以连接可分离末端执行单元和执行单元释放和回收机构之间的电气连接，实现了树枝修剪机构和机器人本体的分离，可以完全实现修剪机构的脱离本体工作，克服了现有的机器人在进行对高度较高的树干进行树枝修剪时需要使用加上机械臂的弊端，降低了树枝修剪机器人的成本。

附图说明

图1为本发明全自动树枝修剪机器人的立体结构示意图。

图2为本发明全自动树枝修剪机器人的主视结构示意图。

图3为本发明全自动树枝修剪机器人的电控单元结构示意图。

图4为本发明全自动树枝修剪机器人的执行单元释放和回收机构结构示意图。

图5为本发明全自动树枝修剪机器人的可分离末端执行单元的立体结构示意图。

图6为本发明全自动树枝修剪机器人的可分离末端执行单元的俯视结构示意图。

图7为本发明全自动树枝修剪机器人的刀体及驱动机构结构示意图。

图8为本发明全自动树枝修剪机器人的爬高抱紧转向机构结构示意图。

具体实施方式

下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

如图1、图2所示，一种全自动树枝修剪机器人，包括全地形底盘移动平台1、电控单元2、可分离末端执行单元3、机械臂4、执行单元释放和回收机构5、视觉导航机构6、大容量锂电池7，所述电控单元2、机械臂4、视觉导航机构6、大容量锂电池7安装于全地形底盘移动平台1上，所述机械臂4的顶部通过执行单元释放和回收机构5与可分离末端执行单元3连接，所述大容量锂电池7与机器人用电器件连接并为其供电。

所述全地形底盘移动平台1为履带式四轮移动平台，具备悬挂系统，悬挂系统上的四杆机构通过变形可以提高机器人的越障能力。同时通过差速车体的主动控制，增强运行过程中车体的平稳性。另外，前、后四个轮子均装有转向装置，可以实现机器人的原地转向。每个轮子单独驱动增强了机器人的前进动力和越障性能。因为修剪机器人工作在室外，路面的状况不定，因此需要这种结构才能为整套的修剪机构等提供安全和稳定保障。

如图3所示，所述电控单元2由控制柜21、微型工控机22、底盘移动平台驱动器23、导航摄像机三维云台驱动器24、电磁吸盘驱动器25、绕线辊驱动器26、爬高步进电机驱动器27、抱紧伸缩电机驱动器28、刀距伸缩步进电机驱动器29、直流电机驱动器2-10、转向减速电机驱动器2-11组成。上述中的所有电控模块，包括微型工控机22、底盘移动平台驱动器23等均连接大容量锂电池7。且微型工控机22为整套智能机器人的控制、决策核心，底盘移动平台驱动器23可以实现对全地形底盘移动平台1的驱动，导航摄像机三维云台驱动器24可以实现对导航摄像机三维云台63的驱动，电磁吸盘驱动器25实现对电磁吸盘52的驱动，绕线辊驱动器26实现对电动绕线辊53的驱动，爬高步进电机驱动器27实现对爬高步进电机33-d的驱动，抱紧伸缩电机驱动器28实现对抱紧伸缩电机33-b的驱动，刀距伸缩步进电机驱动器29则可以实现刀距伸缩步进电机34-a的驱动，直流电机驱动器2-10实现对直流电机35-b的驱动，转向减速电机驱动器2-11实现对转向减速电机33-e的驱动。

如图5、图6所示，所述可分离末端执行单元3为树木树枝修剪的核心机构。由执行单元本体31、张合机构32、爬高抱紧转向机构33、刀距调节机构34、刀体及驱动机构35组成。

所述执行单元本体31为筒形支架，分为左右两个半圆柱支撑体：左半圆柱支撑体31-a、右半圆柱支撑体31-b。执行单元本体31作为整套装置的支撑体，应具备的功能是对树干实现全方位的包裹。左半圆柱支撑体31-a、右半圆柱支撑体31-b通过张合机构32连接在一起。

所述张合机构32包括：张合支架32-a、张合伺服电机32-b。所述张合支架32-a为两套，连接左半圆柱支撑体31-a和右半圆柱支撑体31-b，且其中一套连接张合伺服电机32-b的转轴，另一套连接张合伺服电机32-b的机体。又两套张合支架32-a之间可以张开和闭合，因此可以通过驱动张合伺服电机32-b，从而控制张合支架32-a的闭合和打开，进而带动左半圆柱支撑体31-a和右半圆柱支撑体31-b的打开和关闭，最终带动执行单元本体31的打开和闭合，实现对执行单元本体31对树干的包裹。

如图8所示，所述爬高抱紧转向机构33包括：爬高轮组33-a、抱紧伸缩电机33-b、爬高齿轮组33-c、爬高步进电机33-d、转向减速电机33-e、压力传感器33-f。所述爬高轮组33-a为橡胶轮子和支架结构，轮子主要用来实现与树干的摩擦压紧作用，共八个，平均分为上下两组，每组呈现方向对角线分布，分布在执行单元本体31内侧的上下两端，配合执行单元本体31和抱紧伸缩电机33-b，实现对树干的抱紧作用。如上所述的，抱紧伸缩电机33-b为被压缩状态，两端被固定在执行单元本体31的内侧和爬高轮组33-a外侧之间，通过控制伸缩抱紧电机33-b与爬高轮组33-a之间的距离，从而调节爬高轮组与树干的压力值，并配合压力传感器33-f实现与树干压力的实时调整，从而实现对爬高轮组33-a向树干的恒定压缩力的作用。所述爬高齿轮组33-c为普通的齿轮或皮带结构，用于连接爬高轮组33-a和爬高步进电机33-d，将爬高步进电机33-d的动力传输至连接爬高轮组33-a上，用于连接爬高轮组33-a上橡胶轮子的旋转。爬高步进电机33-d主要用于实现对爬高轮组33-a上橡胶轮子的驱动，固定在执行单元本体31内侧支架上。所述压力传感器33-f安装在爬高轮组33-a上，可以实时监测轮组与树干的压力，发送至控制器，供控制器分析处理后，控制抱紧伸缩电机33-b的运动，实现执行单元本体31与爬高轮组33-a的距离可调，从而控制爬高轮组33-a与树干的压力值恒定。所述转向减速电机33-e的本体安装在抱紧伸缩电机33-b的伸缩机构上，转向减速电机33-e的转轴则安装爬高轮组33-a的本体上，效果为：通过转向减速电机33-e的运动，可以带动爬高轮组33-a的转向，从而实现爬高轮组33-a任意角度的转向。当爬高轮组33-a的轴线与树干的轴线垂直时，此时，爬高轮组33-a可以带动整套执行单元本体31沿树干外周的切线方向转动，即实现了围绕树干的圆周运动，如果此时执行单元本体31上设置有树枝修剪机构，则可以实现对树干上树枝的修剪。更重要的是，由于爬高轮组33-a的任意角度可调，此时可以带动爬高轮组33-a沿任意角度实现对树干的攀爬，不受树枝的影响。

所述刀距调节机构34包括：刀距伸缩步进电机34-a、刀距调节载体平台34-b。所述刀距调节机构34为两套，机械连接关系为：所述刀距伸缩步进电机34-a转轴上连接有刀体及驱动机构35，所述刀距伸缩步进电机34-a可以实现转轴的伸缩，进而带动刀体及驱动机构35的前进和后退，进而实现刀体35-a和执行单元本体31轴心处距离的调整。所述刀距伸缩步进电机34-a第一套的本体安装固定在执行单元本体31上端面的下侧；另一套的本体则安装固定在执行单元本体31下端面的上侧。

如图7所示，所述刀体及驱动机构35亦为两套，包括：刀体35-a，直流电机35-b。所述刀体35-a为铝合金锯片，安装固定在直流电机35-b的转轴上，通过电机的旋转带动刀体35-a旋转，实现对树枝的切割。且铝合金锯片的轴心为水平，垂直于执行单元本体31所在的轴心。所述直流电机35-b安装固定在所述刀距调节机构34上的刀距调节载体平台34-b上，通过刀距伸缩步进电机34-a的伸缩作用，带动刀体及驱动机构35前进和后退，实现刀距的可调。

所述机械臂4为一套六自由度的机械臂4-1，用作修剪机器人运动的载体平台。机械臂4的末端固定连接在全地形底盘移动平台1上，顶端连接执行单元释放和回收机构5。

所述执行单元释放和回收机构5的功能为实现对可分离末端执行单元3的释放，以便可分离末端执行单元3可以脱离履带式四轮移动平台，实现对高大的树枝的爬高和树枝修剪功能。另外，当可分离末端执行单元3工作完毕时，还需要通过执行单元释放和回收机构5实现对可分离末端执行单元3的回收工作。如图4所示，所述执行单元释放和回收机构5包括：环形钢叉51、电磁吸盘52、电动绕线辊53。连接关系为：环形钢叉51为本体支架结构，上端面安装固定电磁吸盘52，该电磁吸盘51可以通过通断电产生磁性，进而实现对可分离末端执行单元3的分离释放和吸合回收动作。另外，所述电动绕线辊53固定在环形钢叉51的侧面，作用为：电动绕线辊53上缠有电线，电线的尾部连接微型工控机22，电线的端部则连接可分离末端执行单元3，微型工控机22可以通过电线实现对可分离末端执行单元3的供电与否，而且可分离末端执行单元3和微型工控机22之间的电线长度可以通过电动绕线辊53改变。

所述视觉导航机构6由道路导航摄像机61、双目立体视觉摄像机62、导航摄像机三维云台63、立体视觉摄像机支架64组成。连接、安装和固定关系为：道路导航摄像机61通过导航摄像机三维云台63固定在全地形底盘移动平台1前方，导航摄像机三维云台驱动器24的驱动下，导航摄像机三维云台63可以实现空间三维的运动，进而带动道路导航摄像机61三维运动，实现对全地形底盘移动平台1周围环境状况及前方道路状况的监控和自主导航运动。由于在进行对树木修剪时，一般来说，树木需位于全地形底盘移动平台1的前方或侧前方，因此立体视觉摄像机支架64是固定的刚性支架，底部直接通过螺栓结构固定在全地形底盘移动平台1的前端，顶部直接固定双目立体视觉摄像机62。

本发明还提出了上述机器人的修剪方法，步骤如下：

St1：道路导航摄像机61通过导航摄像机三维云台63固定在全地形底盘移动平台1前方，导航摄像机三维云台驱动器24的驱动下，导航摄像机三维云台63可以实现空间三维的运动，进而带动道路导航摄像机61三维运动，实现对全地形底盘移动平台1周围环境状况及前方道路状况的监控和自主导航运动；同时，微型工控机22控制底盘移动平台驱动器23驱动全地形底盘移动平台1前进；

St2：当发现需要修剪的树枝时，全地形底盘移动平台1放慢速度前进，慢慢靠近需要修剪的树木，进入可控范围内，最终实现树木处于全地形底盘移动平台1的前方或侧前方；

St3：此后双目立体视觉摄像机62开始工作，实现对树木的空间三维坐标定位，定位完毕后，微型工控机22控制机械臂4带动可分离末端执行单元3、执行单元释放和回收机构5靠近树干；在该过程中，微型工控机22通过驱动张合伺服电机32-b控制张合支架32-a的打开，进而带动左半圆柱支撑体31-a和右半圆柱支撑体31-b的打开，最终带动执行单元本体31的打开，实现对执行单元本体31对树干的进入；执行单元本体31进入树干后，微型工控机22通过驱动张合伺服电机32-b带动执行单元本体31闭合，实现对树干的全方位包裹；在上述过程的开端，双目立体视觉摄像机62还需要确定树干的粗细、需要修剪树枝的高度及树枝的分布等信息；

St4：此后为可分离末端执行单元3和执行单元释放和回收机构5分离过程，过程为：微型工控机22控制电磁吸盘驱动器25掉电操作，从而使得电磁吸盘52和可分离末端执行单元3之间没有吸合力，从而为下一步的分离提供电气控制条件；

St5：所述爬高抱紧转向机构33开始工作，过程为：由于所述爬高轮组33-a为橡胶轮子和支架结构，轮子主要用来实现与树干的摩擦压紧作用，微型工控机22通过控制爬高步进电机驱动器27进而实现对爬高步进电机33-d的驱动，通过爬高齿轮组33-c的传动作用，实现对爬高轮组33-a的驱动，此时爬高轮组33-a上橡胶轮子开始在树干上旋转，进而带动整套可分离末端执行单元3沿树干上升；在该过程中，由于可分离末端执行单元3与执行单元释放和回收机构5开始分离，距离变长，因此需要通过微型工控机22控制绕线辊驱动器26驱动电动绕线辊53进行放线；同时，在该过程中，所述压力传感器33-f安装在爬高轮组33-a上，可以实时监测轮组与树干的压力，发送至控制器，供控制器分析处理后，控制抱紧伸缩电机33-b的运动，实现执行单元本体31与爬高轮组33-a的距离可调，从而控制爬高轮组33-a与树干的压力值恒定；

St6：爬高抱紧转向机构33继续上升到需要修剪的树枝高度后停止运动，由于在步骤St3中已经由双目立体视觉摄像机62确定了树干的粗细、需要修剪树枝的高度及树枝的分布等信息，此时开始进入刀距调整过程，具体过程为：微型工控机22通过控制刀距伸缩步进电机驱动器29驱动刀距伸缩步进电机34-a实现转轴的伸缩，进而带动刀体及驱动机构35的前进和后退，进而实现刀体35-a和执行单元本体31轴心处距离的调整，当调整到位后，爬高抱紧转向机构33停止工作；

St7：该过程为刀体35-a旋转和切割过程，当然旋转和切割过程为同时进行的，具体步骤为：

①旋转过程：所述转向减速电机33-e的本体安装在抱紧伸缩电机33-b的伸缩机构上，转向减速电机33-e的转轴则安装爬高轮组33-a的本体上，通过转向减速电机33-e的运动，可以带动爬高轮组33-a的转向，从而实现爬高轮组33-a任意角度的转向；当爬高轮组33-a的轴线与树干的轴线垂直时，爬高轮组33-a可以带动整套执行单元本体31沿树干外周的切线方向转动，即实现了围绕树干的圆周运动，如果此时执行单元本体31上设置有树枝修剪机构，则可以实现对树干上树枝的修剪；由于爬高轮组33-a的任意角度可调，此时可以带动爬高轮组33-a沿任意角度实现对树干的攀爬，不受树枝的影响；

②切割过程：在上述旋转过程中，由于整套刀体及驱动机构35会触碰到需要修剪的树枝，因此该过程中，微型工控机22控制直流电机驱动器2-10驱动直流电机35-b高速旋转，进而带动刀体35-a的铝合金锯片高速旋转，实现对待修剪树枝的修剪作用；

St8：当上述过程中的旋转过程和切割过程进行一个周期后，则该树干区域内的多余树枝已经被修剪、清楚干净，如果需要继续修剪上部的树枝，此时重复St5-St7过程；

St9：当一颗树干上的所有需要修剪的树枝被修剪完毕后，修剪机器人上的可分离末端执行单元3开始进入回收阶段，具体的为：像步骤St5过程一样，只是爬高抱紧转向机构33开始向下工作，进入下降阶段，下降到较低的高度时，此时爬高抱紧转向机构33所在的高度与修剪机器人上所在的执行单元释放和回收机构5的上端面一致或者稍高于执行单元释放和回收机构5时，开始进入对可分离末端执行单元3的回收工作；在爬高抱紧转向机构33下降过程中，由于可分离末端执行单元3与执行单元释放和回收机构5开始靠近，距离变短，因此需要通过微型工控机22控制绕线辊驱动器26驱动电动绕线辊53进行收线操作；

St10：在该过程中，进入可分离末端执行单元3与树干的分离过程，具体为：微型工控机22通过驱动张合伺服电机32-b，从而控制张合支架32-a的打开，进而带动左半圆柱支撑体31-a和右半圆柱支撑体31-b的打开，最终带动执行单元本体31的打开，实现对执行单元本体31对树干的可分离；

St11：此后，由于可分离末端执行单元3与树干已经分离，此后为可分离末端执行单元3和执行单元释放和回收机构5的回收过程，过程为：微型工控机22控制电磁吸盘驱动器25得电操作，从而使得电磁吸盘52和可分离末端执行单元3之间产生吸合力，从而可分离末端执行单元3被执行单元释放和回收机构5回收，至此，全自动树枝修剪机器人完成一棵树干的树枝修剪工作。

以上所述仅为本发明的较佳实施例而已，并不用以限制本发明，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。

Claims (5)

1.一种全自动树枝修剪机器人，其特征在于，包括全地形底盘移动平台、电控单元、可分离末端执行单元、机械臂、执行单元释放和回收机构、视觉导航机构、大容量锂电池，所述电控单元、机械臂、视觉导航机构、大容量锂电池安装于全地形底盘移动平台上，所述机械臂的顶部通过执行单元释放和回收机构与可分离末端执行单元连接，所述大容量锂电池与机器人用电器件连接并为其供电；所述可分离末端执行单元由执行单元本体、张合机构、爬高抱紧转向机构、刀距调节机构、刀体及驱动机构组成，执行单元本体为筒形支架，分为左半圆柱支撑体、右半圆柱支撑体，张合机构由张合支架、张合伺服电机组成，爬高抱紧转向机构由爬高轮组、抱紧伸缩电机、爬高齿轮组、爬高步进电机、转向减速电机、压力传感器组成，刀距调节机构由刀距伸缩步进电机、刀距调节载体平台组成，刀体及驱动机构由刀体、直流电机组成。

2.如权利要求1所述的全自动树枝修剪机器人，其特征在于，所述电控单元由控制柜、微型工控机、底盘移动平台驱动器、导航摄像机三维云台驱动器、电磁吸盘驱动器、绕线辊驱动器、爬高步进电机驱动器、抱紧伸缩电机驱动器、刀距伸缩步进电机驱动器、直流电机驱动器、转向减速电机驱动器组成。

3.如权利要求1所述的全自动树枝修剪机器人，其特征在于，所述执行单元释放和回收机构由环形钢叉、电磁吸盘、电动绕线辊组成，环形钢叉为本体支架结构，上端面安装固定电磁吸盘，电动绕线辊固定在环形钢叉的侧面。

4.如权利要求1所述的全自动树枝修剪机器人，其特征在于，所述视觉导航机构由道路导航摄像机、双目立体视觉摄像机、导航摄像机三维云台、立体视觉摄像机支架组成，道路导航摄像机通过导航摄像机三维云台固定在全地形底盘移动平台前方，立体视觉摄像机支架底部通过螺栓结构固定在全地形底盘移动平台的前端，双目立体视觉摄像机固定于立体视觉摄像机支架的顶部。

5.权利要求1-4任一所述的全自动树枝修剪机器人的修剪方法，其特征在于，包括以下步骤：

St1：道路导航摄像机通过导航摄像机三维云台固定在全地形底盘移动平台前方，导航摄像机三维云台驱动器的驱动下，导航摄像机三维云台可以实现空间三维的运动，进而带动道路导航摄像机三维运动，实现对全地形底盘移动平台周围环境状况及前方道路状况的监控和自主导航运动；同时，微型工控机控制底盘移动平台驱动器驱动全地形底盘移动平台前进；

St2：当发现需要修剪的树枝时，全地形底盘移动平台放慢速度前进，慢慢靠近需要修剪的树木，进入可控范围内，最终实现树木处于全地形底盘移动平台的前方或侧前方；

St3：此后双目立体视觉摄像机开始工作，实现对树木的空间三维坐标定位，定位完毕后，微型工控机控制机械臂带动可分离末端执行单元、执行单元释放和回收机构靠近树干；在该过程中，微型工控机通过驱动张合伺服电机控制张合支架的打开，进而带动左半圆柱支撑体和右半圆柱支撑体的打开，最终带动执行单元本体的打开，实现执行单元本体对树干的进入；执行单元本体进入树干后，微型工控机通过驱动张合伺服电机带动执行单元本体闭合，实现对树干的全方位包裹；在上述过程的开端，双目立体视觉摄像机还需要确定树干的粗细、需要修剪树枝的高度及树枝的分布信息；

St4：此后为可分离末端执行单元和执行单元释放和回收机构分离过程，过程为：微型工控机控制电磁吸盘驱动器掉电操作，从而使得电磁吸盘和可分离末端执行单元之间没有吸合力，从而为下一步的分离提供电气控制条件；

St5：所述爬高抱紧转向机构开始工作，过程为：由于所述爬高轮组为橡胶轮子和支架结构，轮子主要用来实现与树干的摩擦压紧作用，微型工控机通过控制爬高步进电机驱动器进而实现对爬高步进电机的驱动，通过爬高齿轮组的传动作用，实现对爬高轮组的驱动，此时爬高轮组上橡胶轮子开始在树干上旋转，进而带动整套可分离末端执行单元沿树干上升；在该过程中，由于可分离末端执行单元与执行单元释放和回收机构开始分离，距离变长，因此需要通过微型工控机控制绕线辊驱动器驱动电动绕线辊进行放线；同时，在该过程中，所述压力传感器安装在爬高轮组上，可以实时监测轮组与树干的压力，发送至控制器，供控制器分析处理后，控制抱紧伸缩电机的运动，实现执行单元本体与爬高轮组的距离可调，从而控制爬高轮组与树干的压力值恒定；

St6：爬高抱紧转向机构继续上升到需要修剪的树枝高度后停止运动，由于在步骤St3中已经由双目立体视觉摄像机确定了树干的粗细、需要修剪树枝的高度及树枝的分布信息，此时开始进入刀距调整过程，具体过程为：微型工控机通过控制刀距伸缩步进电机驱动器驱动刀距伸缩步进电机实现转轴的伸缩，进而带动刀体及驱动机构的前进和后退，进而实现刀体和执行单元本体轴心处距离的调整，当调整到位后，爬高抱紧转向机构停止工作；

St7：该过程为刀体旋转和切割过程，当然旋转和切割过程为同时进行的，具体步骤为：

①旋转过程：所述转向减速电机的本体安装在抱紧伸缩电机的伸缩机构上，转向减速电机的转轴则安装爬高轮组的本体上，通过转向减速电机的运动，可以带动爬高轮组的转向，从而实现爬高轮组任意角度的转向；当爬高轮组的轴线与树干的轴线垂直时，爬高轮组可以带动整套执行单元本体沿树干外周的切线方向转动，即实现了围绕树干的圆周运动，如果此时执行单元本体上设置有树枝修剪机构，则可以实现对树干上树枝的修剪；由于爬高轮组的任意角度可调，此时可以带动爬高轮组沿任意角度实现对树干的攀爬，不受树枝的影响；

②切割过程：在上述旋转过程中，由于整套刀体及驱动机构会触碰到需要修剪的树枝，因此该过程中，微型工控机控制直流电机驱动器驱动直流电机高速旋转，进而带动刀体的铝合金锯片高速旋转，实现对待修剪树枝的修剪作用；

St8：当上述过程中的旋转过程和切割过程进行一个周期后，则该树干区域内的多余树枝已经被修剪、清除干净，如果需要继续修剪上部的树枝，此时重复St5-St7过程；

St9：当一颗树干上的所有需要修剪的树枝被修剪完毕后，修剪机器人上的可分离末端执行单元开始进入回收阶段，具体的为：像步骤St5过程一样，只是爬高抱紧转向机构开始向下工作，进入下降阶段，下降到较低的高度时，此时爬高抱紧转向机构所在的高度与修剪机器人上所在的执行单元释放和回收机构的上端面一致或者稍高于执行单元释放和回收机构时，开始进入对可分离末端执行单元的回收工作；在爬高抱紧转向机构下降过程中，由于可分离末端执行单元与执行单元释放和回收机构开始靠近，距离变短，因此需要通过微型工控机控制绕线辊驱动器驱动电动绕线辊进行收线操作；

St10：在该过程中，进入可分离末端执行单元与树干的分离过程，具体为：微型工控机通过驱动张合伺服电机，从而控制张合支架的打开，进而带动左半圆柱支撑体和右半圆柱支撑体的打开，最终带动执行单元本体的打开，实现执行单元本体对树干的分离；

St11：此后，由于可分离末端执行单元与树干已经分离，此后为可分离末端执行单元和执行单元释放和回收机构的回收过程，过程为：微型工控机控制电磁吸盘驱动器得电操作，从而使得电磁吸盘和可分离末端执行单元之间产生吸合力，从而可分离末端执行单元被执行单元释放和回收机构回收，至此，全自动树枝修剪机器人完成一棵树干的树枝修剪工作。