Draft: Implement basic version of human group obstacle.

Tobias Grögerrequested to merge
feature/human-group-obsacle into dev

Basic implementation of HumanGroup as PolygonObstacle for teb.

Edited by Tobias Gröger

Merge request reports