[發明專利]姿態傳感器安裝偏置的校正方法在審
| 申請號: | 201410035561.5 | 申請日: | 2014-01-24 |
| 公開(公告)號: | CN103743396A | 公開(公告)日: | 2014-04-23 |
| 發明(設計)人: | 李璽華;方繼勇;陳養彬 | 申請(專利權)人: | 上海新世紀機器人有限公司 |
| 主分類號: | G01C21/00 | 分類號: | G01C21/00 |
| 代理公司: | 北京金信立方知識產權代理有限公司 11225 | 代理人: | 劉鋒;黃小棟 |
| 地址: | 201318 上海市浦東新*** | 國省代碼: | 上海;31 |
| 權利要求書: | 查看更多 | 說明書: | 查看更多 |
| 摘要: | |||
| 搜索關鍵詞: | 姿態 傳感器 安裝 偏置 校正 方法 | ||
1.一種姿態傳感器安裝偏置的校正方法,其特征在于,包括如下的偏置角度測量過程:
S1.將安裝有所述姿態傳感器的安裝平臺固定設置于水平轉臺上,控制所述水平轉臺勻速旋轉,其中所述安裝平臺與所述水平轉臺之間保持相對靜止;
S2.在所述水平轉臺勻速旋轉時,獲取所述姿態傳感器中的陀螺儀輸出的俯仰角速度ωX0和偏航角速度ωZ0;
S3.根據公式θ=arctan(-ωX0/ωZ0)計算所述陀螺儀的俯仰軸與所述安裝平臺的俯仰軸之間的夾角θ并將該夾角θ作為所述偏置角度進行保存。
2.根據權利要求1所述的姿態傳感器安裝偏置的校正方法,其特征在于,該方法還包括如下的偏置角度校正過程:
在測量所述安裝平臺的俯仰角速度ωX′和偏航角速度ωZ′時,根據如下公式對所述陀螺儀輸出的俯仰角速度ωX和偏航角速度ωZ進行校正,以得到所述安裝平臺的俯仰角速度ωX′和偏航角速度ωZ′:
ωX′=ωX·cosθ+ωZ·sinθ
????????????????????????????。
ωZ′=ωZ·cosθ-ωX·sinθ
3.如權利要求1或2所述的姿態傳感器安裝偏置的校正方法,其特征在于,所述安裝平臺是自平衡兩輪車的姿態傳感器的安裝平臺。
該專利技術資料僅供研究查看技術是否侵權等信息,商用須獲得專利權人授權。該專利全部權利屬于上海新世紀機器人有限公司,未經上海新世紀機器人有限公司許可,擅自商用是侵權行為。如果您想購買此專利、獲得商業授權和技術合作,請聯系【客服】
本文鏈接:http://www.szxzyx.cn/pat/books/201410035561.5/1.html,轉載請聲明來源鉆瓜專利網。
- 上一篇:用于電容傳感器的測量電路
- 下一篇:鏤空網狀防水防靜電面料





