SubT - wrong initial orientation of Marsupial robots

[m3d]

The Marsupial robots are special because they are oriented backwards:

This info is available in origin message but OSGAR ignores that:

drone:
0:00:05.992755 38 [b'B100W', -6.410452, 5.000274, 0.807016, -0.005923, -1.8e-05, 0.999982, -2.4e-05]
0:00:06.092203 38 [b'B100W', -6.410452, 5.000274, 0.807016, -0.005923, -1.8e-05, 0.999982, -2.4e-05]

R2:
0:00:05.708154 44 [b'A60R', -6.003202, 5.000313, 0.397469, 0.0, -0.006077, 2.8e-05, 0.999982]
0:00:05.841033 44 [b'A60R', -6.003202, 5.000313, 0.397469, 0.0, -0.006077, 2.8e-05, 0.999982]

For example see ver92exp3cp2 (12ca902c-83fb-46c8-9c20-5500dc9cbeb1)

Note, that IMU integrates direction from (0, 0, 0).