主权项 |
一种用于地磁要素测量系统的非对准误差校正方法,其特征在于,具体步骤为:①设置一直角型台面,并建立直角型台面的基准坐标系;②将地磁要素测量系统的磁传感器和加速度计一体封装于一个无磁正六面体内,将该无磁正六面体的两个面贴紧直角型台面的两个垂直面;建立无磁正六面体的正六面体坐标系;在初始位置时,无磁正六面体的正六面体坐标系与直角型台面的基准坐标系一致;③通过多次翻转无磁正六面体,令翻转后的无磁正六面体仍然紧靠直角型台面;利用空间磁场矢量和重力矢量在基准坐标系中投影不变的原理,得到翻转过程中正六面体坐标系的磁场投影与基准坐标系的磁场投影之间的解析表达式;④利用多次翻转过程中磁传感器与加速度计的多组测量值,通过多个非线性方程联立求解,分别计算出磁传感器的非对准误差和加速度计的非对准误差;同时,得到磁场和重力在基准坐标系的投影值;⑤间接计算出磁传感器与惯导之间的非对准误差,并进一步对磁传感器的测量值进行非对准误差的校正;所述磁传感器采用三轴磁传感器,所述加速度计采用三轴加速度计;初始位置时,直角型台面基准坐标系与正六面体坐标系重合,磁传感器与无磁正六面体的坐标关系如下式(1):<maths num="0001" id="cmaths0001"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>m</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><mi></mi><mi>θ</mi><mi>cos</mi><mi>Ψ</mi></mtd><mtd><mo>-</mo><mi>cos</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi>Ψ</mi><mo>+</mo><mi>sin</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi></mi><mi>θ</mi><mi>sin</mi><mi>Ψ</mi></mtd><mtd><mi>sin</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi>Ψ</mi><mo>+</mo><mi>cos</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi></mi><mi>θ</mi><mi>cos</mi><mi>Ψ</mi></mtd></mtr><mtr><mtd><mi>cos</mi><mi></mi><mi>θ</mi><mi>sin</mi><mi>Ψ</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>φ</mi><mi>cos</mi><mi>Ψ</mi><mo>+</mo><mi>sin</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi></mi><mi>θ</mi><mi>sin</mi><mi>Ψ</mi></mtd><mtd><mo>-</mo><mi>sin</mi><mi></mi><mi>φ</mi><mi>cos</mi><mi>Ψ</mi><mo>+</mo><mi>cos</mi><mi></mi><mi>φ</mi><mi>sin</mi><mi></mi><mi>θ</mi><mi>sin</mi><mi>Ψ</mi></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><mi>θ</mi></mtd><mtd><mi>sin</mi><mi></mi><mi>φ</mi><mi>cos</mi><mi>θ</mi></mtd><mtd><mi>cos</mi><mi></mi><mi>φ</mi><mi>cos</mi><mi>θ</mi></mtd></mtr></mtable></mfenced><mo>·</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>V</mi><mi>E</mi></msub></mtd></mtr><mtr><mtd><msub><mi>V</mi><mi>N</mi></msub></mtd></mtr><mtr><mtd><msub><mi>V</mi><mi>D</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>1</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000637844760000011.GIF" wi="2022" he="237" /></maths>其中,m<sub>x</sub>,m<sub>y</sub>,m<sub>z</sub>分别是磁传感器正交坐标系三个轴的测量值;V<sub>E</sub>,V<sub>N</sub>,V<sub>D</sub>分别是磁场矢量在直角型台面的基准坐标系的投影,θ,φ,Ψ分别是磁传感器到正六面体坐标系的非对准误差角;加速度计与无磁正六面体的坐标关系如下式(2):<maths num="0002" id="cmaths0002"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>g</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msup><mrow><mi>cos</mi><mi>θ</mi></mrow><mo>′</mo></msup><mi>cos</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd><mtd><mo>-</mo><mi>cos</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup><mo>+</mo><mi>sin</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>θ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd><mtd><mi>sin</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup><mo>+</mo><mi>cos</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>θ</mi><mo>′</mo></msup><mi>cos</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd></mtr><mtr><mtd><mi>cos</mi><msup><mi>θ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd><mtd><mi>cos</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>cos</mi><msup><mi>Ψ</mi><mo>′</mo></msup><mo>+</mo><mi>sin</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>θ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd><mtd><mo>-</mo><mi>sin</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>cos</mi><msup><mi>Ψ</mi><mo>′</mo></msup><mo>+</mo><mi>cos</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>θ</mi><mo>′</mo></msup><mi>sin</mi><msup><mi>Ψ</mi><mo>′</mo></msup></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><msup><mi>θ</mi><mo>′</mo></msup></mtd><mtd><mi>sin</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>cos</mi><msup><mi>θ</mi><mo>′</mo></msup></mtd><mtd><mi>cos</mi><msup><mi>φ</mi><mo>′</mo></msup><mi>cos</mi><msup><mi>θ</mi><mo>′</mo></msup></mtd></mtr></mtable></mfenced><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>g</mi><mi>E</mi></msub></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>N</mi></msub></mtd></mtr><mtr><mtd><msub><mi>g</mi><mi>D</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>2</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000637844760000012.GIF" wi="2018" he="233" /></maths>其中,g<sub>x</sub>,g<sub>y</sub>,g<sub>z</sub>分别是加速度计正交坐标系三个轴的测量值,g<sub>E</sub>,g<sub>N</sub>,g<sub>D</sub>分别是重力矢量在直角型台面的基准坐标系的投影,θ',φ',Ψ'分别为加速度计到正六面体坐标系的非对准误差角;所述间接计算出的磁传感器与惯导之间的非对准误差为:w<sub>x</sub>=θ'‑θ,w<sub>y</sub>=φ'‑φ,w<sub>z</sub>=Ψ'‑Ψ;对磁传感器的测量值进行非对准误差的校正为下式(3):<maths num="0003" id="cmaths0003"><math><![CDATA[<mrow><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>m</mi><mrow><mi>x</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mrow><mi>y</mi><mn>1</mn></mrow></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mrow><mi>z</mi><mn>1</mn></mrow></msub></mtd></mtr></mtable></mfenced><mo>=</mo><mfenced open='[' close=']'><mtable><mtr><mtd><mi>cos</mi><msub><mi>w</mi><mi>x</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>z</mi></msub></mtd><mtd><mo>-</mo><mi>cos</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub><mo>+</mo><mi>sin</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>x</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub></mtd><mtd><mi>sin</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub><mo>+</mo><mi>cos</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>x</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><mi>cos</mi><msub><mi>w</mi><mi>x</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>w</mi><mi>y</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>z</mi></msub><mo>+</mo><mi>sin</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>x</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub></mtd><mtd><mo>-</mo><mi>sin</mi><msub><mi>w</mi><mi>y</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>z</mi></msub><mo>+</mo><mi>cos</mi><msub><mi>w</mi><mi>y</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>x</mi></msub><mi>sin</mi><msub><mi>w</mi><mi>z</mi></msub></mtd></mtr><mtr><mtd><mo>-</mo><mi>sin</mi><msub><mi>w</mi><mi>x</mi></msub></mtd><mtd><mi>sin</mi><msub><mi>w</mi><mi>y</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>x</mi></msub></mtd><mtd><mi>cos</mi><msub><mi>w</mi><mi>y</mi></msub><mi>cos</mi><msub><mi>w</mi><mi>x</mi></msub></mtd></mtr></mtable></mfenced><mo>·</mo><mfenced open='[' close=']'><mtable><mtr><mtd><msub><mi>m</mi><mi>x</mi></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mi>y</mi></msub></mtd></mtr><mtr><mtd><msub><mi>m</mi><mi>z</mi></msub></mtd></mtr></mtable></mfenced><mo>-</mo><mo>-</mo><mo>-</mo><mrow><mo>(</mo><mn>3</mn><mo>)</mo></mrow></mrow>]]></math><img file="FDA0000637844760000021.GIF" wi="1922" he="210" /></maths>其中,m<sub>x1</sub>,m<sub>y1</sub>,m<sub>z1</sub>为非对准误差校正后的磁传感器的测量值。 |