TO DO: test obstacles and tracking