Changeset 64 in pacpussensors for trunk/StereoVisionDisparity/ObstacleDetectionComponent.cpp

Timestamp:

Sep 4, 2014, 11:19:05 AM (10 years ago)

Author:

phudelai

Message:

Programme détection d'obstacles amélioré

File:

• trunk/StereoVisionDisparity/ObstacleDetectionComponent.cpp (modified) (3 diffs)

trunk/StereoVisionDisparity/ObstacleDetectionComponent.cpp

@@ -504 +504 @@
                                 cv::waitKey(1);
                         }
-
+                
                         // Remap the v-disparity point in the original image and create binary masks
                         //std::pair<cv::Mat, cv::Mat> masks = this->MaskSurface2(Disp_map, color_v_disp_map1, color_uv_disp_map.first, this->min_disp, this->max_disp, 1);
@@ -599 +599 @@
                                 cv::imshow("ObstacleDetectionComponent - Final Classification", reference);
                         }
+
                         //---------------------------------------------------------------------------
 
@@ -622 +623 @@
                 cvDestroyAllWindows();
 }
+
+/*      PointTriangulate
+Description:
+Calculate the point triangulation in the world
+Parameters:
+row,col = row and column in the image
+x,y,z = world coordinates
+disparity = disparity value
+
+bool ObstacleDetectionComponent::PointTriangulate(int row, int col, double &x, double &y, double &z, double disparity)
+{
+                bool valid_point = false;
+
+        if(disparity > 0.0 && disparity < 255.0)
+        {
+                z = this->cam_width * this->cam_fx * this->cam_baseline / disparity;
+                double u = col / (this->cam_width - 1.0) - this->cam_cx;
+                double v = row / (this->cam_height - 1.0) - this->cam_cy;
+
+                x = u * z / this->cam_fx;
+
+                y = v * z / this->cam_fy;
+
+                valid_point = true;
+        }
+
+        return valid_point;
+}*/
+
 
 // Function to calculate the U/V disparity map