CN205694490U - 一种高枝修剪机械动态配重装置 - Google Patents

Abstract

本实用新型涉及一种高枝修剪机械动态配重装置，包括：动态配重机械模块、传感器模块、动态配重控制模块；动态配重机械模块包括配重臂、配重臂拉杆、配重机构底板、直线导轨、轴承、滑块、配重块、配重电机、联轴器、丝杆、丝杆螺母；传感器模块为配重块测距传感器；所述配重块测距传感器固定于配重机构底板上；动态配重控制模块包括电源、动态配重控制器和输入输出接口；配重块测距传感器和配重电机通过输入输出接口连接至动态配重控制器；本实用新型能够实时监测高枝修剪机械臂架系统所产生的倾翻力矩，能够在高枝修剪机械工作过程中实现对臂架系统的实时调平。

Description

一种高枝修剪机械动态配重装置

技术领域

本发明涉及一种园林机械，尤其涉及一种高枝修剪机械动态配重装置。

背景技术

高枝修剪机械是一种应用于园林高大树木的修枝机械，能够方便有效的修剪高大树木侧枝，并在修枝同时进行修枝茬口的养护。上述功能在本专利申请人已申请的专利中已有论述。具体专利信息如下，专利号：ZL201210194078.2，名称：一种高空剪枝机械手；专利号ZL201410048553.4，名称：一种导向卡锁式高枝修剪护茬锯。但是在高枝修剪机械使用过程中由于臂架系统的工作姿态不断变化，会产生较大的且实时变化的倾翻力矩，缩短了整机的使用寿命甚至发生倾翻危险。针对以上问题，高枝修剪机械动态配重装置成为研究的重点。

下面对高枝修剪机械做简要说明包括底盘、升降系统、回转支承系统、臂架系统和修枝护茬锯。其中底盘带有行走轮系、支撑腿等装置，工作状态下支撑腿打开，保证整机平稳性；升降系统位于底盘上，用于提高整机工作高度；回转支承系统位于升降系统顶端，连接升降系统和臂架系统底座，使臂架系统有水平面内旋转自由度；臂架系统包括臂架系统底座、三节主机械臂和一节辅助臂，用于增大修枝护茬锯工作空间，相邻机械臂间由伺服电动缸驱动；修枝护茬锯位于辅助臂末端，用于修枝树枝并实时养护修枝茬口。

经过现有技术文献的检索发现，专利公告号：CN202415030U，名称：一种自动配重塔吊。它包括配重块、配重臂齿轮、齿轮摆杆、弹簧等。它通过塔吊起重臂的载荷变化带动弹簧伸缩，弹簧带动齿轮摆杆进而带动齿轮转动，齿轮转动来实现配重块的左右移动。这种配重方法比较适用于塔吊，简单有效。但是其控制原理简单，而且塔吊结构与高枝修剪机械差别较大，这种动态配重系统不适合于高枝修剪机械。

发明内容

本发明针对现有技术存在的上述不足，提供了一种高枝修剪机械动态配重装置，能够在高枝修剪机械工作过程中实现对臂架系统的实时调平。

本发明所采用的技术方案是：

一种高枝修剪机械动态配重装置，包括：动态配重机械模块、传感器模块、动态配重控制模块。

所述动态配重机械模块，包括配重臂、配重臂拉杆、配重机构底板、直线导轨、轴承、滑块、配重块、配重电机、联轴器、丝杆、丝杆螺母。

所述配重臂一端垂直固接臂架系统底座下部；所述配重臂拉杆一端固接于配重臂，另一端固接于臂架系统底座上部；所述配重机构底板固接于配重臂上；两根直线导轨对称平行安装在配重机构底板上部前后两侧；两个轴承分别安装于配重机构底板上左右两侧，轴承端面与直线导轨轴向方向垂直。所述丝杆两端分别安装于两侧轴承上，丝杆轴向与直线导轨轴向平行；所述配重电机通过电机架安装在配重臂上；所述联轴器连接电机输出轴与丝杆；所述滑块包括四个同样的滑块，四个滑块对称安装在两根直线导轨上，每根直线导轨上分别安装两个滑块；所述配重块安装在四个滑块上部；所述丝杆螺母安装在丝杆上，丝杆螺母侧面与配重块固接。

所述传感器模块为配重块测距传感器；所述配重块测距传感器固定于配重机构底板上。

所述动态配重控制模块，包括电源、动态配重控制器和输入输出接口。

所述电源优先选用12伏或24伏直流电源；所述动态配重控制器优先选用STM32型单片机；输入输出接口包括光电隔离、信号放大以及数字IO驱动电路；所述的配重块测距传感器通过所述输入输出接口连接至动态配重控制器；所述的配重电机通过所述的输入输出接口与动态配重控制器相连，动态配重控制器通过输入输出接口控制配重电机启停。

本发明一种高枝修剪机械动态配重装置的具体控制过程如下：

