当前位置: 首页 » 技术方案 » 技术分析 » 正文

基于iNEMO模块的姿态检测及数据传输系统设计


  来源: 仪器仪表商情网 时间:2015-07-27 作者:
分享到:




图4 GPRS电路图

 4 系统软件设计

 4.1 系统软件整体流程图

       图5所示为系统软件整体流程图,首先对STM32进行初始化配置,包括时钟电路RCC高速时钟和低速时钟的起振、通用引脚GPIO输出输出模式的配置、串口USART波特率的设置,然后将SIM300设置为透传模式,进行网络连接(具体过程可参考3.3),成功连接网络之后,配置iNEMO模块各传感器的分辨率、字节对齐方式、读取频率等,然后分别读取腰部和腿部iNEMO模块的加速度、陀螺仪、磁力计原始数据,获得原始数据之后根据分别率的设置计算磁力计、陀螺仪、加速度的大小,最后通过扩展卡尔曼滤波融合得到腰部的俯仰角PITCH、腿部的偏航角YAW,结合两个角度信息通过查表法进行姿态判断,设置相应的标志位,通过GPRS将姿态标志位打包后发送到远程监控端。
       4.2 姿态检测
       如图6所示,iNEMO模块中L3GD20、LSM303DLHC 以及LPS331AP 通过I2C串行总线与单片机进行通信,I2C总线两根双向信号线一根是数据线SDA,另一根是时钟线SCL,通过上拉电阻接到正电源VDD,每个接到I2C总线上的器件都有唯一的地址,主机发送地址时,总线上的每个从机都将7位地址码与自己的地址进行比较,如果相同,则认为自己正被主机寻址。
       iNEMO各个传感器的地址码宏定义如下:
       #define ACC_ADDRESS 032 //加速度计地址码
       #define MAG_ADDRESS 03C //磁力计地址码
       #define GYRO_ADDRESS 0D6 //陀螺仪地址码
       采集到传感器的数据之后,首先利用三轴陀螺仪信号,采用四元数的姿态表达式,积分求得姿态角,然后采用三轴加速度计和三轴磁力计,利用大地磁场和重力磁场在地理坐标系和运动坐标系之间的方向余弦进行绝对角度的解算,然后采用卡尔曼滤波进行前三者数据的融合,得到腰部的俯仰角PITCH、腿部偏航角YAW。通过大量实验建立姿态角与人体姿态的对应表如下:
       4.3 GPRS发送

关键词:MEMS,微传感器,人体姿态检测    浏览量:779

声明:凡本网注明"来源:仪商网"的所有作品,版权均属于仪商网,未经本网授权不得转载、摘编使用。
经本网授权使用,并注明"来源:仪商网"。违反上述声明者,本网将追究其相关法律责任。
本网转载并注明自其它来源的作品,归原版权所有人所有。目的在于传递更多信息,并不代表本网赞同其观点或证实其内容的真实性,不承担此类作品侵权行为的直接责任及连带责任。如有作品的内容、版权以及其它问题的,请在作品发表之日起一周内与本网联系,否则视为放弃相关权利。
本网转载自其它媒体或授权刊载,如有作品内容、版权以及其它问题的,请联系我们。相关合作、投稿、转载授权等事宜,请联系本网。
QQ:2268148259、3050252122。


让制造业不缺测试测量工程师

最新发布
行业动态
技术方案
国际资讯
仪商专题
按分类浏览
Copyright © 2023- 861718.com All rights reserved 版权所有 ©广州德禄讯信息科技有限公司
本站转载或引用文章涉及版权问题请与我们联系。电话:020-34224268 传真: 020-34113782

粤公网安备 44010502000033号

粤ICP备16022018号-4