假设三个电机分别为Yaw电机、Roll电机和Pitch电机,分别对应的角速度为w_yaw、w_roll和w_pitch。同时假设IMU测量到的角速度为w_imu = (w_imu_x, w_imu_y, w_imu_z)。

根据题目中给出的IMU坐标系和电机坐标系的方向关系,可以得到以下转换关系:

  1. Yaw电机轴方向上的角速度:w_yaw = w_imu_z

  2. Roll电机轴方向上的角速度:w_roll = -w_imu_y

  3. Pitch电机轴方向上的角速度:w_pitch = w_imu_x

其中,w_imu_x、w_imu_y和w_imu_z分别为IMU测量到的角速度在IMU坐标系中的分量。

需要注意的是,这里的转换关系假设了电机的夹角较小,即电机轴之间的夹角较小,以确保转换的准确性。如果电机夹角较大,可能需要考虑更复杂的转换关系。

三轴云台从上到下依次是偏航电机横滚电机俯仰电机imu放置在俯仰电机轴上方向为y向前x向上z向左当电机有一定夹角时求imu上测出的角速度转换到三个电机轴方向上的角速度

原文地址: http://www.cveoy.top/t/topic/hB3M 著作权归作者所有。请勿转载和采集!

免费AI点我,无需注册和登录