fix unit test
add IsDOFRevolute/Prismatic
Merge branch 'production' of https://github.com/rdiankov/openrave into cuong
Pretty advanced stage of Mergewaypoints