(1)动态配重控制模块和传感器初始化；

(2)高枝修剪机械开始作业。伺服电动缸开始工作并将实时伸缩状态反馈给动态配重控制器；同时，配重块测距传感器测得当前配重块位置并将信号传送到动态配重控制器；

(3)动态配重控制器接收到三个伺服电动缸反馈信号和配重块位置的实时信号，当程序判断出臂架系统倾翻力矩超出安全范围时，动态配重控制器通过输入输出接口驱动配重电机转动，进而带动配重块移动，使臂架系统倾翻力矩一直处于安全范围内。

本发明中信号处理流程如下：

1)伺服电动缸伸长状态信号L_i转换为相邻机械臂之间夹角θ_i：

θ_i＝f(L_i) i＝1,2,3--------------(1)

2)相邻机械臂之间夹角θ_i转换为臂架系统倾翻力矩T：

T＝g(θ_i) i＝1,2,3--------------(2)

3)倾翻力矩T计算出配重块理论位置X；

式中T₀为配重臂、直线导轨等固定构件所产生的平衡力矩；G为配重块所受重力。

4)计算出配重块理论位移ΔX；

ΔX＝X-X₀--------------(4)

式中X₀为配重块测距传感器测得的配重块实时位置信号X₀；

5)设定倾翻力矩安全阈值，并求出配重块位置偏差安全阈值X_δ，并将ΔX与X_δ对比。

如果|ΔX|≤X_δ，配重电机不动作，配重块不运动，否则配重电机带动配重块运动ΔX。

本发明的有益效果是：

1、能够实时监测高枝修剪机械臂架系统所产生的倾翻力矩。2、能够实时调整配重块位置，使臂架系统所产生的倾翻力矩在安全范围内，安全阈值的设定有效防止了配重块的频繁运动，也提高了高枝修剪机械的稳定性。

附图说明

图1为高枝修剪机械示意图。

图2为高枝修剪机械动态配重装置示意图。

图3为高枝修剪机械动态配重装置控制过程流程图。

图4为高枝修剪机械臂架系统尺寸关系示意图一。

图5为高枝修剪机械臂架系统尺寸关系示意图二。

图中：1底盘、2升降系统、3配重臂、4臂架系统底座、5配重臂拉杆、6伺服电动缸、7修枝护茬锯、8臂架系统、9回转支承系统、10配重机构底板、11配重电机、12联轴器、13配重块、14丝杆螺母、15滑块、16直线导轨、17丝杆、18轴承、19配重块测距传感器

具体实施方式

下面结合附图对本发明作进一步描述。

本发明可以适用于现有的常见的折臂式作业机械，比如本实施例中所涉及的高枝修剪机械。首先对本实施例所涉及的高枝修剪机械做简要说明，其结构如图2所示：其包括底盘1、升降系统2、回转支承系统9、臂架系统8和修枝护茬锯7。其中底盘1带有行走轮系、支撑腿等装置，工作状态下支撑腿打开，保证整机平稳性；升降系统2位于底盘1上，用于提高整机工作高度；回转支承系统9位于升降系统2顶端，连接升降系统2和臂架系统底座4，使臂架系统8有水平面内旋转自由度；臂架系统8包括臂架系统底座4、三节主机械臂和一节辅助臂，用于增大修枝护茬锯7工作空间，相邻机械臂间由伺服电动缸6驱动；修枝护茬锯7位于辅助臂末端，用于修枝树枝并实时养护修枝茬口。

本发明所述的一种高枝修剪机械动态配重装置，包括：动态配重机械模块、传感器模块、动态配重控制模块。

所述动态配重机械模块，包括配重臂3、配重臂拉杆5、配重机构底板10、直线导轨16、轴承18、滑块15、配重块13、配重电机11、联轴器12、丝杆17、丝杆螺母14。

所述配重臂3一端垂直固接臂架系统底座4下部；所述配重臂拉杆5一端固接于配重臂3，另一端固接于臂架系统底座4上部；所述配重机构底板10固接于配重臂3上，用于安装动态配重装置各部件；所述直线导轨16水平安装于配重机构底板10上部,两根直线导轨对称安装；所述轴承18包括两个轴承，分别安装于配重机构底板10上，轴承端面与直线导轨16轴向方向垂直。所述丝杆17两端安装于轴承18上，丝杆17轴向与直线导轨16轴向平行；所述配重电机11通过电机架安装在配重臂3上；所述联轴器12链接配重电机输出轴与丝杆17；所述滑块15包括四个同样的滑块，两根直线导轨16上分别安装两个滑块15，滑块15可以沿直线导轨16滑动；所述配重块13安装在四个滑块上；所述丝杆螺母14安装在丝杆17上，丝杆螺母14侧面与配重块13固接。

