fixed compile error, was caused by a mixup of old and new gazebo
test now included