Added flow navigation & throttle batt compensation

NEEDS WORK. FALLS WHEN SONAR MODE ACTIVATED.