fixed tests
not implemented for mimic joints (yet)
fixing the way mimic joints are updated
Merge branch 'groovy-devel' of git://github.com/ros-planning/moveit_core into groovy-devel
merge vertices when possible
minor fix