@@ -535,16 +535,17 @@ namespace pcl
535
535
std::vector<pcl::Vertices>& triangleMesh)
536
536
{
537
537
double area = 0 ;
538
+ pcl::PointCloud<PointT>& cl = (*cloud);
538
539
for (auto & triangle_ : triangleMesh) {
539
540
if (triangle_.vertices .size () == 3 ) {
540
541
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 );
544
545
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 );
548
549
area += 0.5 * P.cross (Q).norm ();
549
550
}
550
551
}
0 commit comments