Integrating Social forces model for obstacles

[maxspahn]

Especially in planar cases (mobile robots, cars), it is very useful to have a more involved model of moving obstacles.
Therefore, the integration of a social forces model would be beneficial. An implementation as suggested in https://github.com/yuxiang-gao/PySocialForce/tree/dev seems relatively simple to add.