引言

本系统提出的算法主要是在加速度计、陀螺仪、磁力计采集人体运动姿态信息的基础上，运用扩展卡尔曼滤波算法将数据进行融合，得到人体腰部和腿部的角度信息，然后通过大量实验建立与姿态的对应关系，采用这种方式可以利用加速度计与磁力计克服单独采用陀螺仪引起的姿态角发散问题，另外利用陀螺仪可以避免振动对于加速度计的影响和软硬铁磁对于磁力计的影响[2]。

1 系统整体设计方案

系统分为上位机系统和下位机系统，下位机系统由电源模块、两个iNEMO模块、GPRS模块和主控板组成，其中电源模块给整个系统提供3.3 V和5 V的工作电压，两个iNEMO模块分别固定在人体的腰部和腿部，完成对加速度计、磁力计、陀螺仪的信息采集，然后通过串口发送到主控板，主控板进行卡尔曼滤波，融合出腰部和腿部的角度，然后根据腰部和腿部的角度值完成姿态的检测，最后GPRS模块通过Socket协议将姿态信息打包传送到上位机，上位机实现远程监控。系统整体设计方案如图1所示。

图1 系统整体设计方案

2 数据融合原理

在惯性导航领域，求取姿态角的数学表达式叫做方向余弦矩阵。方向余弦矩阵有两种表示方式：欧拉角与四元数[3]。欧拉角的优点是比较直观，缺点是在俯仰角为正负90°时系统存在不稳定奇点。四元数的优点是当俯仰角为正负90°时系统不受影响，缺点是不直观。下面是它们之间的相互转换公式。

欧拉角转换成四元数：

四元数转换成欧拉角:

在程序中使用的是四元数，由于四元数不能直观地表示输出的角度，所以首先根据陀螺仪求取四元数，再将四元数转换成姿态角。根据运动体安装的三轴陀螺仪，可以得到在运动体坐标系下的三轴角速度（wx,wy,wz），用三轴角速度更新四元数:

然后利用加速度计的信息，采用卡尔曼滤波的方法来对四元数进行修正，设系统的状态空间方程为:

其中，X(k)是k时刻的系统状态，U(k)是k时刻对系统的控制量。A和B是系统参数。Z(k)是k时刻的测量值，H是测量系统的参数。W(k)和V(k)分别表示过程和测量的噪声。

为了提高惯性导航仪的启动速度，需要利用欧拉角求取初始的四元数，首先根据运动体上三轴加速度计输出的三轴加速度(fx,fy,fz)，求取俯仰角θ与横滚角,公式如下：

随后读取磁力计输出的三轴磁场强度Mb=MbxMbyMbz，然后用加速度计对磁力计进行倾斜补偿:

根据倾斜补偿后的磁力计输出，可以求得偏航角为:

利用式（5）和（7）可以完成对四元数的初始化工作。

3 系统硬件设计

3.1 iNEMO模块简介

iNEMO惯性导航模块的基本原理如图2所示，利用MEMS传感器和主控芯片STM32F103RET6提供动静态方向和惯性测量功能。集成3个(4种)意法半导体传感器：三轴陀螺仪（L3GD20）、三轴加速度计+三轴磁力计（LSM303DLHC）以及气压传感器（LPS331AP）。iNEMO传感器平台主控制器通过I2C总线与各传感器通信。iNEMO传感器平台可以通过串口向外界提供各传感器原始数据，还可以提供各传感器经AHRS算法融合后的横滚、偏航及俯仰角度。

图2 iNEMO惯性导航模块框图

3.2 主控制器电路设计

图3为系统主控板电路图，其中处理器采用了STM32F103VCT6，STM32系列单片机以CortexM3为内核，时钟频率可达到72 MHz，具有丰富的片内外设，高性能、低成本、低功耗的特点使其成为32位产品用户的最佳选择。主控板拓展了多个串行接口，和iNEMO腿部模块、iNEMO腰部模块和GPRS模块进行串口通信。稳压芯片选用了LM2576D2T5，其最大输入电压为45 V，可稳定输出5 V电压，再经过REG11173.3的稳压电路，产生3.3 V工作电压，当电流异常导致温度过高时，保险丝F1、F2可以自身熔断切断电流，起到保护电路的作用。另外，主控电路还包括复位电路、晶振电路、电容滤波电路以及JTAG下载接口等。

图3 主控板电路图

1

图4 GPRS电路图

3.3 GPRS电路设计

