wrote debug code to show normals for all triangles
made some small changes to debug modes
modularized min length parameter
got yaw,pitch,roll and x,y data recorded in text file successfully