拖拉机组主从跟踪控制系统研究

摘要

为了提高农田作业的生产效率及作业的安全性，本文设计了拖拉机组的主从跟踪控制模型，实现了一个驾驶员可以控制两台拖拉机的目的。系统中采用了基于红外触发的超声波对射式测距原理实现了从动拖拉机对主拖拉机的定位，通过齐次坐标变换将主拖拉机的位置坐标点转换到以从动拖拉机为基准的静态坐标系中，通过最小二乘法拟合出主拖拉机的行驶路径，根据PID 控制原理设计了直线路径跟踪控制器。实车实验表明：在0.27m/s 的速度下，跟踪拖拉机跟踪先行拖拉机行驶30m的距离，最大的横向偏差为5cm，平均偏差为0.8cm，标准差为2.31。