Output obstacle information relative to the robot

* Add a theta field to structures.