AP_NavEKF: Fix bug preventing opt flow scale factor estimation

Also removes un-used variable declarations
AP_NavEKF: Add public method to inhibit GPS use and clean-up GPS use logic