madgwick_py icon indicating copy to clipboard operation
madgwick_py copied to clipboard

Quaternion Euler/Euler123 issues

Open mungewell opened this issue 6 years ago • 1 comments

Hi, Looks like there is a coding error with Euler123 output, setting different initiation and outputing without updating AHRS gives invalid data

refq = Quaternion(1,0,0,0) # look front
Euler:  (0.0, 0.0, 0.0)
Eu123:  (0.0, 0.0, 0.0)
Quat:   [1 0 0 0]

refq = Quaternion.from_angle_axis(np.pi/2,0,0,1) # look front, sideways
Euler:  (0, 1.5707963267948966, 0.0)
Eu123:  (-0.0, 0.0, 1.5707963267948963)
Quat:   [ 0.70710678  0.          0.          0.70710678]

refq = Quaternion.from_angle_axis(np.pi/2,1,0,0) # look up
Euler:  (1.5707963267948963, 0.0, 0.0)
Eu123:  (1.5707963267948963, 1.5707963267948966, -0.0)
Quat:   [ 0.70710678  0.70710678  0.          0.        ]

refq = Quaternion.from_angle_axis(np.pi/2,0,1,0) # look right
Euler:  (0.0, 0.0, 1.5707963267948963)
Eu123:  (-0.0, 0.0, -0.0)
Quat:   [ 0.70710678  0.          0.70710678  0.        ]

Also discussed here: https://github.com/RiftCat/vridge-api/issues/17

mungewell avatar Nov 13 '18 17:11 mungewell