Navigator: Fix pause mode to not continue to next waypoint if already set
Navigator: Fix pause mode to not continue to next waypoint if already set

mje-nz/PX4-Firmware,acfloria/Firmware,mcgill-robotics/Firmware,mcgill-robotics/Firmware,krbeverx/Firmware,Aerotenna/Firmware,Aerotenna/Firmware,jlecoeur/Firmware,jlecoeur/Firmware,mcgill-robotics/Firmware,jlecoeur/Firmware,acfloria/Firmware,acfloria/Firmware,dagar/Firmware,Aerotenna/Firmware,dagar/Firmware,jlecoeur/Firmware,krbeverx/Firmware,krbeverx/Firmware,krbeverx/Firmware,acfloria/Firmware,mje-nz/PX4-Firmware,mje-nz/PX4-Firmware,PX4/Firmware,PX4/Firmware,mje-nz/PX4-Firmware,jlecoeur/Firmware,acfloria/Firmware,mje-nz/PX4-Firmware,mje-nz/PX4-Firmware,PX4/Firmware,dagar/Firmware,Aerotenna/Firmware,krbeverx/Firmware,mcgill-robotics/Firmware,krbeverx/Firmware,PX4/Firmware,mcgill-robotics/Firmware,PX4/Firmware,dagar/Firmware,krbeverx/Firmware,acfloria/Firmware,mje-nz/PX4-Firmware,PX4/Firmware,jlecoeur/Firmware,mcgill-robotics/Firmware,PX4/Firmware,dagar/Firmware,Aerotenna/Firmware,Aerotenna/Firmware,mcgill-robotics/Firmware,acfloria/Firmware,dagar/Firmware,jlecoeur/Firmware,Aerotenna/Firmware,jlecoeur/Firmware,dagar/Firmware