Finished getCurvature(), added visualization