一种基于MIMU的便携脊柱测量仪及方法与流程

本发明专利公开了一种基于mimu的便携脊柱测量仪，为医疗器械技术领域。

背景技术：

在门诊诊断过程中，脊柱外科医生需要得到脊柱侧弯的病人cobb角，在测量cobb角时需要在x光片上多处多道辅助线，并通过量角器测量出夹角，通过计算其补角方可得到最后结果即cobb角。在测量脊柱cobb角的过程中需要使用各种医疗器械，但是在测量过程中极易导致人为的出错，使用繁琐且可靠性不高，而针对脊柱的测量专用仪器则又存在着不易携带，设备笨重且使用成本高的弊端。

目前，电子脊柱测量仪，如瑞士的idiagspinalmouse和以色列的spinescantm，其测量原理是一样的，基于大地倾角的测量，也即是三维电子重力角度感应技术；由于测量角度是根据重力三个轴向上计算的，必定会受重力提取精度的影响；由于一次只能测量一个角度，要想其他角度测量时，就必需得设计其他模式，导致测量操作繁琐；在大角度测量时，会存在很大的抖动误差；还有一种脊柱电子测量仪的核心测量传感器采用电阻式应变计或应变片，而应变是用来测量应力变化，一般测量微小变化，而脊柱可能大角度的变化，所以在测量原理上可能存在一些问题；另外，由于这些脊柱测量仪由主机、计算机、打印机组成，还不能做到便携。

技术实现要素：

近年来，mems惯性器件以其成本低、体积小、寿命长、集成化、抗冲击能力强和可靠性高等优势，成为姿态测量的首选器件。

本发明的目的在于通过构建由三轴mems加速度计和三轴mems陀螺仪的mimu惯性测量系统，通过脊柱测量仪在脊柱上滑动时的加速度和角速度，进而互补组合测量，同时高精度的解算出每个脊椎的三个角度(后凸角、侧凸角、侧弯角)，进而就能获得整个脊柱的角度变化。

脊柱测量仪主要包括两部分：手持智能终端测量部分和上位机分析显示部分。

手持智能终端测量部分包括：mimu数据采集单元、数据预处理和姿态解算单元、数据显示单元、数据传输单元，该智能终端测量部分实现姿态测量功能，可单独使用。

mimu数据采集单元包括三轴加速度计、三轴陀螺仪和温度计，加速度计和陀螺仪输出加速度、角速度和温度数据，经过放大，根据设置的数据采样频率和带宽，经过spi接口传输到数据预处理和姿态解算单元。

数据预处理和姿态解算单元也即是脊柱姿态测量的核心单元，硬件上由高速的嵌入式处理器、静/动态存储器、microsd卡、外围辅助电子元件构成，先进行温度漂移补偿，然后采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，然后根据补偿后的加速度和角速度数据进行姿态解算，并将原始加速度、角速度和脊柱姿态数据记录到microsd卡。

数据显示单元为spi接口的4线制的tft真彩屏。

数据传输单元为无线传输，采用有线和无线传输模式，有线传输模式采用usb数据格式传输，无线传输采用蓝牙加密模式传输。

上位机分析显示部分采用labview实现界面编程，其功能包括：

1)测量数据波形图显示和保存，即惯性测量数据(振动加速度和角速度)；

2)脊柱测量时脊柱的3d运动轨迹及姿态动态显示，对解算的脊柱姿态数据

记录保存；

3)远程读取，用于医护人员脊柱姿态分析。

脊柱测量仪的姿态解算步骤如下。

坐标系定义及其之间的转换关系是测量仪姿态解算的必备基础之一，坐标系定义坐标系及姿态描述：

基准坐标系——oxnynzn(n-系)：根据脊柱测量需求，采用地理坐标系作为基准坐标系。地理坐标系是相对于大地水平面定义的东北天坐标系，其原点位于地球表面，ozn轴沿地心与坐标系原点的连线并指向天向，垂直于当地水平面。oxnyn所组成的平面位于当地水平面内，两水平坐标轴分别指向东向和北向，三个坐标轴指向符合右手定则。

测量坐标系——oxbybzb(b-系)：测量坐标系沿测量仪的三个坐标轴建立。其中，取测量仪的重心为b-系的原点，oxb轴和oyb轴在同一平面内且互相垂直，ozb轴与测量仪轴线方向一致，且垂直于oxb轴和oyb轴构成的平面。三轴加速度计和三轴陀螺仪固联于测量仪坐标系，并沿测量仪的三个轴向正交安装。

脊柱的姿态和侧弯角，是由测量仪b-系相对于n-系的方位关系确定的。根据欧拉定理可知，测量仪任一姿态都可以采用b-系相对n-系的一系列转动来描述。每次旋转的角度依次为侧弯角ψ、后凸角θ和侧凸角γ，即欧拉角。进一步，可得到n-系到b-系的坐标变换矩阵为

