Removed forward angle and lateral error because we don't have a reliable way to calculate it when driving.  Also since side sensors are saturating put in check to only use farther sensor reading.