added quadratic interpolation to check path constraints
Merge branch 'cuong' of https://github.com/rdiankov/openrave into cuong