Added a little tool to visualize orientations with a posestamped in rviz