Compute Planarity of a 3D point using approach 1.

planarity.cpp

double PointCloud::computePlanarity(int pointIndex) {
	PointCloud p;
	p.points.push_back(points[pointIndex]);
	for (int i = 0; i < (int)points.size(); i++) {
		if(i != pointIndex && points[i].distanceTo(points[pointIndex]) <= MaxEPS) {
			p.points.push_back(points[i]);
		}
	}
	
	Plane plane = p.bestFittingPlane();
	double dist = 0;
	for (int i = 0; i < (int)p.points.size(); i++)
		dist += p.points[i].distanceTo(plane);
	dist /= p.points.size();
	
	return dist;
}