GroundPlaneEstimator.cpp解读

GroundPlaneEstimator域下的compute函数,就相当于整个cpp的主函数,也体现了整个调用过程,先执行compute_v_disparity_data,再compute_v_disparity_image,最后estimate_ground_plane

void GroundPlaneEstimator::compute()
{
    static int num_iterations = ;
    static double cumulated_time = ;

    const int num_iterations_for_timing = ;
    const double start_wall_time = omp_get_wtime();

    compute_v_disparity_data();
    compute_v_disparity_image();
    estimate_ground_plane();

    // timing ---
    cumulated_time += omp_get_wtime() - start_wall_time;
    num_iterations += ;

    if((num_iterations % num_iterations_for_timing) == )
    {
        printf("Average GroundPlaneEstimator::compute speed  %.2lf [Hz] (in the last %i iterations)\n",
               num_iterations_for_timing / cumulated_time, num_iterations_for_timing );
        cumulated_time = ;
    }

    return;
}