发明名称 |
三轴加速度传感器的z敏感轴的校准算法 |
摘要 |
本发明涉及一种三轴加速度传感器的z敏感轴的校准算法,其包括有以下步骤。设定三轴加速度传感器的x,y,z三敏感轴的零点依次为bx,by,bz,灵敏度依次为sx,sy,sz,其单位为一个重力加速度,其中z轴的零点与灵敏度:bz、sz,由于其较差的准确度,在此将其视为未知数;设定公式:a*z2+b*z+c=g(x,y) (1)以一个固定采样频率采样三轴加速度传感器在不同姿态静止状态下的3组原始数据:x1,y1,z1、x2,y2,z2、x3,y3,z3;代入公式(1)计算得到参数a,b,c的值,进而计算得到三轴加速度传感器z敏感轴真实的零点bz与灵敏度sz。 |
申请公布号 |
CN102654515A |
申请公布日期 |
2012.09.05 |
申请号 |
CN201110051829.0 |
申请日期 |
2011.03.04 |
申请人 |
美新微纳传感系统有限公司 |
发明人 |
毛尧辉;丁险峰;王清亮;周汉秦 |
分类号 |
G01P21/00(2006.01)I |
主分类号 |
G01P21/00(2006.01)I |
代理机构 |
上海和跃知识产权代理事务所(普通合伙) 31239 |
代理人 |
孟建勇 |
主权项 |
三轴加速度传感器的z敏感轴的校准算法,其特征在于:其包括有以下步骤:设定三轴加速度传感器的x、y、z三敏感轴的零点依次为bx、by、bz,灵敏度依次为sx、sy、sz,其单位为一个重力加速度,其中z轴的零点bz与灵敏度sz由于其较差的准确度,在此将其视为未知数;设定公式:a*z2+b*z+c=g(x,y) (1)其中: <mrow> <mi>a</mi> <mo>=</mo> <mfrac> <mn>1</mn> <msup> <mi>sz</mi> <mn>2</mn> </msup> </mfrac> </mrow> <mrow> <mi>b</mi> <mo>=</mo> <mfrac> <mrow> <mo>-</mo> <mn>2</mn> <mo>*</mo> <mi>bz</mi> </mrow> <msup> <mi>sz</mi> <mn>2</mn> </msup> </mfrac> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>2</mn> <mo>)</mo> </mrow> </mrow> <mrow> <mi>c</mi> <mo>=</mo> <mfrac> <msup> <mi>bz</mi> <mn>2</mn> </msup> <msup> <mi>sz</mi> <mn>2</mn> </msup> </mfrac> </mrow>以一个固定采样频率采样三轴加速度传感器在不同姿态静止状态下的3组原始数据:x1,y1,z1、x2,y2,z2、x3,y3,z3;则由公式(1)可得: <mrow> <mfenced open='[' close=']'> <mtable> <mtr> <mtd> <msubsup> <mi>z</mi> <mn>1</mn> <mn>2</mn> </msubsup> </mtd> <mtd> <msub> <mi>z</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>z</mi> <mn>2</mn> <mn>2</mn> </msubsup> </mtd> <mtd> <msub> <mi>z</mi> <mn>2</mn> </msub> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> <mtr> <mtd> <msubsup> <mi>z</mi> <mn>3</mn> <mn>2</mn> </msubsup> </mtd> <mtd> <msub> <mi>z</mi> <mn>3</mn> </msub> </mtd> <mtd> <mn>1</mn> </mtd> </mtr> </mtable> </mfenced> <mfenced open='[' close=']'> <mtable> <mtr> <mtd> <mi>a</mi> </mtd> </mtr> <mtr> <mtd> <mi>b</mi> </mtd> </mtr> <mtr> <mtd> <mi>c</mi> </mtd> </mtr> </mtable> </mfenced> <mo>=</mo> <mfenced open='[' close=']'> <mtable> <mtr> <mtd> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>1</mn> </msub> <mo>,</mo> <msub> <mi>y</mi> <mn>1</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>2</mn> </msub> <mo>,</mo> <msub> <mi>y</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mi>g</mi> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mn>3</mn> </msub> <mo>,</mo> <msub> <mi>y</mi> <mn>3</mn> </msub> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>-</mo> <mo>-</mo> <mo>-</mo> <mrow> <mo>(</mo> <mn>3</mn> <mo>)</mo> </mrow> </mrow>根据公式(3)计算得到参数a、b、c的值,然后通过公式(2)即可计算得到三轴加速度传感器z敏感轴真实的零点bz与灵敏度sz。 |
地址 |
214101 江苏省无锡市锡山经济开发区(东区)大成路南安盛路东 |