三轴云台从上到下依次是偏航电机横滚电机俯仰电机imu放置在俯仰电机轴上方向为y向前x向上z向左当电机轴角度分别为abc时求imu上测出的角速度转换到三个电机轴方向上的角速度
要将imu上测出的角速度转换到电机轴方向上的角速度,需要进行坐标系变换。
假设imu测得的角速度为wx, wy, wz。
首先,根据电机轴角度a, b, c,我们可以得到imu坐标系相对于电机坐标系的旋转矩阵R。
R = Rz(a) * Rx(b) * Ry(c)
其中,Rz(a)表示绕z轴旋转a角度的旋转矩阵,Rx(b)表示绕x轴旋转b角度的旋转矩阵,Ry(c)表示绕y轴旋转c角度的旋转矩阵。
然后,将imu测得的角速度(wx, wy, wz)表示为imu坐标系下的向量w_imu。
w_imu = [wx, wy, wz]^T
接下来,将w_imu通过旋转矩阵R进行坐标系变换,得到电机坐标系下的角速度w_motor。
w_motor = R * w_imu
最后,w_motor中的三个分量分别表示偏航电机、横滚电机、俯仰电机的角速度。
原文地址: http://www.cveoy.top/t/topic/hB30 著作权归作者所有。请勿转载和采集!