摘要
本发明涉及一种惯性姿态数据修正方法,所述方法包括:S1,持续检测载体的俯仰角,并实时判断所述载体是否处于垂直平面上;S2,当检测到所述载体处于垂直平面上时,记录所述载体相对于参考坐标系的第一航向角A1;S3,继续持续检测所述载体的俯仰角,并实时判断所述载体是否脱离垂直平面;S4,当检测到所述载体脱离垂直平面时,记录脱离瞬间所述载体相对于所述参考坐标系的第二航向角A2;S5,将所述第二航向角A2修正为所述第一航向角A1。本发明的方法可以有效限制和减少载体在垂直平面上的航向角误差漂移。
技术关键词
数据修正方法
载体
清洁机器人
坐标系
控制单元
传感器
误差
系统为您推荐了相关专利信息
光纤光栅传感器
水下机器人
实时定位方法
分布式光纤
实时定位系统
表面形貌数据
多元线性回归模型
粗糙度参数
激光冲击工艺
多尺度特征
朗缪尔探针
实时监测系统
监测等离子体
控制单元
PID控制算法