Potential Fields

[stevenwaslander]

Coordinate with other planner methods to use common environments and environment generators. Make functions of potential and gradient calculations, and define controllers to use gradient to drive common robots.