Ensure that all rotation angles are in the range [-pi, pi].
Also return orientation of marker.
Publish orientation in ros.