HSR smach states sample for open source simulator https://github.com/hsr-project run $ rosrun smach_sample remove_object.py #once delete all objects $ rosrun smach_sample smach_sample.py This program repeats five times getting an object (apple) from the shelf and coming back.