基于上述坐标系描述，可定义测量仪测量的侧弯角、后凸角和侧弯角，侧弯角ψ定义为地磁北向沿逆时针方向与ozb轴在地平面的投影之间的夹角，ψ的取值范围为90°～90°；后凸角θ定义为oxb轴与地平面之间的夹角，θ的取值范围为-90°～+90°；侧凸角γ定义为oyb轴与地平面之间的夹角，γ的取值范围为90°～±90°。

在b-系中，测量仪稳定时沿三个轴向安装的加速度计只受到重力加速度的影响，此时加速度计实际测量值为重力加速度。在n-系中，重力矢量的方向始终朝下，而在其它轴向上的分量为零。重力加速度信号从b-系到n-系的转换关系为：

其中，为b-系到m-系的姿态变换矩阵，g为重力加速度，axc,ayc,azc为重力加速度在b-系中三个轴向上的计算分量。

将式(1)代入式(2)得

对(3)求解，可采用测量仪中的加速度计数据计算后凸角θa和侧凸角γa为

当后凸角或侧凸角的大角度测量时，az→0，导致γa角度大范围波动，当θa>85度时，在计算γa时补偿一个ay项，

姿态矩阵也可用四元数表示为

初始四元数计算：采用θa、γa、0初始化四元数

更新四元数：通过陀螺仪测量的三轴角速度数据gx,gy,gz计算四元数

利用陀螺仪数据获得的四元数计算后凸角θg、侧凸角γg和侧弯角ψg：

采用加速度计输出的数据ax,ay,az解算的后凸角和侧凸角，由于ax,ay,az可能包含外界加速度，即不全是重力加速度，所以利用加速度计实际输出的数据需要调节，设计自动调节参数即k>1时，说明利用加速度计输出的数据解算的后凸角和侧弯角有一定的误差，和k有关，k越大，误差越大，此时利用加速度解算的角度小一些；当k≈1时，利用加速度解算数据，即

计算姿态矩阵下的重力加速度，即把重力加速度投影到姿态矩阵下，即得如果姿态矩阵准确，则计算的重力加速度和三个轴向上输出的重力加速度是一样的，但实际上存在误差，设侧弯角误差δψ，该误差正比于向量和向量的叉乘中的ax*ayc-ay*axc项，设比例系数为p，则δψ＝p(ax*ayc-ay*axc)，利用δψ进行补偿ψg，考虑加速度波动的影响，即k的影响，即侧弯角

补偿后的后凸角、侧凸角和侧弯角为

本发明脊柱测试仪无需用户自定义、操作简单、无创、可即时快速度三维角度动态测量，实时每个脊椎和脊柱姿态，测量精度更准确，不仅仅应用于脊柱姿态测量，可广泛应用于其他场合，如学校、儿保科、骨科、康复科、运动医学研究所、人体解剖实验室、生理实验室、保健实验室、国民体质监测中心、社区保健中心、疗养院、体检中心、老年医学等的姿态测量。

附图说明

图1是本发明脊柱测量仪系统结构；

图2是本发明脊柱测量仪姿态解算流程。

具体实施方式

如图1所示脊柱测量仪系统结构图。

脊柱测量仪主要包括两部分：手持智能终端测量部分和上位机分析显示部分。

手持智能终端测量部分包括：mimu数据采集单元、数据预处理和姿态解算单元、数据显示单元、数据传输单元。

mimu数据采集单元传感器硬件采用三轴模拟硅微mems陀螺pa-3arg-01，qfn封装，供电电压5v，尺寸25mm×25mm×24mm，具有spi接口，角速率分辨率为0.0625dps/lsb，动态可选的全量程范围(±250/±500/±1000/±2000°/s)，输出数据频率(odr)范围：12.5hz至800hz；加速度计采用colibrys的ms9000系列加速度计，具有从±2g到±250g大范围量程，超小型lcc20封装(8.9mm×8.9mm)，加速度计和陀螺仪输出加速度和角速度数据，经过谐振电路放大，采用二阶系统设置数据采样频率和带宽，再经过spi接口传输到数据预处理和姿态解算单元。

数据预处理和姿态解算单元也即是脊柱姿态测量的核心单元，硬件上采用stm32f4系列处理器，32-bit，处理速度168mhz，具有多种接口can，dcmi，ebi/emi，以太网，i2c，irda，lin，spi，uart/usart，usbotg等，自带a/d24x12b数据接口，程序存储器容量1mb，ram容量192k，外接256gmicrosd卡，对接收的加速度、角速度和温度，先进行温度漂移补偿，然后采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，再根据补偿后的加速度(ax,ay,az)和角速度(gx,gy,gz)数据进行姿态解算，并对手持智能终端部分测量数据进行记录，保存到microsd卡中，用于后期数据分析。

