started path verification code
Added curvature for TODO comparison
Merge pull request #47 from JimHokanson/master

Working on path feature comparison