Subversion Repositories FlightCtrl

Rev

Rev 2439 | Rev 2447 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 2439 Rev 2443
Line 672... Line 672...
672
 CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100);
672
 CHK_POTI_MM(Parameter_Hoehe_P,EE_Parameter.Hoehe_P,0,100);
673
 CHK_POTI_MM(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255);
673
 CHK_POTI_MM(Parameter_Gyro_P,EE_Parameter.Gyro_P,10,255);
674
 CHK_POTI_MM(Parameter_J16Timing,EE_Parameter.J16Timing,5,255);
674
 CHK_POTI_MM(Parameter_J16Timing,EE_Parameter.J16Timing,5,255);
675
 CHK_POTI_MM(Parameter_J17Timing,EE_Parameter.J17Timing,5,255);
675
 CHK_POTI_MM(Parameter_J17Timing,EE_Parameter.J17Timing,5,255);
Line 676... Line 676...
676
 
676
 
677
 if(EE_Parameter.Servo3 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo3 = 140; else Parameter_Servo3 = 70;}       // Out1 (J16)
677
 if(EE_Parameter.Servo3 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo3 = EE_Parameter.Servo3OnValue; else Parameter_Servo3 = EE_Parameter.Servo3OffValue;}       // Out1 (J16)
678
 else if(EE_Parameter.Servo3 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo3 = 140; else Parameter_Servo3 = 70;}
678
 else if(EE_Parameter.Servo3 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo3 = EE_Parameter.Servo3OnValue; else Parameter_Servo3 = EE_Parameter.Servo3OffValue;}
Line 679... Line 679...
679
 else CHK_POTI_MM(Parameter_Servo3,EE_Parameter.Servo3, 24, 255);
679
 else CHK_POTI_MM(Parameter_Servo3,EE_Parameter.Servo3, 24, 255);
680
 
680
 
681
 if(EE_Parameter.Servo4 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo4 = 140; else Parameter_Servo4 = 70;}
681
 if(EE_Parameter.Servo4 == 247) { if(PORTC & (1<<PORTC2)) Parameter_Servo4 = EE_Parameter.Servo4OnValue; else Parameter_Servo4 = EE_Parameter.Servo4OffValue;}
Line 682... Line 682...
682
 else if(EE_Parameter.Servo4 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo4 = 140; else Parameter_Servo4 = 70;}  // Out2 (J17)
682
 else if(EE_Parameter.Servo4 == 246) { if(PORTC & (1<<PORTC3)) Parameter_Servo4 = EE_Parameter.Servo4OnValue; else Parameter_Servo4 = EE_Parameter.Servo4OffValue;}  // Out2 (J17)
683
 else CHK_POTI_MM(Parameter_Servo4,EE_Parameter.Servo4, 24, 255);
683
 else CHK_POTI_MM(Parameter_Servo4,EE_Parameter.Servo4, 24, 255);
684
 
684
 
Line 2251... Line 2251...
2251
                            if(EE_Parameter.MotorSmooth == 0)
2251
                            if(EE_Parameter.MotorSmooth == 0)
2252
                                {
2252
                                {
2253
                                  tmp_int = 2 * tmp_int - tmp_motorwert[i];  // original MotorSmoothing
2253
                                  tmp_int = 2 * tmp_int - tmp_motorwert[i];  // original MotorSmoothing
2254
                                }
2254
                                }
2255
                                                        else  // 1 means tmp_int = tmp_int;
2255
                                                        else  // 1 means tmp_int = tmp_int;
2256
                            if(EE_Parameter.MotorSmooth > 1)
2256
                            if(EE_Parameter.MotorSmooth > 1)
2257
                                {
2257
                                {
2258
                                  // If >= 2 then allow >= 50% of the intended step down to rapidly reach the intended value.
2258
                                  // If >= 2 then allow >= 50% of the intended step down to rapidly reach the intended value.
2259
                                  tmp_int = tmp_int + ((tmp_motorwert[i] - tmp_int) / EE_Parameter.MotorSmooth);
2259
                                  tmp_int = tmp_int + ((tmp_motorwert[i] - tmp_int) / EE_Parameter.MotorSmooth);
2260
                                }
2260
                                }
2261
                        }
2261
                        }