图4为GPRS电路图，主要包括MCU、SIM300模块、SIM卡卡槽、稳压电路四部分[4]。MCU同样采用了STM32F103VCT6，围绕它设计了单片机最小系统，包括晶振电路、复位电路、电容滤波电路等，MCU通过串口向SIM300发送控制指令以及接收SIM300返回的数据；SIM300模块与PCB板的连接方式为60引脚的板板连接器，全部引脚从该连接器引出，SIM300的网络状态指示灯引脚可根据模块的网络状态输出不同频率的电压脉冲，方便观测模块是否正常工作，对于不需要用的音频接口、LCD接口等，对应的引脚悬空即可。稳压芯片选择方面，可以使用开关型稳压芯片或者LDO线性稳压芯片，开关型稳压芯片转换效率高，但是需要的外围器件较多，且多为功率器件，占用空间比较大，为了节省PCB空间，设计中采用MIC52193.3BM5稳压芯片作为SIM300的电源调理芯片。

4 系统软件设计

4.1 系统软件整体流程图

图5所示为系统软件整体流程图，首先对STM32F103VCT6(以下简称STM32)进行初始化配置，包括时钟电路RCC高速时钟和低速时钟的起振、通用引脚GPIO输入/输出模式的配置、串口USART波特率的设置，然后将SIM300设置为透传模式，进行网络连接（具体过程可参考3.3节）。成功连接网络之后，配置iNEMO模块各传感器的分辨率、字节对齐方式、读取频率等，分别读取腰部和腿部iNEMO模块的加速度、陀螺仪、磁力计原始数据。获得原始数据之后根据分辨率的设置计算磁力计、陀螺仪、加速度的大小，最后通过扩展卡尔曼滤波融合得到腰部的俯仰角PITCH、腿部的偏航角YAW，结合两个角度信息通过查表法进行姿态判断，设置相应的标志位，通过GPRS将姿态标志位打包后发送到远程监控端。

图5 系统软件整体流程图

4.2 姿态检测

如图6所示，iNEMO模块中L3GD20、LSM303DLHC以及LPS331AP通过I2C串行总线与单片机进行通信，I2C总线两根双向信号线一根是数据线SDA，另一根是时钟线SCL，通过上拉电阻接到正电源VDD，每个接到I2C总线上的器件都有唯一的地址，主机发送地址时，总线上的每个从机都将7位地址码与自己的地址进行比较，如果相同，则认为自己正被主机寻址。

图6 I2C串行总线示意图

iNEMO各个传感器的地址码宏定义如下：

#define ACC_ADDRESS0x32//加速度计地址码

#define MAG_ADDRESS 0x3C//磁力计地址码

#define GYRO_ADDRESS 0xD6//陀螺仪地址码

采集到传感器的数据之后，首先利用三轴陀螺仪信号，采用四元数的姿态表达式、积分求得姿态角，然后采用三轴加速度计和三轴磁力计，利用大地磁场和重力磁场在地理坐标系和运动坐标系之间的方向余弦进行绝对角度的解算，然后采用卡尔曼滤波进行前三者数据的融合，得到腰部的俯仰角PITCH、腿部偏航角YAW。通过大量实验建立姿态角与人体姿态的对应表如表1所列。

表1 姿态与YAW、PITCH的对应表

4.3 GPRS发送

SIM300透传模式的配置大致分为以下4步：

① 匹配波特率，发送“AT”指令后，延时一段时间发送“ATE0”。

② 注册网络，发送“AT+CREG？”，若返回“OK”，则网络注册成功。

③ 设置透传模式，发送“AT + CIPMODE=1”，若返回“OK”，则设置成功。

④ 连接网络，发送“AT+CIPSTART="TCP"，"219.236.xxx.xxx"，"7000"”，其219.236.xxx.xxx为PC的IP地址，7000为端口号。连接成功返回"CONNECT OK"。

5 系统测试

为了验证系统姿态检测功能的可靠性，选取了不同的人分别佩戴该系统做了大量的实验，完成了对站立、坐下、行走、弯腰、躺下、趴倒的识别率的测试。从表2中可以看出，大部分动作均可以准确无误地识别出来，行走、弯腰两个动作出现了误识别，这是由于不同的人佩戴该系统时，各个姿态对应的角度阈值会有少许的差别，但是95%以上的识别率足够满足用户的要求。

表2 识别次数

结语

人体姿态检测装置实现了对人体姿态的检测，可以很好地应用在对老人的监护、体感游戏等领域。数字式传感器的应用简化了硬件电路，GPRS模块的网络传输突破了射频传输距离短的缺陷，扩大了传输距离，整个系统体积小巧方便、应用性强。