Discontinuity in device orientation

Question

Why is there a discontinuity in the quaternion representation of my device orientation?

I'm using a SENtral+PNI RM3100+ST LSM330 to track orientation. I performed the following test:

Place the device in the center of a horizontal rotating plate ("lazy susan").
Pause for a few seconds.
Rotate the plate 360° clockwise.
Pause for a few seconds.
Rotate the plate 360° clockwise again.

I got this output, which appears discontinuous at sample #1288-1289.

Sample #1288 has (Qx,Qy,Qz,Qw) = (0.5837, 0.8038, 0.0931, 0.0675), but sample #1289 has (Qx,Qy,Qz,Qw) = (0.7079, -0.6969, -0.0807, 0.0818).

Plugging in the formulas on page 32 of this document, this corresponds to a change in orientation from (Heading, Pitch, Roll) = (108°, 0°, 142°) to (Heading, Pitch, Roll) = (-89°, 0°, 83°).

The graph of (Heading, Pitch, Roll) is also not continuous mod 90°.

Does this output make sense? I did not expect a discontinuity in the first plot, since the unit quaternions are a covering space of SO(3). Is there a hardware problem, or am I interpreting the data incorrectly?

Edit: The sensor code is in central.c and main.c. It is read with this Python script.

What is the repeatability of this? Once per power up? Always at the same time or position? — hauptmech, Dec 10 '15 at 10:17
It seems 100% repeatable once per powerup. The glitch always happens for the first few seconds. — tba, Dec 19 '15 at 19:46
Your code suggests that the problem is within the sensor. Why is Quat_x bouncing from negative to positive slope in that sample? Also, your code is doing a lot of big-endian to little-endian conversion that would be better left to a built-in function or even a macro. — Ian, Dec 21 '15 at 11:18

score 1 · Accepted Answer · answered Dec 10 '15 at 17:04

Something's not right, either with your test, your conversion, or with the device itself. If you look at your graph of heading, pitch, and roll, you can see that heading rotates through 360 degrees, which is expected, but roll changes almost 180 degrees in one direction, then 180 degrees back. If your device is loose and rolling around on the turntable then maybe that's correct, but otherwise you've got something else going on.

Can you provide your initialization code? Notice that you can't just power-on this device an use it - from page 16 of the manual:

Note: It is necessary to set the MagRate, AccelRate, AND GyroRate registers to non-zero values for the SENtral algorithm to function properly and to obtain reliable orientation and scaled sensor data. If a [Sensor]Rate register is left as 0x00 after power-up, or is changed to 0x00, this effectively disablesthat sensor within the SENtral algorithm. Also, the CalStatus, MagTransient, and AlgorithmSlow bits become undefined.

Are you getting any errors? Page 17, step (d) states you are to read the event register and then process the bits in the priority order specified in Figure 4-3 (at the top of that page), which means you are to check and act on an error bit before checking the sensor data available bits.

Finally, Can you provide your sensor read code? Your sample data with the discontinuity shows values in the range of -1 to 1, but Page 19 clearly states that Full Scale Output for the quaternions are 0-1, or $\pm \pi$. All of your data appears to be bounded at +1 on the high end, which makes me believe that you are not operating at the $\pm \pi$ band, so maybe you are reconstructing the bytes incorrectly upon receipt.

Thanks for your answer. The sensor code is in these two files: http://pastebin.com/raw/sT2F7f5g and http://pastebin.com/raw/qu8RFx4z . It is read with this python script: http://pastebin.com/raw/7QXJ00cq . Do you see anything clearly wrong? — tba, Dec 19 '15 at 19:44

score 0 · Answer 2 · answered Dec 10 '15 at 07:58

You are right, the quaternion should be without discontinuities.

It could be a bad implementation of your algorithm, but I believe your discontinuity may come from the magnetometer in your setup. Magnetometers have to be calibrated properly in order to map the magnetic field reading to an orientation. If it is not, it can lead to effects where small changes in the actual orientation of the device lead to large changes in the interpretation of the orientation from the magnetic reading.

score -1 · Answer 3 · answered Dec 09 '15 at 22:33

-1

yaw has a range of +/- 180 degrees. There is going to be a discontinuity when you reach that limit.

answered Dec 09 '15 at 22:33

holmeski

1,853
13
18

My question is about the quaternion output, which does not have a reason for discontinuity. In addition, the graph of (Heading, Pitch, Roll) is not even continuous mod 90°. – tba Dec 10 '15 at 01:37

Discontinuity in device orientation

3 Answers3