发明名称 移动式足底内力测量系统
摘要 本发明提出了移动式足底内力测量系统,包括数据处理器、I2C总线以及设置在鞋垫上的测力器和柔性弯曲部件;所述测力器把测量得到的信号通过I2C总线汇总传输到数据处理器中进行运算,数据处理器中设有六维力解耦计算方法(1)和姿态融合计算方法(2),经过两种计算方法的运算,解算出人体生物力学信息。本发明能在人正常行走的状态下,精密测量人体生物力学信息数据,经过汇总运算后将人体生物力学信息数据实时地反馈到人体运动辅助的外骨骼或者机器人的控制系统中。
申请公布号 CN103932721A 申请公布日期 2014.07.23
申请号 CN201410178505.7 申请日期 2014.04.29
申请人 绍兴共立传感科技有限公司 发明人 刘涛;韩梅梅
分类号 A61B5/22(2006.01)I;A61B5/11(2006.01)I 主分类号 A61B5/22(2006.01)I
代理机构 北京联瑞联丰知识产权代理事务所(普通合伙) 11411 代理人 高文迪
主权项 移动式足底内力测量系统,其特征在于,包括数据处理器、I2C总线以及设置在鞋垫上的测力器和柔性弯曲部件,所述测力器与所述柔性弯曲部件连接;所述测力器把测量得到的信号通过I2C总线汇总传输到数据处理器中进行运算,所述数据处理器设有一套六维力解耦计算方法:C=F<sub>r</sub>·(F)<sup>T</sup>·(F·(F)<sup>T</sup>)<sup>‑1</sup>     (1)其中,公式中C是一个6*6的解耦标定矩阵;Fr代表参考力,是一个n*6的矩阵;F是六维力传感器在每次加载时候的输出值,也是一个n*6的矩阵;n是指标定过程中动态加载的次数,n大于6;所述数据处理器还设有一套姿态融合计算方法:<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>F</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>g</mi></msup><mo>=</mo><mi>R</mi><mo>&CenterDot;</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>F</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>;</mo><msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>M</mi><mi>x</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>g</mi></msup><mo>=</mo><mi>R</mi><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>M</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000498488480000011.GIF" wi="1725" he="269" /></maths>其中,公式中R代表三维姿态矩阵,<maths num="0002" id="cmaths0002"><math><![CDATA[<mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>F</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000498488480000012.GIF" wi="194" he="266" /></maths>和<maths num="0003" id="cmaths0003"><math><![CDATA[<mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>M</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced>]]></math><img file="FDA0000498488480000013.GIF" wi="206" he="272" /></maths>分别代表六维力传感器测到的原始三维力值和三维力矩值<maths num="0004" id="cmaths0004"><math><![CDATA[<msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>F</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>F</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>g</mi></msup>]]></math><img file="FDA0000498488480000014.GIF" wi="211" he="271" /></maths>和<maths num="0005" id="cmaths0005"><math><![CDATA[<msup><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mi>M</mi><mi>X</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Y</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr><mtr><mtd><msup><mi>M</mi><mi>Z</mi></msup><mrow><mo>(</mo><mi>k</mi><mo>)</mo></mrow></mtd></mtr></mtable></mfenced><mi>g</mi></msup>]]></math><img file="FDA0000498488480000015.GIF" wi="223" he="271" /></maths>代表通过计算得到的移动状态的三维力值和三维力矩值;所述数据处理器通过六维力解耦计算方法(1)和姿态融合计算方法(2)运算得到足底内力的信息数据。
地址 312000 浙江省绍兴市绍兴县科创大厦综合楼第三层306室