CN110101388A - 一种基于mimu的便携脊柱测量仪及方法 - Google Patents

一种基于mimu的便携脊柱测量仪及方法 Download PDF

Info

Publication number
CN110101388A
CN110101388A CN201910409506.0A CN201910409506A CN110101388A CN 110101388 A CN110101388 A CN 110101388A CN 201910409506 A CN201910409506 A CN 201910409506A CN 110101388 A CN110101388 A CN 110101388A
Authority
CN
China
Prior art keywords
data
backbone
acceleration
angle
measuring instrument
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201910409506.0A
Other languages
English (en)
Other versions
CN110101388B (zh
Inventor
费树岷
杨金显
黄晓晖
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing Dongqi Intelligent Manufacturing Research Institute Co Ltd
Original Assignee
Nanjing Dongqi Intelligent Manufacturing Research Institute Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Nanjing Dongqi Intelligent Manufacturing Research Institute Co Ltd filed Critical Nanjing Dongqi Intelligent Manufacturing Research Institute Co Ltd
Priority to CN201910409506.0A priority Critical patent/CN110101388B/zh
Priority to PCT/CN2019/088259 priority patent/WO2020232727A1/zh
Publication of CN110101388A publication Critical patent/CN110101388A/zh
Application granted granted Critical
Publication of CN110101388B publication Critical patent/CN110101388B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/107—Measuring physical dimensions, e.g. size of the entire body or parts thereof
    • A61B5/1071—Measuring physical dimensions, e.g. size of the entire body or parts thereof measuring angles, e.g. using goniometers
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/107—Measuring physical dimensions, e.g. size of the entire body or parts thereof
    • A61B5/1075—Measuring physical dimensions, e.g. size of the entire body or parts thereof for measuring dimensions by non-invasive methods, e.g. for determining thickness of tissue layer
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/103—Detecting, measuring or recording devices for testing the shape, pattern, colour, size or movement of the body or parts thereof, for diagnostic purposes
    • A61B5/107—Measuring physical dimensions, e.g. size of the entire body or parts thereof
    • A61B5/1077—Measuring of profiles
    • A—HUMAN NECESSITIES
    • A61—MEDICAL OR VETERINARY SCIENCE; HYGIENE
    • A61B—DIAGNOSIS; SURGERY; IDENTIFICATION
    • A61B5/00—Measuring for diagnostic purposes; Identification of persons
    • A61B5/72—Signal processing specially adapted for physiological signals or for diagnostic purposes
    • G—PHYSICS
    • G16—INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR SPECIFIC APPLICATION FIELDS
    • G16H—HEALTHCARE INFORMATICS, i.e. INFORMATION AND COMMUNICATION TECHNOLOGY [ICT] SPECIALLY ADAPTED FOR THE HANDLING OR PROCESSING OF MEDICAL OR HEALTHCARE DATA
    • G16H50/00—ICT specially adapted for medical diagnosis, medical simulation or medical data mining; ICT specially adapted for detecting, monitoring or modelling epidemics or pandemics

Landscapes

  • Health & Medical Sciences (AREA)
  • Life Sciences & Earth Sciences (AREA)
  • Engineering & Computer Science (AREA)
  • Public Health (AREA)
  • Medical Informatics (AREA)
  • General Health & Medical Sciences (AREA)
  • Biomedical Technology (AREA)
  • Pathology (AREA)
  • Molecular Biology (AREA)
  • Veterinary Medicine (AREA)
  • Physics & Mathematics (AREA)
  • Heart & Thoracic Surgery (AREA)
  • Biophysics (AREA)
  • Surgery (AREA)
  • Animal Behavior & Ethology (AREA)
  • Oral & Maxillofacial Surgery (AREA)
  • Dentistry (AREA)
  • Physiology (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Psychiatry (AREA)
  • Signal Processing (AREA)
  • Data Mining & Analysis (AREA)
  • Databases & Information Systems (AREA)
  • Epidemiology (AREA)
  • Primary Health Care (AREA)
  • Gyroscopes (AREA)
  • Length Measuring Devices With Unspecified Measuring Means (AREA)
  • Measurement Of The Respiration, Hearing Ability, Form, And Blood Characteristics Of Living Organisms (AREA)

Abstract

本发明公开一种基于MIMU的便携脊柱测量仪，其特征在于包括手持智能终端，所述手持智能终端实现脊柱姿态测量功能，主要包括MIMU数据采集单元和数据预处理和姿态解算单元，所述MIMU数据采集单元利用三轴加速度计、三轴陀螺仪和温度计采集测量仪在脊柱上移动时的加速度、角速度和温度数据，并传输给所述数据预处理和姿态解算单元；所述数据预处理和姿态解算单元先进行温度漂移补偿，再采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，然后根据补偿后的加速度和角速度数据进行脊柱姿态解算。本发明脊柱测试仪操作简单，可即时快速度三维角度动态测量，实时每个脊椎和脊柱姿态，测量精度更准确。

Description

一种基于MIMU的便携脊柱测量仪及方法
技术领域
本发明专利公开了一种基于MIMU的便携脊柱测量仪，为医疗器械技术领域。
背景技术
在门诊诊断过程中，脊柱外科医生需要得到脊柱侧弯的病人cobb角，在测量cobb角时需要在X光片上多处多道辅助线，并通过量角器测量出夹角，通过计算其补角方可得到最后结果即cobb角。在测量脊柱cobb角的过程中需要使用各种医疗器械，但是在测量过程中极易导致人为的出错，使用繁琐且可靠性不高，而针对脊柱的测量专用仪器则又存在着不易携带，设备笨重且使用成本高的弊端。
目前，电子脊柱测量仪，如瑞士的Idiag SpinalMouse和以色列的SpineScanTM，其测量原理是一样的，基于大地倾角的测量，也即是三维电子重力角度感应技术；由于测量角度是根据重力三个轴向上计算的，必定会受重力提取精度的影响；由于一次只能测量一个角度，要想其他角度测量时，就必需得设计其他模式，导致测量操作繁琐；在大角度测量时，会存在很大的抖动误差；还有一种脊柱电子测量仪的核心测量传感器采用电阻式应变计或应变片，而应变是用来测量应力变化，一般测量微小变化，而脊柱可能大角度的变化，所以在测量原理上可能存在一些问题；另外，由于这些脊柱测量仪由主机、计算机、打印机组成，还不能做到便携。
发明内容
近年来，MEMS惯性器件以其成本低、体积小、寿命长、集成化、抗冲击能力强和可靠性高等优势，成为姿态测量的首选器件。
本发明的目的在于通过构建由三轴MEMS加速度计和三轴MEMS陀螺仪的MIMU惯性测量系统，通过脊柱测量仪在脊柱上滑动时的加速度和角速度，进而互补组合测量，同时高精度的解算出每个脊椎的三个角度(后凸角、侧凸角、侧弯角)，进而就能获得整个脊柱的角度变化。
脊柱测量仪主要包括两部分：手持智能终端测量部分和上位机分析显示部分。
手持智能终端测量部分包括：MIMU数据采集单元、数据预处理和姿态解算单元、数据显示单元、数据传输单元，该智能终端测量部分实现姿态测量功能，可单独使用。
MIMU数据采集单元包括三轴加速度计、三轴陀螺仪和温度计，加速度计和陀螺仪输出加速度、角速度和温度数据，经过放大，根据设置的数据采样频率和带宽，经过SPI接口传输到数据预处理和姿态解算单元。
数据预处理和姿态解算单元也即是脊柱姿态测量的核心单元，硬件上由高速的嵌入式处理器、静/动态存储器、micro SD卡、外围辅助电子元件构成，先进行温度漂移补偿，然后采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，然后根据补偿后的加速度和角速度数据进行姿态解算，并将原始加速度、角速度和脊柱姿态数据记录到micro SD卡。
数据显示单元为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，USB OTG等，自带A/D24x12b数据接口，程序存储器容量1MB，RAM容量192K，外接256G Micro SD卡，对接收的加速度、角速度和温度，先进行温度漂移补偿，然后采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，再根据补偿后的加速度(ax,ay,az)和角速度(gx,gy,gz)数据进行姿态解算，并对手持智能终端部分测量数据进行记录，保存到Micro SD卡中，用于后期数据分析。
数据显示单元采用SPI接口的4线制TFT真彩屏。
数据传输单元为无线传输，采用有线和无线传输模式，有线传输模式采用USB数据格式传输，无线传输采用蓝牙加密模式传输，可利用小型蓝牙MS50SF A1M进行数据传输。
脊柱测量仪使用非常便捷，打开电源开关，沿着脊柱移动即可，数据显示单元就能显示姿态数据，包括后凸角、侧凸角和侧弯角。
上位机分析显示部分采用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的影响，即侧弯角
补偿后的后凸角、侧凸角和侧弯角为

Claims (8)

1.一种基于MIMU的便携脊柱测量仪，其特征在于包括手持智能终端，所述手持智能终端实现脊柱姿态测量功能，主要包括MIMU数据采集单元和数据预处理和姿态解算单元，所述MIMU数据采集单元利用三轴加速度计、三轴陀螺仪和温度计采集测量仪在脊柱上移动时的加速度、角速度和温度数据，并传输给所述数据预处理和姿态解算单元；所述数据预处理和姿态解算单元先进行温度漂移补偿，再采用时间序列分析和强跟踪卡尔曼滤波的处理算法，估计角速度和加速度零点偏差，进行数据零点偏差补偿，然后根据补偿后的加速度和角速度数据进行脊柱姿态解算。
2.如权利要求1所述的基于MIMU的便携脊柱测量仪，其特征在于所述手持智能终端包括数据显示单元，所述数据显示单元用于显示脊柱姿态，包括后凸角、侧凸角和侧弯角。
3.如权利要求2所述的基于MIMU的便携脊柱测量仪，其特征在于所述数据显示单元为SPI接口的4线制的TFT真彩屏。
4.如权利要求1所述的基于MIMU的便携脊柱测量仪，其特征在于包括上位机，所述手持智能终端包括数据传输单元，采用有线或无线传输模式，将姿态解算结果发送给所述上位机进行分析、显示。
5.如权利要求4所述的基于MIMU的便携脊柱测量仪，其特征在于所述上位机采用LabVIEW实现界面编程，其分析、显示功能包括：测量数据波形图显示和保存；脊柱测量时脊柱的3D运动轨迹及姿态动态显示，对解算的脊柱姿态数据记录保存；远程读取，用于医护人员脊柱姿态分析。
6.如权利要求1所述的基于MIMU的便携脊柱测量仪，其特征在于所述数据预处理和姿态解算单元由高速的嵌入式处理器、静/动态存储器、micro SD卡、外围辅助电子元件构成。
7.如权利要求1所述的基于MIMU的便携脊柱测量仪，其特征在于所述MIMU数据采集单元采集的数据经过放大，根据设置的数据采样频率和带宽，通过SPI接口传输给所述数据预处理和姿态解算单元。
8.权利要求1所述脊柱测量仪的姿态解算方法，其特征在于包括：
1)坐标系转换及姿态描述：
坐标系定义如下：
基准坐标系n-系——OXnYnZn：根据脊柱测量需求，采用地理坐标系作为基准坐标系；
测量坐标系b-系——OXbYbZb：测量坐标系沿测量仪的三个坐标轴建立；其中，取测量仪的重心为b-系的原点，OXb轴和OYb轴在同一平面内且互相垂直，OZb轴与测量仪轴线方向一致，且垂直于OXb轴和OYb轴构成的平面；三轴加速度计和三轴陀螺仪固联于测量仪坐标系，并沿测量仪的三个轴向正交安装；
n-系到b-系的坐标变换矩阵为
基于上述坐标系描述，定义测量仪测量的侧弯角、后凸角和侧弯角，侧弯角ψ定义为地磁北向沿逆时针方向与OZb轴在地平面的投影之间的夹角，ψ的取值范围为90°～90°；后凸角θ定义为OXb轴与地平面之间的夹角，θ的取值范围为-90°～+90°；侧凸角γ定义为OYb轴与地平面之间的夹角，γ的取值范围为90°～±90°；
在b-系中，测量仪稳定时沿三个轴向安装的加速度计只受到重力加速度的影响，此时加速度计实际测量值为重力加速度；在n-系中，重力矢量的方向始终朝下，而在其它轴向上的分量为零；重力加速度信号从b-系到n-系的转换关系为：
其中，为b-系到m-系的姿态变换矩阵，g0为重力加速度，axc,ayc,azc为重力加速度在b-系中三个轴向上的计算分量；
将式(1)代入式(2)得
对(3)求解，采用测量仪中的加速度计数据计算后凸角θa和侧凸角γa为
其中，ax,ay,az为加速度计输出数据；
当后凸角或侧凸角的大角度测量时，az→0，导致γa角度大范围波动，当θa>85度时，在计算γa时补偿一个ay项，
2)姿态矩阵也可用四元数表示为
初始四元数计算：采用θa、γa、0初始化四元数
更新四元数：通过陀螺仪测量的三轴的加速度数据gx,gy,gz计算四元数
利用陀螺仪数据获得的四元数计算后凸角θg、侧凸角γg和侧弯角ψg：
采用加速度计输出的数据ax,ay,az解算的后凸角和侧凸角，由于ax,ay,az可能包含外界加速度，即不全是重力加速度，所以利用加速度计实际输出的数据得需要调节，设计自动调节参数即k>1时，说明利用加速度计输出的数据解算的后凸角和侧弯角有一定的误差，和k有关，k越大，误差越大，此时利用加速度解算的角度要小一些；当k≈1时，完全利用加速度解算的数据，即
3)计算姿态矩阵下的重力加速度，即把重力加速度投影到姿态矩阵下，即得如果姿态矩阵准确，则计算的重力加速度和三个轴向上输出的重力加速度是一样的，但实际上存在误差，设侧弯角误差Δψ，该误差正比于向量和向量的叉乘中的ax*ayc-ay*axc项，设比例系数为p，则Δψ＝p(ax*ayc-ay*axc)，利用Δψ进行补偿ψg，考虑加速度波动的影响，即k的影响，即侧弯角
补偿后的后凸角、侧凸角和侧弯角为
CN201910409506.0A 2019-05-17 2019-05-17 一种基于mimu的便携脊柱测量仪及方法 Active CN110101388B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201910409506.0A CN110101388B (zh) 2019-05-17 2019-05-17 一种基于mimu的便携脊柱测量仪及方法
PCT/CN2019/088259 WO2020232727A1 (zh) 2019-05-17 2019-05-24 一种基于mimu的便携脊柱测量仪及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910409506.0A CN110101388B (zh) 2019-05-17 2019-05-17 一种基于mimu的便携脊柱测量仪及方法

