Example #1
0
bool TrivialDetector::compute_centroid_sensor(DataFrame& frame, cv::Mat sensor_silhouette, Vector3& retval)
{
    Vector3 tot(0,0,0);
    int count = 0;
    for(int row=0; row<sensor_silhouette.rows; row++){
        for(int col=0; col<sensor_silhouette.cols; col++){
            if(sensor_silhouette.at<uchar>(row,col)<125)
                continue;
            Vector3 p_sensor = frame.point_at_pixel(col,row,camera);
            tot += p_sensor;
            count++;
        }
    }

    if(count==0){
        retval = Vector3(0,0,0);
        return false;
    } else {
        retval = tot / count;
        return true;
    }
}