关键词:
果园巡检机器人
柔性臂
奇异摄动法
轨迹规划
抑振控制
摘要:
果园巡检机器人应用于果树栽培过程中冠层图像的采集工作,主要由行走机构和支撑图像采集装置的柔性臂构成。由于臂体柔性显著,在受到冲击或调姿过程中极易发生低频振动,严重影响设备稳定性及图像采集质量和效率。为解决柔性臂抑振问题,本文针对柔性臂关节角位移固定的行走过程和角位移变化的调姿过程,分别建立柔性臂振动力学模型,并设计不同场景下的控制器进行抑振。主要研究内容如下:
(1)在行走过程中,考虑柔性臂自重对轴向载荷的影响,建立了轴向载荷与负载同时作用下的变截面柔性臂振动力学解析模型,并基于格林函数给出了固有特性求解方法,进而探究了柔性臂自重对固有特性的影响;应用柔性臂振动力学模型求解振动响应,结果表明,柔性臂各工况下的末端残余振动显著,因此需要进行抑振控制。
(2)针对柔性臂行走过程中残余振动的抑制问题,考虑PID控制中参数组合难以选取的现状,设计了基于BP神经网络的PID控制器。结果表明,基于BP神经网络的PID控制器抑振效果显著,且具有较好的动态性能。
(3)在调姿过程中,考虑柔性臂关节转动对末端振动的影响,基于假设模态法和Lagrange原理,建立了柔性臂振动力学解析模型,进而研究了柔性臂不同运动轨迹下其末端振动响应规律,并基于改进蜣螂算法,制定了抑振轨迹规划策略,得到了最优抑振轨迹。结果表明,柔性臂完全跟踪此轨迹时,抑振效果显著。
(4)针对柔性臂最优抑振轨迹跟踪问题,采用奇异摄动法对振动力学模型解耦,设计了基于自抗扰控制和线性二次型最优控制的组合控制器,并通过改进能量谷优化(EVO)算法优化控制器参数。结果表明,组合控制器能够使柔性臂精确跟踪最优抑振轨迹,但抗干扰能力较弱,致使柔性臂偏离最优抑振轨迹,从而增加振动量。
(5)针对组合控制器抗干扰能力较弱问题,设计了基于滑模控制的SMC控制器,并通过改进EVO算法优化控制器参数,得到了比组合控制器更好的轨迹跟踪效果,且抗干扰能力较强、抑振效果显著。