Subversion Repositories Projects

Rev

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

Rev 297 Rev 303
Line 15... Line 15...
15
#include "ubx.h"
15
#include "ubx.h"
16
#include "button.h"
16
#include "button.h"
Line 17... Line 17...
17
 
17
 
18
#ifdef USE_FOLLOWME
18
#ifdef USE_FOLLOWME
-
 
19
int16_t UBat = 120;
-
 
20
int16_t Zellenzahl = 0;
-
 
21
int16_t PowerOn = 0;
-
 
22
int16_t i = 0;
19
int16_t UBat = 120;
23
int16_t delay = 0;
Line 20... Line 24...
20
#endif
24
#endif
Line 65... Line 69...
65
        printf("\r\n------------------------------");
69
        printf("\r\n------------------------------");
66
        printf("\r\n");
70
        printf("\r\n");
Line 67... Line 71...
67
 
71
 
68
 
72
 
69
        #ifdef USE_FOLLOWME
73
        #ifdef USE_FOLLOWME
Line 70... Line 74...
70
        BeepTime = 2000;
74
        //BeepTime = 2000;
Line 71... Line 75...
71
        #endif
75
        #endif
72
 
76
 
73
    LCD_Clear();
77
    LCD_Clear();
74
 
78
 
75
        GPS_Timer = SetDelay(1000);
79
        GPS_Timer = SetDelay(1000);
76
        while (1)
80
        while (1)
77
        {
81
        {
78
                // check for button action
82
                // check for button action
Line 79... Line 83...
79
                if(GetButton())
83
                if(GetButton())
Line 80... Line 84...
80
                {
84
                {
Line 101... Line 105...
101
                        // because of the silicon diode inbetween.
105
                        // because of the silicon diode inbetween.
102
                        // voltage divider R2=10K, R3=3K9
106
                        // voltage divider R2=10K, R3=3K9
103
                        // UAdc4 = R3/(R3+R2)*UBat= 3.9/(3.9+10)*UBat = UBat/3.564
107
                        // UAdc4 = R3/(R3+R2)*UBat= 3.9/(3.9+10)*UBat = UBat/3.564
104
                        UBat = (3 * UBat + (64 * Adc4) / 368) / 4;
108
                        UBat = (3 * UBat + (64 * Adc4) / 368) / 4;
105
                        DebugOut.Analog[8] = UBat;
109
                        DebugOut.Analog[8] = UBat;
-
 
110
                       
-
 
111
                        // check for zellenzahl
-
 
112
                        if(PowerOn < 100)
-
 
113
                        {
-
 
114
                                if(UBat<=84) Zellenzahl = 2;
-
 
115
                                else Zellenzahl = 3;
-
 
116
                                PowerOn++;
-
 
117
                        }
-
 
118
                        DebugOut.Analog[16] = Zellenzahl;
-
 
119
                        DebugOut.Analog[17] = PowerOn;
-
 
120
                       
-
 
121
                        //show recognised Zellenzahl to user
-
 
122
                        if(i < Zellenzahl && PowerOn >= 100 && BeepTime == 0 && delay > 1000)
-
 
123
                        {
-
 
124
                                BeepTime = 100;
-
 
125
                                i++;
-
 
126
                                delay = 0;
-
 
127
                        }
-
 
128
                        if(delay < 1500) delay++;
-
 
129
                       
-
 
130
                        // monitor battery undervoltage
-
 
131
                        if(UBat < Zellenzahl * 31 && PowerOn >= 100) BeepTime = 200;
106
                        #endif
132
                        #endif
107
                        ADReady = 0;
133
                        ADReady = 0;
108
                        ADC_Enable(); // restart ad conversion sequence
134
                        ADC_Enable(); // restart ad conversion sequence
109
                }
135
                }