Added rest of the PID controllers.  Fixed bug in controller selection.  Kindof works with very minimal tuning, but that's what the EA algorithm is for.