Subversion Repositories FlightCtrl

Rev

Rev 1478 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1478 Rev 1568
Line 266... Line 266...
266
    Poti1 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110;
266
    Poti1 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI1]] + 110;
267
    Poti2 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110;
267
    Poti2 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI2]] + 110;
268
    Poti3 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110;
268
    Poti3 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI3]] + 110;
269
    Poti4 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110;
269
    Poti4 = PPM_in[EE_Parameter.Kanalbelegung[K_POTI4]] + 110;
270
    SenderOkay = 100;
270
    SenderOkay = 100;
271
    if(ServoActive)
-
 
272
         {
271
         {
273
                HEF4017R_ON;
272
                HEF4017R_ON;
274
                DDRD  |=0x80; // enable J7 -> Servo signal
273
                DDRD  |=0x80; // enable J7 -> Servo signal
275
     }
274
     }
276
}
275
}
Line 485... Line 484...
485
/*    DebugOut.Analog[12] = Motor[0];
484
/*    DebugOut.Analog[12] = Motor[0];
486
    DebugOut.Analog[13] = Motor[1];
485
    DebugOut.Analog[13] = Motor[1];
487
    DebugOut.Analog[14] = Motor[3];
486
    DebugOut.Analog[14] = Motor[3];
488
    DebugOut.Analog[15] = Motor[2];*/
487
    DebugOut.Analog[15] = Motor[2];*/
Line -... Line 488...
-
 
488
 
489
 
489
#if USE_SERVOBOARD
490
    //Start I2C Interrupt Mode
490
    //Start I2C Interrupt Mode
491
    twi_state = 0;
491
    twi_state = 0;
492
    motor = 0;
492
    motor = 0;
-
 
493
    i2c_start();
493
    i2c_start();
494
#endif
Line 494... Line 495...
494
}
495
}
Line 650... Line 651...
650
                               ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
651
                               ReadParameterSet(GetActiveParamSetNumber(), (unsigned char *) &EE_Parameter.Kanalbelegung[0], STRUCT_PARAM_LAENGE);
651
                           if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG))  // Höhenregelung aktiviert?
652
                           if((EE_Parameter.GlobalConfig & CFG_HOEHENREGELUNG))  // Höhenregelung aktiviert?
652
                            {
653
                            {
653
                             if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset();
654
                             if((MessLuftdruck > 950) || (MessLuftdruck < 750)) SucheLuftruckOffset();
654
                            }
655
                            }
655
                                                   ServoActive = 0;
-
 
656
                           SetNeutral();
656
                           SetNeutral();
657
                                                   ServoActive = 1;
-
 
658
                                                   DDRD  |=0x80; // enable J7 -> Servo signal
657
                                                   DDRD  |=0x80; // enable J7 -> Servo signal
659
                           Piep(GetActiveParamSetNumber(),120);
658
                           Piep(GetActiveParamSetNumber(),120);
660
                         }
659
                         }
661
                        }
660
                        }
662
                    }
661
                    }