微波EDA网,见证研发工程师的成长!
首页 > 硬件设计 > 嵌入式设计 > 多MEMS传感器的嵌入式姿态测量系统设计

多MEMS传感器的嵌入式姿态测量系统设计

时间:11-05 来源:互联网 点击:

陀螺仪与单片机ADC模块的接口如图3所示。图中ST、HP、PD作为自我测试、能量控制、高通滤波设置3个引脚,它们分别连接到MC9S08 QE8的通用I/O接口上。一般它们都接下拉电阻,默认为正常工作模式,如果需要对相应的工作模式进行改变则须改变对应MC9S08QE8I/O口的电平为高电平。而LY530AL与LPR530AL的输出信号(4xOTUX、4xOTUY、4xOTUZ引脚)与输出参考电压(Vref引脚)分别接MC9S08QE8的ADC模块的相应通道。设计中特别注意的是,LPR530AL有2种输出模式:一种是采用经过内部放大4倍后的输出,另一种是正常的输出。当采用非线性放大输出方式时,应当把LPR530AL的5引脚和9引脚连接GND;如果采用放大输出方式并且外部没有扩展旁路滤波,则应当分别把4和5引脚、9和10引脚短接。图3中,LY530AL工作原理与LPR530AL相似。
2.3 加速度计、电子罗盘与I2C接口
MC9S08QE8内带的高速I2C模块拥有多主机操作、可编程从机地址、中断驱动的逐字节数据发送、支持广播模式和10位寻址等特点,总线在最大负荷下可达到100kbps的速度。系统中,加速度计、电子罗盘芯片与MC9S08QE8 I2C模块的接口如图4所示。图中ADXL345的CS引脚用来控制选择I2C还是SPI通信协议,电平为高表示采用I2C协议,而SDA和SCL引脚分别连接到MC9S08QE8的I2C总线引脚上。电子罗盘HMC5843支持双电压工作,其中引脚VDD表示内核电压,引脚VDDIO表示外部I/O电压,本系统中采用单电压模式,即内核电压与外部I/O电压相同。

3 软件设计与测试
系统的软件设计是整个系统的重要组成部分。依据上述硬件电路的设计原理与功能要求,软件中首先要完成MC9S08QE8的初始化,对各种MEMS传感器的工作模式进行设定;然后获取三轴陀螺仪、加速度计、电子罗盘的实时信号,并根据姿态计算算法计算姿态角,最终把姿态角信息通过串口传送到上位机中进行测试与演示,嵌入式姿态测量系统软件流程如图5所示。


3.1 MC9S08QE8的初始化
MC9S08QE8的初始化函数主要实现对系统时钟、端口及各个使用的功能模块进行初始化,如ADC模块、SCI模块、I2C模块。初始化函数Sys_init_fun(void)如下:


上述计算得到的实时姿态角数据通过串口传送到上位机,上位机中通过编写的python演示程序对下位机姿态测量模块的运动姿态进行跟踪与显示,演示效果如图7所示。每幅图中包含3个部分:第1部分(左上角)中红、绿、蓝3种指针指向分别代表横滚角(roll)、俯仰角(pitch)与航向角(yaw)的大小,第2部分(左下角)显示模块实时运动姿态,第3部分(右边)用于显示姿态角信息。左图为物体静止不动下的演示效果,右图表示在运动过程中物体的姿态运动效果,通过对比与分析2个图及各图对应3部分的效果,可以说明本设计达到了良好的效果,能比较正确地测量物体的姿态信息。

结语
当前,各种消费电子设备内部一般含有三轴加速度计和电子罗盘,如智能手机、平板电脑等,但加速度计动态性能相比陀螺仪逊色很多,而陀螺仪的增加可以提升系统整体的动态与静态性能。本文设计的嵌入式姿态测量系统,采用多MEMS传感器组合方式,拓展了MEMS传感器的应用范围,也延伸了姿态测量系统的应用领域。实验演示表明系统性能和使用性都比较好,可以应用于消费电子与一般工业的姿态测量与物体稳定控制的应用中。

Copyright © 2017-2020 微波EDA网 版权所有

网站地图

Top