Subversion Repositories FlightCtrl

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
1 ingob 1
#include "main.h"
2
 
3
volatile unsigned int CountMilliseconds = 0;
4
volatile static unsigned int tim_main;
5
volatile unsigned char UpdateMotor = 0;
6
volatile unsigned int cntKompass = 0;
7
volatile unsigned int beeptime = 0;
723 hbuss 8
volatile unsigned char SendSPI = 0;
9
 
173 holgerb 10
unsigned int BeepMuster = 0xffff;
1 ingob 11
int ServoValue = 0;
12
 
13
enum {
14
  STOP             = 0,
15
  CK               = 1,
16
  CK8              = 2,
17
  CK64             = 3,
18
  CK256            = 4,
19
  CK1024           = 5,
20
  T0_FALLING_EDGE  = 6,
21
  T0_RISING_EDGE   = 7
22
};
23
 
24
 
25
SIGNAL (SIG_OVERFLOW0)    // 8kHz
26
{
27
    static unsigned char cnt_1ms = 1,cnt = 0;
173 holgerb 28
    unsigned char pieper_ein = 0;
1 ingob 29
//    TCNT0 -= 250;//TIMER_RELOAD_VALUE;
723 hbuss 30
   if(SendSPI) SendSPI--;
1 ingob 31
   if(!cnt--)
32
    {
33
     cnt = 9;
34
     cnt_1ms++;
35
     cnt_1ms %= 2;
36
     if(!cnt_1ms) UpdateMotor = 1;
37
     CountMilliseconds++;
723 hbuss 38
    }  
1 ingob 39
 
40
     if(beeptime > 1)
41
        {
173 holgerb 42
        beeptime--;      
43
        if(beeptime & BeepMuster)
44
         {
45
          pieper_ein = 1;
46
         }
47
         else pieper_ein = 0;
1 ingob 48
        }
173 holgerb 49
     else
50
      {
51
       pieper_ein = 0;
52
       BeepMuster = 0xffff;
53
      }
54
 
55
 
56
     if(pieper_ein)
57
        {
58
          if(PlatinenVersion == 10) PORTD |= (1<<2); // Speaker an PORTD.2
59
          else                      PORTC |= (1<<7); // Speaker an PORTC.7
60
        }
1 ingob 61
     else  
173 holgerb 62
        {
63
         if(PlatinenVersion == 10) PORTD &= ~(1<<2);
64
         else                      PORTC &= ~(1<<7);
65
        }
66
 
1 ingob 67
 if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
68
 {
69
  if(PINC & 0x10)
70
   {
71
    cntKompass++;
72
   }
73
  else
74
   {
849 hbuss 75
    if((cntKompass) && (cntKompass < 362))
1 ingob 76
    {
693 hbuss 77
     cntKompass += cntKompass / 41;
78
     if(cntKompass > 10) KompassValue = cntKompass - 10; else KompassValue = 0;
1 ingob 79
    }
80
//     if(cntKompass < 10) cntKompass = 10;
81
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
82
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
83
    cntKompass = 0;
84
   }
85
 }
86
}
87
 
871 hbuss 88
//----------------------------
1 ingob 89
void Timer_Init(void)
90
{
91
    tim_main = SetDelay(10);
92
    TCCR0B = CK8;
93
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
94
    OCR0A =  0;
95
    OCR0B = 120;
304 ingob 96
    TCNT0 = (unsigned char)-TIMER_RELOAD_VALUE;  // reload
1 ingob 97
    //OCR1  = 0x00;
98
 
99
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
871 hbuss 100
//    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);    // clk/256
101
    TCCR2B=(0<<CS20)|(0<<CS21)|(1<<CS22);      // clk/64
1 ingob 102
 
871 hbuss 103
 
104
  TIMSK2 |= _BV(OCIE2A);
1 ingob 105
 
106
    TIMSK0 |= _BV(TOIE0);
107
    OCR2A = 10;
108
    TCNT2 = 0;
109
 
110
}
111
 
