畜牧养殖环境监测自主移动平台轨迹跟踪控制算法  

Trajectory tracking algorithm of autonomous mobile platform for animal husbandry environment information monitoring

作　　者：吕恩利[1,2] 韦鉴峰 王昱[1,2] 赵俊宏[1] 王飞仁 刘妍华 Lü Enli;Wei Jianfeng;Wang Yu;Zhao Junhong;Wang Feiren;Liu Yanhua(College of Engineering,South China Agricultural University,Guangzhou 510642,China;Key Laboratory of Key Technology on Agricultural Machine and Equipment,Ministry of Education,South China Agricultural University,Guangzhou 510642,China;Engineering Fundamental Teaching and Training Center,South China Agricultural University,Guangzhou 510642,China)

机构地区：[1]华南农业大学工程学院,广州510642 [2]华南农业大学南方农业机械与装备关键技术教育部重点实验室,广州510642 [3]华南农业大学工程基础教学与训练中心,广州510642

出　　处：《农业工程学报》2018年第13期86-94,共9页Transactions of the Chinese Society of Agricultural Engineering

基　　金：国家科技支撑计划课题(2015BAD18B0303);现代农业产业技术体系建设专项资金(CARS-33-13);国家自然科学基金项目(51108194)

摘　　要：为实现畜牧养殖环境全方位监测,开发了可实现轨迹跟踪的自主移动监测平台。以具有非完整约束特性的自主移动平台为研究对象,研究其轨迹跟踪问题。在平台的结构基础上,通过建立其运动学模型及误差模型,提出基于Lyapunov函数和反推(Backstepping)时变状态反馈控制方法的轨迹跟踪算法,实现自主移动平台转向轮转角和行驶速度的控制。仿真和试验表明:所提出的控制算法能使该平台较好的收敛于期望轨迹,当跟踪期望轨迹稳定后,控制参数为(k_1,k_2,k_3,k_4)=(0.1,0.2,0.15,0.3)时,直线轨迹跟踪误差为x_e=±7 mm,y_e=±9.8 mm,θ_e=±4.2°,圆弧轨迹跟踪误差为x_e=±6.2 mm,y_e=±8.3 mm,θ_e=±5.8°,取得良好的跟踪精度。该研究可为畜牧养殖环境监测自主移动平台轨迹跟踪控制提供参考。In order to achieve all-round monitoring of livestock environment, an autonomous mobile monitoring platform for trajectory tracking was developed. The trajectory tracking control problem of autonomous mobile platform was studied. According to the structure of the platform, the system structure and function of the autonomous mobile platform were introduced, including all kinds of sensors that the platform itself needs to perceive, and the measurement sensors needed for animal environment monitoring. And in the structure based autonomous mobile platform, combined with the autonomous mobile platform of four wheel model characteristics and kinematics principle of the simplified two DOF bicycle model, through the analysis of two degree of freedom model to obtain the kinematics model of the bicycle, so as to obtain the platform of steering wheel angle and moving between speed and wheelbase. According to the position and posture relationship between the current point and the desired point of the platform, the error model and the error differential model were obtained by using the geometric method, and it was proved that the platform would eventually converge to the desired trajectory as long as the platform speed and steering wheel angle were accurately controlled. In addition, according to the characteristics of the nonholonomic constraints of the platform, the choice of the expected point was determined by the arc tangent point method. Based on the platform error differential model, a time-varying state feedback control algorithm based on Lyapunov function and Backstepping was proposed, and the trajectory tracking control rate was obtained to achieve the control of steering wheel angle and speed of autonomous mobile platform. The rate was simulated on the platform of Matla2015 a software, using the obtained control. The simulation results show that when the initial error is large, the rate control algorithm can make the platform converge to the desired trajectory, the error over time tends to zero. When choosing the p

关 键 词：环境监测 算法 模型 自主移动平台 轨迹跟踪 运动学模型 LYAPUNOV函数 Beckstepping 

分 类 号：TP23[自动化与计算机技术—检测技术与自动化装置]