Publications (2)

Publication Number Publication Date
CN110101388A true CN110101388A (zh) 2019-08-09
CN110101388B CN110101388B (zh) 2022-02-18

Family

ID=67490565

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910409506.0A Active CN110101388B (zh) 2019-05-17 2019-05-17 一种基于mimu的便携脊柱测量仪及方法

Country Status (2)

Country Link
CN (1) CN110101388B (zh)
WO (1) WO2020232727A1 (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112535489A (zh) * 2020-12-25 2021-03-23 四川大学华西医院 一种利用波形图测量脊柱侧弯Cobb角的方法及其系统
CN112971983A (zh) * 2021-02-03 2021-06-18 广州导远电子科技有限公司 姿态数据的测量方法、装置、电子设备及存储介质

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN114485562B (zh) * 2022-01-25 2023-09-29 福建利利普光电科技有限公司 一种基于重力传感的手持示波器水平位置调节方法

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN86201303U (zh) * 1986-03-10 1987-04-08 尹继军 防止脊柱弯曲提示器
CN103776451A (zh) * 2014-03-04 2014-05-07 哈尔滨工业大学 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
CN103790583A (zh) * 2014-02-27 2014-05-14 河南理工大学 基于惯性测量参数的地质预测方法
CN104834372A (zh) * 2015-04-15 2015-08-12 程锦发 基于mems加速度传感器的多功能穿戴式人机交互输入设备
US20150276793A1 (en) * 2014-03-26 2015-10-01 Honda Motor Co., Ltd. Upper body motion measurement system and upper body motion measurement method
CN105102928A (zh) * 2013-02-01 2015-11-25 株式会社理光 惯性装置、方法和程序
CN106419927A (zh) * 2016-08-29 2017-02-22 中国科学院深圳先进技术研究院 一种脊柱健康评估方法及装置
CN106482734A (zh) * 2016-09-28 2017-03-08 湖南优象科技有限公司 一种用于imu多传感器数据融合的滤波方法
CN107661105A (zh) * 2017-11-07 2018-02-06 上海大学 一种测量脊柱形态的测量仪
CN108742633A (zh) * 2018-06-09 2018-11-06 沙志平 一种电子脊椎测量仪
CN109737941A (zh) * 2019-01-29 2019-05-10 桂林电子科技大学 一种人体动作捕捉方法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20170347919A1 (en) * 2016-06-01 2017-12-07 Jimmy Dale Bollman Micro deviation detection device
CN107478223A (zh) * 2016-06-08 2017-12-15 南京理工大学 一种基于四元数和卡尔曼滤波的人体姿态解算方法
CN108836350B (zh) * 2018-06-24 2021-10-08 北京旷景科技有限公司 穿戴式躯干姿态监测系统及制作方法
CN109009135A (zh) * 2018-08-03 2018-12-18 北京纳通科技集团有限公司 脊柱3d测量仪及其测量方法
CN109674480B (zh) * 2019-02-02 2020-10-30 北京理工大学 一种基于改进互补滤波的人体运动姿态解算方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN86201303U (zh) * 1986-03-10 1987-04-08 尹继军 防止脊柱弯曲提示器
CN105102928A (zh) * 2013-02-01 2015-11-25 株式会社理光 惯性装置、方法和程序
CN103790583A (zh) * 2014-02-27 2014-05-14 河南理工大学 基于惯性测量参数的地质预测方法
CN103776451A (zh) * 2014-03-04 2014-05-07 哈尔滨工业大学 一种基于mems的高精度三维姿态惯性测量系统以及测量方法
US20150276793A1 (en) * 2014-03-26 2015-10-01 Honda Motor Co., Ltd. Upper body motion measurement system and upper body motion measurement method
CN104834372A (zh) * 2015-04-15 2015-08-12 程锦发 基于mems加速度传感器的多功能穿戴式人机交互输入设备
CN106419927A (zh) * 2016-08-29 2017-02-22 中国科学院深圳先进技术研究院 一种脊柱健康评估方法及装置
CN106482734A (zh) * 2016-09-28 2017-03-08 湖南优象科技有限公司 一种用于imu多传感器数据融合的滤波方法
CN107661105A (zh) * 2017-11-07 2018-02-06 上海大学 一种测量脊柱形态的测量仪
CN108742633A (zh) * 2018-06-09 2018-11-06 沙志平 一种电子脊椎测量仪
CN109737941A (zh) * 2019-01-29 2019-05-10 桂林电子科技大学 一种人体动作捕捉方法

Non-Patent Citations (7)

* Cited by examiner, † Cited by third party
Title
VO NHAT NGUYEN等: "Novel automatic posture detection for in-patient care using IMU sensors", 《2013 6TH IEEE CONFERENCE ON ROBOTICS, AUTOMATION AND MECHATRONICS (RAM)》 *
YONGHONG LI等: "Study on guided projectile ballistic trajectory measurement based on MIMU system", 《INTERNATIONAL CONFERENCE ON AUTOMATIC CONTROL AND ARTIFICIAL INTELLIGENCE (ACAI 2012)》 *
崔晓阳: "多传感器组合测姿系统设计及姿态解算算法研究", 《中国优秀硕士学位论文全文数据库工程科技辑》 *
杨洪兴等: "基于MIMU的人体三维姿态检测系统", 《信息技术与信息化》 *
沈林勇等: "基于姿态传感器的脊柱形态测量技术", 《传感技术学报》 *
许德新: "《动载体姿态检测与控制技术》", 30 September 2017, 哈尔滨工业大学出版社 *
金学波等编著: "《多传感器信息融合估计理论及其在智能制造中的应用》", 31 December 2018, 华中科技大学出版社 *

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112535489A (zh) * 2020-12-25 2021-03-23 四川大学华西医院 一种利用波形图测量脊柱侧弯Cobb角的方法及其系统
CN112535489B (zh) * 2020-12-25 2023-12-05 四川大学华西医院 一种利用波形图测量脊柱侧弯Cobb角的方法及其系统
CN112971983A (zh) * 2021-02-03 2021-06-18 广州导远电子科技有限公司 姿态数据的测量方法、装置、电子设备及存储介质

Also Published As

Publication number Publication date
CN110101388B (zh) 2022-02-18
WO2020232727A1 (zh) 2020-11-26

Similar Documents

Publication Publication Date Title
Roetenberg et al. Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation
Madgwick et al. Measuring motion with kinematically redundant accelerometer arrays: Theory, simulation and implementation
WO2008068542A1 (en) Auto-calibration method for sensors and auto-calibrating sensor arrangement
CN110101388A (zh) 一种基于mimu的便携脊柱测量仪及方法
US9599634B2 (en) System and method for calibrating inertial measurement units
JP5754051B2 (ja) 移動要素に剛結合された３軸加速度計の連続的な位置により形成された経路の特徴を決定する装置、システムおよび方法
CN108458714B (zh) 一种姿态检测系统中不含重力加速度的欧拉角求解方法
Ribeiro et al. Inertial measurement units: A brief state of the art on gait analysis
CN102980577A (zh) 一种微型捷联航姿系统及其工作方法
KR20060060666A (ko) 3축 나침반 문제해결을 위한 2축 자기센서를 이용한 장치
JP2004264060A (ja) 姿勢の検出装置における誤差補正方法及びそれを利用した動作計測装置
JP2009526980A (ja) モーションキャプチャー装置およびそれに係る方法
JP5850934B2 (ja) 自動車におけるより良いナビゲーション精度のためのｐｎｄ再位置決め検出器
KR20190043306A (ko) 3차원 좌표 측정장치
CN109916394A (zh) 一种融合光流位置和速度信息的组合导航算法
Lin et al. Development of an ultra-miniaturized inertial measurement unit WB-3 for human body motion tracking
CN110141240A (zh) 一种基于磁/惯性器件的脊柱测量仪
CN110243361A (zh) 惯性测量装置及移动体
JP2003093566A (ja) 運動識別方法および運動センシングモジュール
Li et al. A Pedestrian Dead Reckoning System Integrating Low-Cost MEMS Inertial Sensors and GPS Receiver.
Sang et al. A self-developed indoor three-dimensional pedestrian localization platform based on MEMS sensors
Barraza-Madrigal et al. Instantaneous position and orientation of the body segments as an arbitrary object in 3D space by merging gyroscope and accelerometer information
Lobo et al. Integration of inertial information with vision towards robot autonomy
Mumtaz et al. Development of a low cost wireless IMU using MEMS sensors for pedestrian navigation
KR101948017B1 (ko) 3차원 좌표 획득 방법

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant