Page 360 - 2
P. 360

#endif
                  case 4:
                    taskOrder=0;
                    #if SONAR
                      Sonar_update(); //debug[2] = sonarAlt;
                    #endif
                    #ifdef LANDING_LIGHTS_DDR
                      auto_switch_landing_lights();
                    #endif
                    #ifdef VARIOMETER
                      if (f.VARIO_MODE) vario_signaling();
                    #endif
                    break;
                }
              }


              while(1) {
                currentTime = micros();
                cycleTime = currentTime - previousTime;
                #if defined(LOOP_TIME)
                  if (cycleTime >= LOOP_TIME) break;
                #else
                  break;
                #endif
              }
              previousTime = currentTime;


              computeIMU();


              //***********************************
              //**** Experimental FlightModes *****
              //***********************************
              #if defined(ACROTRAINER_MODE)
              if(f.ANGLE_MODE){
                if (abs(rcCommand[ROLL]) + abs(rcCommand[PITCH]) >= ACROTRAINER_MODE ) {
                  f.ANGLE_MODE=0;
                  f.HORIZON_MODE=0;
                  f.MAG_MODE=0;
                  f.BARO_MODE=0;
                  GPS_mode = GPS_MODE_NONE;
                  }
                }
              #endif


              //***********************************


                                                         - 360 -
   355   356   357   358   359   360   361   362   363   364   365