Writing high level controllers for ROS in Indigolog