diff --git a/script.py b/script.py index cf7b67c..2c74727 100644 --- a/script.py +++ b/script.py @@ -113,7 +113,9 @@ def main(): # Rotate body accelerations to Earth frame acc = [] for x,y,z,q in zip(accX,accY,accZ,quat): - acc.append(q_rot(np.array([x, y, z]), q_conj(q))) + #print(q_conj(q)) + acc.append(q_rot(q_conj(q), np.array([x, y, z]))) + acc = np.array(acc) acc = acc - np.array([0,0,1]) acc = acc * 9.81 diff --git a/ximu_python_library/__pycache__/CalInertialAndMagneticDataClass.cpython-37.pyc b/ximu_python_library/__pycache__/CalInertialAndMagneticDataClass.cpython-37.pyc deleted file mode 100644 index 60c22d2..0000000 Binary files a/ximu_python_library/__pycache__/CalInertialAndMagneticDataClass.cpython-37.pyc and /dev/null differ diff --git a/ximu_python_library/__pycache__/xIMUdataClass.cpython-37.pyc b/ximu_python_library/__pycache__/xIMUdataClass.cpython-37.pyc deleted file mode 100644 index fbef5cf..0000000 Binary files a/ximu_python_library/__pycache__/xIMUdataClass.cpython-37.pyc and /dev/null differ