TO DO: test tracking among obstacles