created a curvature.cpp

Question 4 initial commit. Tomas can you take a look at this code and try it.