如何使用Madgwick过滤器

问题描述 投票:0回答:1

有来自陀螺仪和加速度计的数据。

gyro_xyz = [gyro_x,gyro_y,gyro_z]
acc_xyz = [acc_x,acc_y,acc_z]

有一个Python上的Majwick过滤器的实现。马奇威克过滤器 我创建一个对象。

angles = MadgwickAHRS()

我把数据推到对象里

angles.update_imu(gyro_xyz,acc_xyz)

接下来是什么?如果我需要获得沿 X、Y 和 Z 轴的角度(度数),请解释如何在 Python 脚本中使用 Medjwick 过滤器。

filter accelerometer gyroscope
1个回答
0
投票

你可以通过使用Quaternion类方法将四元组转换为欧拉角。to_euler_angles()

rpy = angles.quaternion.to_euler_angles()
print("rpy: ", rpy)

希望能回答你的问题

© www.soinside.com 2019 - 2024. All rights reserved.