数据显示单元采用spi接口的4线制tft真彩屏。

数据传输单元为无线传输，采用有线和无线传输模式，有线传输模式采用usb数据格式传输，无线传输采用蓝牙加密模式传输，可利用小型蓝牙ms50sfa1m进行数据传输。

脊柱测量仪使用非常便捷，打开电源开关，沿着脊柱移动即可，数据显示单元就能显示姿态数据，包括后凸角、侧凸角和侧弯角。

上位机分析显示部分采用labview实现界面编程，其功能包括：

1)测量数据波形图显示和保存，即惯性测量数据(振动加速度和角速度)；

2)脊柱测量时脊柱的3d运动轨迹及姿态动态显示，对解算的脊柱姿态数据记录保存；

3)远程读取，用于医护人员脊柱姿态分析。

脊柱测量仪的姿态解算步骤如下。

坐标系定义及其之间的转换关系是测量仪姿态解算的必备基础之一，坐标系定义坐标系及姿态描述如下。

基准坐标系——oxnynzn(n-系)：根据脊柱测量需求，采用地理坐标系作为基准坐标系。地理坐标系是相对于大地水平面定义的东北天坐标系，其原点位于地球表面，ozn轴沿地心与坐标系原点的连线并指向天向，垂直于当地水平面。oxnyn所组成的平面位于当地水平面内，两水平坐标轴分别指向东向和北向，三个坐标轴指向符合右手定则。

测量坐标系——oxbybzb(b-系)：测量坐标系沿测量仪的三个坐标轴建立。其中，取测量仪的重心为b-系的原点，oxb轴和oyb轴在同一平面内且互相垂直，ozb轴与测量仪轴线方向一致，且垂直于oxb轴和oyb轴构成的平面。三轴加速度计和三轴陀螺仪固联于测量仪坐标系，并沿测量仪的三个轴向正交安装。

脊柱的姿态和侧弯角，是由测量仪b-系相对于n-系的方位关系确定的。根据欧拉定理可知，测量仪任一姿态都可以采用b-系相对n-系的一系列转动来描述。每次旋转的角度依次为侧弯角ψ、后凸角θ和侧凸角γ，即欧拉角。进一步，可得到n-系到b-系的坐标变换矩阵为

基于上述坐标系描述，可定义测量仪测量的侧弯角、后凸角和侧弯角，侧弯角ψ定义为地磁北向沿逆时针方向与ozb轴在地平面的投影之间的夹角，ψ的取值范围为180°～180°；后凸角θ定义为oxb轴与地平面之间的夹角，θ的取值范围为-90°～+90°；侧凸角γ定义为oyb轴与地平面之间的夹角，γ的取值范围为90°～±90°。

其姿态解算流程，如图2所示。

在b-系中，测量仪稳定时沿三个轴向安装的加速度计只受到重力加速度的影响，此时加速度计实际测量值为重力加速度。在n-系中，重力矢量的方向始终朝下，而在其它轴向上的分量为零。重力加速度信号从b-系到n-系的转换关系为：

其中，为b-系到m-系的姿态变换矩阵，g0为重力加速度。

将式(1)代入式(2)得

对(3)求解，则可利用测量仪预处理后的加速度计数据ax,ay,az计算的后凸角θa和侧凸角γa为

当后凸角或侧凸角的大角度测量时，az→0，导致γa角度大范围波动，当θa>85度时，在计算γa时补偿一个ay项，

姿态矩阵也可用四元数表示：

初始四元数计算：采用θa、γa、0初始化四元数

四元数更新：通过陀螺仪测量的三轴的数据gx,gy,gz计算四元数t为采样周期。

利用陀螺仪数据获得的四元数计算姿态角：

采用加速度计输出的数据ax,ay,az解算的后凸角和侧凸角，由于ax,ay,az可能包含外界加速度，即不全是重力加速度，所以利用加速度计实际输出的数据需要调节，设计自动调节参数即k>1时，说明利用加速度计输出的数据解算的后凸角和侧弯角有一定的误差，和k有关，k越大，误差越大，此时利用加速度解算的角度小一些；当k≈1时，利用加速度解算数据，即

计算姿态矩阵下的重力加速度，即把重力加速度投影到姿态矩阵下，即得如果姿态矩阵准确，则计算的重力加速度和三个轴向上输出的重力加速度是一样的，但实际上存在误差，设侧弯角误差δψ，该误差正比于向量和向量的叉乘中的ax*ayc-ay*axc项，设比例系数为p，则δψ＝p(ax*ayc-ay*axc)，利用δψ进行补偿ψg，考虑加速度波动的影响，即k的影响，即侧弯角

补偿后的后凸角、侧凸角和侧弯角为