Function homogeneous_moved 

pub fn homogeneous_moved<S: Homogeneous>(
    space: &S,
    pose: &Pose<S>,
    to: S::Point,
) -> Result<Pose<S>, DomainError>