attempt to use curvature instead of radius
turn using curvature or radius into a running time flag
break the big cpp file into multiple files
fixed segfault issue