Added verifyinitialpath feature
Merge branch 'cuong' of https://github.com/rdiankov/openrave into cuong