Computation of localization error from geometry_msgs/PoseStamped.