马超, 郑永军, 谭彧, Yubin Lan, 王书茂. 基于MEMS传感器的两轴姿态调整系统设计与试验[J]. 农业工程学报, 2015, 31(z1): 28-37. DOI: 10.3969/j.issn.1002-6819.2015.z1.005
    引用本文: 马超, 郑永军, 谭彧, Yubin Lan, 王书茂. 基于MEMS传感器的两轴姿态调整系统设计与试验[J]. 农业工程学报, 2015, 31(z1): 28-37. DOI: 10.3969/j.issn.1002-6819.2015.z1.005
    Ma Chao, Zheng Yongjun, Tan Yu, Yubin Lan, Wang Shumao. Design of two-axis attitude control system based on MEMS sensors[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2015, 31(z1): 28-37. DOI: 10.3969/j.issn.1002-6819.2015.z1.005
    Citation: Ma Chao, Zheng Yongjun, Tan Yu, Yubin Lan, Wang Shumao. Design of two-axis attitude control system based on MEMS sensors[J]. Transactions of the Chinese Society of Agricultural Engineering (Transactions of the CSAE), 2015, 31(z1): 28-37. DOI: 10.3969/j.issn.1002-6819.2015.z1.005

    基于MEMS传感器的两轴姿态调整系统设计与试验

    Design of two-axis attitude control system based on MEMS sensors

    • 摘要: 在精准农业生产过程中,传感器实时采集作物信息或环境状态,传感器与作物的相对位置,直接影响到采集数据的准确性,及后期处理的效率,甚至影响到作业的效果。而田间道路、垄间颠簸,会影响传感器与作物相对位置,造成信息失真和不准确,为了减少地面不平整干扰对传感器位置的影响,该文提出了基于MEMS传感器步进电机驱动的两轴姿态调整系统。本研究分析了系统的工作原理和控制方法,以陀螺仪、重力加速度计为姿态测量元件,步进电机为驱动部件,设计基于单片机控制的两轴姿态调整系统平台软硬件结构。系统采用单片机对陀螺仪和加速度计信息的实时采样,建立了多传感信息的融合算法和姿态判定模型,可以实时分析检测对象姿态,并输出控制步进电机,对平台姿态进行补偿调整,保持控制对象的相对惯性空间方位不变,实现了平台姿态平衡的快速控制。同时系统加入了绝对位置传感器,实现初始工作状态的自动复位。测试试验结果表明,系统运行稳定,单轴姿态调整精度在平整坡路状态下最大误差在0.5°以内,在田间颠簸路况运行下最大误差在3.0°以内,能够满足信息采集和检测过程中姿态自动调整、保持相对位置的控制要求。利用该控制系统,能够提高信息采集的准确性,在精准农业生产中具有应用作用。

       

      Abstract: Abstract: In precision agricultural equipment automation testing process, sensors on agricultural vehicles for collecting information need to keep the relative position with the ground from impact of narrow, uneven and complicated conditions. In the requirements of obtaining accurate attitude and position about the sensors relative to the ground level and to alleviate this problem, a two-axis attitude control system based on MEMS sensors was proposed. Firstly, the operational principle and control methods were analyzed. The Euler angles coordinate transformation method was introduced which is used to describe objects position accurately in inertial space. Secondly, the hardware and software of the attitude control system were designed. The system hardware includes power supply, accelerometer and gyroscope sensors, stepping motor drive, LCD and serial communication. The control system had two axis of rotation called pitch axis and roll axis, which was driven by stepping motor in each axis. And the system was controlled by microcontroller to drive two stepping motors to keep the relative level with the ground. What is more, the accelerometer is used to measure the acceleration of gravity in the condition of static, and the gyroscope is used to measure the angular velocity, so that the attitude control system used these two MEMS sensors to estimate the platform angle. The data of the gyroscope and accelerometer are real-time sampling to gain and analyze the current attitude angle. Therefore, multi-sensor information fusion algorithm and attitude estimation model were established. The complementary filter with two kinds of sensors was used to estimate the angle which had a time constant to define where the boundary between believing in the gyroscope and believing in the accelerometer is. Specifically, for the time periods shorter than time constant, the gyroscope integration takes precedence and the noisy accelerations are filtered out. And for the time periods longer than time constant, the accelerometer average is given more weighting than the gyroscope. Thus the control system chose the appropriate parameters to estimate the accurate angle which meet the requirement of system maximum control error. Finally, The PWM signal was output by microcontroller driving to the stepping motor. Then PWM signal was sent to stepping motor actuator to make the stepping motor turn a step angle. Additionally, the PD controller was used in the system in order to achieve rapid control in order that the two-axis direction was driven by stepping motors which made a quickly response to eliminate the horizontal deviation and kept the relative position with the ground. Two absolute encoders are also fixed on each axis. They were used to keep the system automatically reset to the initial position when the system started to work. The test results show that the system runs stably and the method of estimating angle is suitable for low and middle speed changing conditions. Single axis attitude control accuracy is less than 0.5 ° in the condition of flat slope of the road and is less than 3.0 ° running in the bumpy field road. The stabilized platform system meets the demands of the attitude automatically adjust to the constant orientation in the information collection process and attitude estimation process.

       

    /

    返回文章
    返回