disabled debug mode
Merged changes from ik_fast repo, made compatible with new moveit version