以角速度为转向动作反馈的拖拉机自动导航控制系统

针对传统农机导航控制系统中转向角度传感器安装麻烦、可靠性较低的缺点,采用角速度计作为拖拉机转向动作的反馈传感器,结合拖拉机加装的基于CAN总线结构的导航控制装置,设计了串级PID自动导航控制系统,内环PID控制器用于转向控制,外环PID控制器用于路径跟踪控制。由于角速度计噪声误差较大,为避免对角速度的积分运算引起误差持续累积增大,角速度计的测量数据仅直接用作内环PID控制器的反馈;外环PID控制器的控制量也设计为角速度值。因此,在以转向角为控制量的比例控制算法基础上,本文又推导、设计了以角速度为控制量的外环PID控制算法。路面实验结果表明,本文设计的以角速度为转向动作反馈的拖拉机自动导航控制系统,直线路径的稳态跟踪误差平均值约为4.1cm,误差绝对值最大为12.9cm,验证了角速度计在农机导航控制系统中应用的可行性及所提控制方法的正确性。

Freescale S12单片机在拖拉机仪表中的应用

利用Freescale公司的S12系列单片机MC9S12XDP512作为主控制芯片制作拖拉机的CAN总线组合仪表,相对传统的拖拉机仪表提高了仪表的可靠性、测量精度和使用寿命,提高了拖拉机的整体性能和可靠性。