Added option to save quaternion orientation vector when saving the
localization and ground truth poses.