Fixed the potential and improved potential controllers (but why have both?) to work with the global coordinate change.
Separated the algorithms out into their own package. The potential controllers work, the a_star one has issues still from the switch to global coords.
Move common utilities into their own package. Updated the controllers accordingly.