Defined in File pose2.hpp
Get distance to identity pose in position and angle.
K – Scalar type.
pose – Pose to measure.
Vector where first element is position magnitude, second is angle magnitude.