Check test commands

All test commands have to be guarded by "if(CATKIN_ENABLE_TESTING)",
and the appriopriate test_depends have to be specified.