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; } }