欢迎关注公众号:编程外星人,加入技术交流群
无人机的状态估计包括姿态解算和速度位置估计,为了进行状态估计,我们首先需要了解状态估计所需要用到的4个坐标系。这4个坐标系为:传感器坐标系(sensor)、机体坐标系(body)、本地坐标第(local)、全局坐标系(global)。
我们来讨论坐标系变换的相关内容。假设在3维直角坐标系x^0、y^0、z^0中坐标系以z^0为转轴按逆时针旋转θ之后得到新的坐标系坐标系x^1、y^1、z^1,那么在原坐标系下的向量p在源坐标系下的坐标和新坐标系下的坐标如图所示:
于是有: