Subversion Repositories FlightCtrl

Rev

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

Rev 1254 Rev 1268
Line 115... Line 115...
115
   else Piep(WinkelOut.CalcState,150);
115
   else Piep(WinkelOut.CalcState,150);
116
  }
116
  }
117
  DebugOut.Analog[19] = WinkelOut.CalcState;
117
  DebugOut.Analog[19] = WinkelOut.CalcState;
118
}
118
}
Line -... Line 119...
-
 
119
 
-
 
120
void LipoDetection(unsigned char print)
-
 
121
{
-
 
122
   unsigned int timer;
-
 
123
   if(print) printf("\n\rBatt:");
-
 
124
   if(EE_Parameter.UnterspannungsWarnung < 50) // automatische Zellenerkennung
-
 
125
    {
-
 
126
         timer = SetDelay(500);
-
 
127
         if(print) while (!CheckDelay(timer));
-
 
128
         if(UBat < 130)
-
 
129
          {
-
 
130
           BattLowVoltageWarning = 3 * EE_Parameter.UnterspannungsWarnung;
-
 
131
           if(print)
-
 
132
            {
-
 
133
                 Piep(3,200);
-
 
134
             printf(" 3 Cells  ");
-
 
135
                }
-
 
136
          }
-
 
137
         else
-
 
138
          {
-
 
139
           BattLowVoltageWarning = 4 * EE_Parameter.UnterspannungsWarnung;
-
 
140
           if(print)
-
 
141
            {
-
 
142
                 Piep(4,200);
-
 
143
             printf(" 4 Cells  ");
-
 
144
                }
-
 
145
          }
-
 
146
    }
-
 
147
    else BattLowVoltageWarning = EE_Parameter.UnterspannungsWarnung;
-
 
148
   if(print) printf(" Low warning level: %d.%d",BattLowVoltageWarning/10,BattLowVoltageWarning%10);
-
 
149
}
119
 
150
 
120
//############################################################################
151
//############################################################################
121
//Hauptprogramm
152
//Hauptprogramm
122
int main (void)
153
int main (void)
123
//############################################################################
154
//############################################################################
Line 289... Line 320...
289
        else printf("Normal (ACC-Mode)");
320
        else printf("Normal (ACC-Mode)");
Line 290... Line 321...
290
 
321
 
291
    LcdClear();
322
    LcdClear();
292
    I2CTimeout = 5000;
323
    I2CTimeout = 5000;
293
    WinkelOut.Orientation = 1;
-
 
294
 
-
 
295
   printf("\n\rBatt:");
-
 
296
   if(EE_Parameter.UnterspannungsWarnung < 50) // automatische Zellenerkennung
-
 
297
    {
-
 
298
         timer = SetDelay(500);
-
 
299
         while (!CheckDelay(timer));
-
 
300
         if(UBat < 130)
-
 
301
          {
-
 
302
           BattLowVoltageWarning = 3 * EE_Parameter.UnterspannungsWarnung;
324
    WinkelOut.Orientation = 1;
303
           Piep(3,200);
-
 
304
           printf(" 3 Cells  ");
-
 
305
          }
-
 
306
         else
-
 
307
          {
-
 
308
           BattLowVoltageWarning = 4 * EE_Parameter.UnterspannungsWarnung;
-
 
309
           Piep(4,200);
-
 
310
           printf(" 4 Cells  ");
-
 
311
          }
-
 
312
    }
-
 
313
    else BattLowVoltageWarning = EE_Parameter.UnterspannungsWarnung;
-
 
314
    printf(" Low warning level: %d.%d",BattLowVoltageWarning/10,BattLowVoltageWarning%10);
325
    LipoDetection(1);
315
        printf("\n\r===================================\n\r");
326
        printf("\n\r===================================\n\r");
316
        while (1)
327
        while (1)
317
        {
328
        {
318
            if(UpdateMotor && AdReady)      // ReglerIntervall
329
            if(UpdateMotor && AdReady)      // ReglerIntervall