smach_ros: Adding rostests to cmakelists