所述传感器模块包括配重块测距传感器19，所述测距传感器采用市面常见测距传感器即可，如超声波测距传感器。配重块测距传感器19固定于配重机构底板10上，用于测量配重块13位置。

所述动态配重控制模块，包括电源、动态配重控制器和输入输出接口。

所述电源优先选用12伏或24伏直流电源，所述电源为配重电机与供电；所述动态配重控制器优先选用STM32型单片机；所述输入输出接口包括光电隔离、信号放大以及数字IO驱动电路；所述的配重块测距传感器通过所述输入输出接口连接至动态配重控制器；所述的配重电机通过的输入输出接口与动态配重控制器相连，动态配重控制器通过输入输出接口控制配重电机启停。

本发明一种高枝修剪机械动态配重装置，具体控制过程如下：

(1)动态配重控制模块和配重块测距传感器初始化；

(2)高枝修剪机械开始作业。伺服电动缸6开始工作并将实时伸缩状态反馈给动态配重控制器；同时，配重块测距传感器19测得当前配重块13位置并将信号传送到动态配重控制器；

(3)动态配重控制器接收到三个伺服电动缸反馈信号和配重块位置的实时信号，当程序判断出倾翻力矩超出安全范围时，动态配重控制器通过输入输出接口驱动配重电机11转动，进而带动配重块13移动，使臂架系统8倾翻力矩一直处于安全范围内。

本发明一种高枝修剪机械动态配重装置，信号处理流程如下：

1)伺服电动缸伸长状态信号L_i转换为相邻机械臂之间夹角θ_i：

θ_i＝f(L_i) i＝1,2,3--------------(1)

结合图4以第一节臂与底座之间的变幅机构为例，l₁与θ₁之间的函数对应关系如下：

式中A、B、C、D、E分别代表五个点，n、p、q、r、t、α、为机械机构中的常量。

θ₂θ₃与l₂l₃之间的关系也用这种方式求得。

2)相邻机械臂之间夹角θ_i转换为臂架系统倾翻力矩T：

T＝g(θ_i) i＝1,2,3--------------(2)

结合图5，函数(2)的详细对应关系如下：

T＝G₁D₁+G₂D₂+G₃D₃

＝G₁L_1,0·sinθ₁+G₂[L₁·sinθ₁-L_2,1·sin(θ₁+θ₂)]+G₃[L₁·sinθ₁-L_2,1·sin(θ₁+θ₂)±L_3,2·sin(θ₁+θ₂+θ₃)]

式中L_i为第i节机械臂的长度；L_i,i-1为第i节机械臂质心到第i节机械臂与i-1节机械臂铰点关节处的长度。

3)倾翻力矩T计算出配重块理论位置X；

式中T₀为配重臂、直线导轨、等固定构件所产生的平衡力矩；G为配重块所受重力。

4)计算出配重块理论位移ΔX；

ΔX＝X-X₀--------------(4)

式中X₀为配重块测距传感器测得的配重块实时位置信号X₀；

5)设定倾翻力矩安全阈值，并求出配重块位置偏差安全阈值X_δ，并将ΔX与X_δ对比。

如果|ΔX|≤X_δ，配重电机不动作，配重块不运动，否则配重电机带动配重块运动ΔX。

Claims (1)

1.一种高枝修剪机械动态配重装置，其特征在于包括：动态配重机械模块、传感器模块、动态配重控制模块；

所述动态配重机械模块，包括配重臂、配重臂拉杆、配重机构底板、直线导轨、轴承、滑块、配重块、配重电机、联轴器、丝杆和丝杆螺母；

所述配重臂一端垂直固接臂架系统底座下部；所述配重臂拉杆一端固接于配重臂，另一端固接于臂架系统底座上部；所述配重机构底板固接于配重臂上；两根直线导轨对称平行安装在配重机构底板上部前后两侧；两个轴承分别安装于配重机构底板上左右两侧，轴承端面与直线导轨轴向方向垂直；所述丝杆两端分别安装于两侧轴承上，丝杆轴向与直线导轨轴向平行；所述配重电机通过电机架安装在配重臂上；所述联轴器连接电机输出轴与丝杆；所述滑块包括四个同样的滑块，四个滑块对称安装在两根直线导轨上，每根直线导轨上分别安装两个滑块；所述配重块安装在四个滑块上部；所述丝杆螺母安装在丝杆上，丝杆螺母侧面与配重块固接；

所述传感器模块为配重块测距传感器；所述配重块测距传感器固定于配重机构底板上；

所述动态配重控制模块，包括电源、动态配重控制器和输入输出接口；

所述电源为12伏或24伏直流电源；所述动态配重控制器为STM32型单片机；输入输出接口包括光电隔离、信号放大以及数字IO驱动电路；所述的配重块测距传感器通过所述输入输出接口连接至动态配重控制器；所述的配重电机通过所述的输入输出接口与动态配重控制器相连，动态配重控制器通过输入输出接口控制配重电机启停。