TO DO: test obstacles sim