Calculate polygon area

Code reformatted according pcl standards