@@ -535,16 +535,17 @@ namespace pcl
535535 std::vector<pcl::Vertices>& triangleMesh)
536536 {
537537 double area = 0 ;
538+ pcl::PointCloud<PointT>& cl = (*cloud);
538539 for (auto & triangle_ : triangleMesh) {
539540 if (triangle_.vertices .size () == 3 ) {
540541 const Eigen::Matrix<double , 3 , 1 > P (
541- (*cloud) [triangle_.vertices [0 ]].x - (*cloud)[triangle_.vertices [2 ]].x ,
542- (*cloud) [triangle_.vertices [0 ]].y - (*cloud)[triangle_.vertices [2 ]].y ,
543- (*cloud) [triangle_.vertices [0 ]].z - (*cloud)[triangle_.vertices [2 ]].z );
542+ cl [triangle_.vertices [0 ]].x - (*cloud)[triangle_.vertices [2 ]].x ,
543+ cl [triangle_.vertices [0 ]].y - (*cloud)[triangle_.vertices [2 ]].y ,
544+ cl [triangle_.vertices [0 ]].z - (*cloud)[triangle_.vertices [2 ]].z );
544545 const Eigen::Matrix<double , 3 , 1 > Q (
545- (*cloud) [triangle_.vertices [1 ]].x - (*cloud)[triangle_.vertices [2 ]].x ,
546- (*cloud) [triangle_.vertices [1 ]].y - (*cloud)[triangle_.vertices [2 ]].y ,
547- (*cloud) [triangle_.vertices [1 ]].z - (*cloud)[triangle_.vertices [2 ]].z );
546+ cl [triangle_.vertices [1 ]].x - (*cloud)[triangle_.vertices [2 ]].x ,
547+ cl [triangle_.vertices [1 ]].y - (*cloud)[triangle_.vertices [2 ]].y ,
548+ cl [triangle_.vertices [1 ]].z - (*cloud)[triangle_.vertices [2 ]].z );
548549 area += 0.5 * P.cross (Q).norm ();
549550 }
550551 }
0 commit comments