solution is now solved once for each ref. point
new tf
extended grasp test script
changed sss.move_planned to lower tolerance
Merge branch 'master' of github.com:ipa-fmw-ws/cob_command_tools