System.ArgumentOutOfRangeException: 索引和長度必須引用該字符串內的位置。 參數名: length 在 System.String.Substring(Int32 startIndex, Int32 length) 在 zhuanliShow.Bind()
【技術實現步驟摘要】
本專利技術屬于慣性測量單元標定領域,具體涉及一種基于陣列式imu的加速度計桿臂誤差補償方法。
技術介紹
1、慣性導航系統由于其完全自主、不依賴外部信息、不受外界干擾的特點,在國防和國民經濟中起到了重要的作用。陀螺儀是慣性導航的核心部件,陀螺儀的性能是決定慣性導航系統性能的主要因素。隨著20世紀90年代基于微電子機械系統技術的進步與完善,該技術被逐步應用到慣性領域,如mems陀螺儀。mems陀螺儀具有占用空間小、質量輕,易于集成,高可靠度制造成本低的特點,但存在檢測精度低的缺陷。
2、提升mems陀螺儀的制造加工工藝難度較大,成本也較高,因此科研人員在努力提高mems陀螺器件本身性能的同時,也在陀螺儀后端數據的處理上做了大量工作,而memsimu陣列技術就是在此背景下興起的一項技術。memsimu陣列又叫虛擬陀螺,是指使用多個精度較低的mems陀螺儀集成到一塊電路板上組成陣列,對同一目標進行檢測,采集多個傳感器數據經過數據融合處理,輸出一組高精度與高可信度的數據,實現對運動目標的精密檢測,該方案因成本低廉、易于實現而被廣泛應用。例如,公開號為cn118410455a的專利提出了一種陣列式冗余imu信息融合的方法和裝置,公開號為cn117191086a的專利公開了一種用于imu陣列的低復雜度自校準方法,公開號為cn116680534a的專利提出了imu陣列數據處理方法、裝置、電子設備以及存儲介質。
3、然而由于集成在memsimu陣列上的每一個mems陀螺儀的安裝位置都不一樣,且與pcb板中心點不相重合,當p
技術實現思路
1、鑒于現有技術的不足,本專利技術的目的在于提供一種基于陣列式imu的加速度計桿臂誤差補償方法,用以解決現有技術中存在的缺陷。
2、為實現上述目的,本專利技術采用如下技術方案:一種基于陣列式imu的加速度計桿臂誤差補償方法,包括如下步驟:
3、s1、測量memsimu陣列上各個陀螺儀相對于pcb板中心點的桿臂長度;
4、s2、根據各個陀螺儀的角速度和桿臂長度,計算各個加速度計x,y,z三軸所敏感到的向心加速度和切向加速度桿臂誤差大小;
5、s3、將memsimu陣列劃分為四個象限,分析各個象限內的加速度計x,y,z三軸所敏感到的向心加速度和切向加速度桿臂誤差方向;
6、s4、根據桿臂誤差大小和桿臂誤差方向,將各個象限內加速度計所敏感到的向心加速度和切向加速度桿臂誤差進行合并整理,得到總的加速度桿臂誤差;
7、s5、在memsimu陣列的輸出加速度中補償總的加速度桿臂誤差。
8、優選地,步驟s1中,測量memsimu陣列上各個陀螺儀相對于pcb板中心點的桿臂長度,具體過程如下:
9、定義陀螺儀的中心點到pcb板縱軸的距離為橫向桿臂長度x,陀螺儀的中心點到pcb板橫軸的距離為縱向桿臂長度y,陀螺儀的中心點到pcb板橫軸和縱軸組成的平面的距離為天向桿臂長度z;
10、分別測量memsimu陣列上各個陀螺儀的橫向桿臂長度x1,x2,...,xn和縱向桿臂長度y1,y2,...,yn;由于pcb板是二維平面板,因此天向桿臂長度z為0。
11、優選地,步驟s2中,根據各個陀螺儀的角速度和桿臂長度,計算各個加速度計x,y,z三軸所敏感到的向心加速度和切向加速度桿臂誤差大小,具體過程如下:
12、當memsimu陣列繞z軸旋轉時,加速度計敏感到的向心加速度和切向加速度桿臂誤差大小分別為:
13、a向=ωz2r;
14、
15、其中,a向為加速度計敏感到的向心加速度桿臂誤差,a切為加速度計敏感到的切向加速度桿臂誤差,ωz為陀螺儀z軸角速度,為陀螺儀z軸角加速度,r為陀螺儀相對于pcb板中心點的桿臂長度;
16、將加速度計敏感到的向心加速度和切向加速度桿臂誤差分解到x軸和y軸上,則加速度計x軸和y軸敏感到的向心加速度和切向加速度桿臂誤差大小分別為:
17、a向x=a向·cosθ=ωz2r·cosθ=ωz2x;
18、a向y=a向·sinθ=ωz2r·sinθ=ωz2y;
19、
20、
21、其中,a向x為加速度計x軸敏感到的向心加速度桿臂誤差,a向y為加速度計y軸敏感到的向心加速度桿臂誤差,a切x為加速度計x軸敏感到的切向加速度桿臂誤差,a切y為加速度計y軸敏感到的切向加速度桿臂誤差;
22、當memsimu陣列繞x軸旋轉時,只有y軸能夠敏感到向心加速度,只有z軸能夠敏感到切向加速度,此時加速度計敏感到的向心加速度和切向加速度桿臂誤差大小為:
23、a向=a向y=ωx2y;
24、
25、其中,a向y為加速度計y軸敏感到的向心加速度桿臂誤差,a切z為加速度計z軸敏感到的切向加速度桿臂誤差,ωx為陀螺儀x軸角速度,為陀螺儀x軸角加速度;
26、當memsimu陣列繞y軸旋轉時,只有x軸能夠敏感到向心加速度,只有z軸能夠敏感到切向加速度,此時加速度計敏感到的向心加速度和切向加速度桿臂誤差大小為:
27、a向=a向x=ωy2x;
28、
29、其中,a向x為加速度計x軸敏感到的向心加速度桿臂誤差,a切z為加速度計z軸敏感到的切向加速度桿臂誤差,ωy為陀螺儀y軸角速度,為陀螺儀y軸角加速度。
30、優選地,步驟s3中,將memsimu陣列劃分為四個象限,分析各個象限內的加速度計x,y,z三軸所敏感到的向心加速度和切向加速度桿臂誤差方向,具體過程如下:
31、將memsimu陣列劃分為四個象限,memsimu陣列安裝在pcb板時,memsimu陣列中心點與pcb板中心點重合,memsimu陣列x軸與pcb板x軸方向一致,memsimu陣列y軸與pcb板y軸方向一致,memsimu陣列z軸方向為垂直pcb板向外;當pcb板及其上的memsimu陣列在旋轉時,不同象限內的加速度計x,y,z三軸感受到的向心加速度和切向加速度桿臂誤差方向不同;
32、在第一象限中,當memsimu陣列繞z軸旋轉時,各個陀螺儀產生的向心加速度在橫軸上的分量方向與對應加速度計x軸方向相同,為正值,各個陀螺儀產生的向心加速度在縱軸上的分量方向與對應加速度計y軸方向相反,為負值,各個陀螺儀產生的切向加速度在橫軸和縱軸上的分量方向分別與對應加速度計x軸和y軸方向相反,均為負值;當memsimu陣列繞x軸旋轉時,各個陀螺儀產生的向心加速度與對應加速度計y軸方向相反,為負值,各個陀螺儀產生的切向加速度與對應加速度計z軸方向相同,為正值;當memsimu陣列繞y軸旋轉時,各個陀螺儀產生的向心加速度與對應加本文檔來自技高網...
【技術保護點】
1.一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,包括如下步驟:
2.根據權利要求1所述的一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,步驟S1中,測量MEMS?IMU陣列上各個陀螺儀相對于PCB板中心點的桿臂長度,具體過程如下:
3.根據權利要求2所述的一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,步驟S2中,根據各個陀螺儀的角速度和桿臂長度,計算各個加速度計X,Y,Z三軸所敏感到的向心加速度和切向加速度桿臂誤差大小,具體過程如下:
4.根據權利要求3所述的一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,步驟S3中,將MEMSIMU陣列劃分為四個象限,分析各個象限內的加速度計X,Y,Z三軸所敏感到的向心加速度和切向加速度桿臂誤差方向,具體過程如下:
5.根據權利要求4所述的一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,步驟S4中,根據桿臂誤差大小和桿臂誤差方向,將各個象限內加速度計所敏感到的向心加速度和切向加速度桿臂誤差進行合并整理,得到總的加速度桿臂誤差,具體過
6.根據權利要求1所述的一種基于陣列式IMU的加速度計桿臂誤差補償方法,其特征在于,步驟S5中,在MEMSIMU陣列的輸出加速度中補償總的加速度桿臂誤差,具體過程如下:
...【技術特征摘要】
1.一種基于陣列式imu的加速度計桿臂誤差補償方法,其特征在于,包括如下步驟:
2.根據權利要求1所述的一種基于陣列式imu的加速度計桿臂誤差補償方法,其特征在于,步驟s1中,測量mems?imu陣列上各個陀螺儀相對于pcb板中心點的桿臂長度,具體過程如下:
3.根據權利要求2所述的一種基于陣列式imu的加速度計桿臂誤差補償方法,其特征在于,步驟s2中,根據各個陀螺儀的角速度和桿臂長度,計算各個加速度計x,y,z三軸所敏感到的向心加速度和切向加速度桿臂誤差大小,具體過程如下:
4.根據權利要求3所述的一種基于陣列式imu的加速度計桿臂誤差補償方法,其...
【專利技術屬性】
技術研發人員:蔡慶中,徐驍楓,宋凝芳,涂勇強,龐陽,
申請(專利權)人:天目山實驗室,
類型:發明
國別省市:
還沒有人留言評論。發表了對其他瀏覽者有用的留言會獲得科技券。