112
// -----------------------------------------------------------------------
113
 
114
unsigned int SetDelay (unsigned int t)
115
{
116
//  TIMSK0 &= ~_BV(TOIE0);
117
  return(CountMilliseconds + t + 1);                                            
118
//  TIMSK0 |= _BV(TOIE0);
119
}
120
 
121
// -----------------------------------------------------------------------
122
char CheckDelay(unsigned int t)
123
{
124
//  TIMSK0 &= ~_BV(TOIE0);
125
  return(((t - CountMilliseconds) & 0x8000) >> 9);
126
//  TIMSK0 |= _BV(TOIE0);
127
}
128
 
129
// -----------------------------------------------------------------------
130
void Delay_ms(unsigned int w)
131
{
132
 unsigned int akt;
133
 akt = SetDelay(w);
134
 while (!CheckDelay(akt));
135
}
136
 
395 hbuss 137
void Delay_ms_Mess(unsigned int w)
138
{
139
 unsigned int akt;
140
 akt = SetDelay(w);
141
 while (!CheckDelay(akt)) ANALOG_ON;
142
}
143
 
1 ingob 144
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
145
//  Servo ansteuern
146
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
871 hbuss 147
SIGNAL(SIG_OVERFLOW2)
148
{
149
  PORTD |= 0x80;
150
  TCCR2A =3;
151
  TIMSK2 &= ~_BV(TOIE2);
152
}
153
 
1 ingob 154
SIGNAL(SIG_OUTPUT_COMPARE2A)
155
{
871 hbuss 156
  #define MULTIPLIER 4
157
  #define PPM_OFFSET  256  //  820us
158
  static unsigned int timer = 10 * MULTIPLIER;
1 ingob 159
 
871 hbuss 160
  if(timer == 3)  
161
    {
162
     ServoValue = PPM_OFFSET;
163
         ServoValue +=  (int) Parameter_ServoNickControl * 2;
164
 
165
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) (EE_Parameter.ServoNickComp * IntegralNick) / 128 )/ (512/MULTIPLIER);
166
     else ServoValue -= ((long) (EE_Parameter.ServoNickComp * IntegralNick) / 128) / (512/MULTIPLIER);
167
 
168
     if((ServoValue) < ((int)EE_Parameter.ServoNickMin*MULTIPLIER)) ServoValue = (int)EE_Parameter.ServoNickMin*MULTIPLIER;
169
     else if((ServoValue) > ((int)EE_Parameter.ServoNickMax*MULTIPLIER)) ServoValue = (int)EE_Parameter.ServoNickMax*MULTIPLIER;
170
 
171
ServoValue = 500;
172
         DebugOut.Analog[23] = ServoValue;
173
 
174
         TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
175
         OCR2A = ServoValue % 256;
176
         TIMSK2 |= _BV(TOIE2);
177
    }
178
  else if (timer < 3)
179
    {
180
 
181
          if (ServoValue > 255)
182
          { PORTD |= 0x80;
183
                TCCR2A =3;
184
                ServoValue -= 255;
185
          }
186
          else
187
      {
188
            TCCR2A =3;
189
        PORTD&=~0x80;
190
                OCR2A = 0xff;
191
      }
192
 
193
          if (timer == 0) timer = (int) EE_Parameter.ServoNickRefresh * MULTIPLIER;
194
    }
195
 
196
 
197
  timer--;
198
 
199
/*  static unsigned char timer = 10;
200
 
1 ingob 201
  if(!timer--)  
202
    {
203
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
204
     ServoValue =  Parameter_ServoNickControl;
205
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
206
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
207
 
208
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
209
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
210
 
211
     OCR2A = ServoValue;// + 75;
212
     timer = EE_Parameter.ServoNickRefresh;
213
    }
214
    else
215
    {
216
     TCCR2A =3;
217
     PORTD&=~0x80;
871 hbuss 218
    } */
219
 
1 ingob 220
}