Added static obstacles to the simulation:
- New classes and geometry functions,
- Specification in XML files,
- Updated time-to-collision computations to consider obstacles as well,
- Updated as many cost functions as possible.
Some cost functions do not yet support obstacles, and they have been marked as such with a warning in the (Doxygen) documentation. I will make separate issues for this.