基于改进PSO的模糊PID高枝修剪机械臂末端抑振算法与试验  

Experiment and vibration suppression algorithm for high-branch pruning manipulator based on fuzzy PID with improved PSO

作　　者：李扬[1,2] 侯加林[1,2] 苑进[1,2] 赵新学[1] 刘雪美[1,2] 张丽[3] 

机构地区：[1]山东农业大学机械与电子工程学院,泰安271018 [2]山东省园艺机械与装备重点实验室,泰安271018 [3]山东科技大学资源与土木工程系,泰安271019

出　　处：《农业工程学报》2017年第10期49-58,共10页Transactions of the Chinese Society of Agricultural Engineering

基　　金：国家自然科学基金项目(51675317;51475278);"十二五"国家科技支撑计划资助项目(2014BAD08B01-2);山东科技发展计划项目(2013GNC11203;2014GNC112010);山东省农机装备研发创新计划项目(2015YB201)

摘　　要：针对设计的高枝修剪机械臂定位过程易产生振动,难以快速、准确地将待修树枝对入锯切口的问题,分析大臂展、高负载自重比臂架系统的柔性特征,在此基础上研究末端修枝锯的抑振控制方法,实现末端修枝锯的快速精准定位。首先介绍了高枝修剪机械臂结构和工作原理,分析了臂架系统的柔性特征对末端修枝锯定位产生的影响;其次通过结构关系推导和有限元方法建立了机械臂的数学模型并进行动力学分析,并设计基于改进粒子群离线优化的模糊PID控制方法,实现了对末端修枝锯的主动抑振控制;最后分别在Simulink环境中和样机系统上进行了数值仿真和试验验证。综合仿真和试验结果表明:该文设计的控制方法可以实现末端修枝锯的主动抑振,定位过程中修枝锯能够在短时间内进入稳态,超调量不足开环状态下的50%,震荡调整时间小于1 s,经1 s后振幅衰减至峰值的5%以下,从而达到了较好的末端抑振效果,改善了修枝锯的定位性能,提高了高枝修剪机械臂的作业效率。相关研究可为其他具有一定相似柔性特征的机械提供末端抑振和精准定位的控制经验参考。Pruning trees is an important work in forestry production, which plays an important role on the growth of trees and timber and the forest fire prevention. However, domestic and foreign high-altitude pruning machinery is still in its infancy, whose working height is generally less than 8 m and is not high flexible. It is difficult to effectively improve work efficiency in pruning high branches. In this paper, a simple, low-cost mobile tall tree pruning machine was designed, which could be easily towed to the forest area, and prune high branches within 15 m height. This machine had the working radius of 6 m and the maximum pruning diameter of 10 cm. However, in the process of sawing and positioning, due to the long arm span and high load weight ratio, there were obviously flexible features for its arms, and the end-effector （pruning saw） was easy to vibrate during its positioning. Thus, it was difficult to achieve fast and accurate positioning, as well as fix the branch to be cut. Aiming to the above problems, this paper analyzed the flexible characteristics of the boom system with the boom display and the high load weight ratio. On this basis, the vibration suppression control method of the end of pruning saws was investigated to achieve the rapid and accurate positioning of the end of pruning saws. In this paper, focusing the flexible characteristics of the manipulator and the vibration suppression of the end-point, based on the introduction of the boom structure and working principle, we analyzed the impact of flexible features on the positioning of the end of pruning saws by geometric derivation, and the FEM （finite element modeling） was used for the dynamics analysis of the boom system. And the fuzzy PID （proportion, integral, derivative） controller was designed based on an improved PSO （particle swarm optimization） algorithm, in order to realize the active vibration suppression control of the end of the actuator. In the designed fuzzy PID controller, the improved PSO algorithm was used on the

关 键 词：机械臂 林业 振动控制 振动抑制 柔性特征 改进粒子群 模糊PID 

分 类 号：S776.274[农业科学—森林工程]