/// Get a linear-interpolated Pose between this and another // (useful ingredient for smooth animations, estimations, etc.) Pose lerp(Pose& target, double amt) const { Pose r(*this); r.pos().lerp(target.pos(), amt); r.quat().slerpTo(target.quat(), amt); return r; }