pub fn extract_jacobian_and_result<T: Scalar + Zero + Float, const DIM_IN: usize, const DIM_OUT: usize, const DIM_HYPER: usize>(
    fx_dual: &SVector<DualN<T, DIM_HYPER>, DIM_OUT>
) -> (SVector<T, DIM_OUT>, SMatrix<T, DIM_OUT, DIM_IN>)