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;
173 holgerb 8
unsigned int BeepMuster = 0xffff;
1 ingob 9
int ServoValue = 0;
10
 
11
enum {
12
  STOP             = 0,
13
  CK               = 1,
14
  CK8              = 2,
15
  CK64             = 3,
16
  CK256            = 4,
17
  CK1024           = 5,
18
  T0_FALLING_EDGE  = 6,
19
  T0_RISING_EDGE   = 7
20
};
21
 
22
 
23
SIGNAL (SIG_OVERFLOW0)    // 8kHz
24
{
25
    static unsigned char cnt_1ms = 1,cnt = 0;
173 holgerb 26
    unsigned char pieper_ein = 0;
1 ingob 27
//    TCNT0 -= 250;//TIMER_RELOAD_VALUE;
28
 
29
   if(!cnt--)
30
    {
31
     cnt = 9;
32
     cnt_1ms++;
33
     cnt_1ms %= 2;
34
     if(!cnt_1ms) UpdateMotor = 1;
35
     CountMilliseconds++;
36
     }  
37
 
38
     if(beeptime > 1)
39
        {
173 holgerb 40
        beeptime--;      
41
        if(beeptime & BeepMuster)
42
         {
43
          pieper_ein = 1;
44
         }
45
         else pieper_ein = 0;
1 ingob 46
        }
173 holgerb 47
     else
48
      {
49
       pieper_ein = 0;
50
       BeepMuster = 0xffff;
51
      }
52
 
53
 
54
     if(pieper_ein)
55
        {
56
          if(PlatinenVersion == 10) PORTD |= (1<<2); // Speaker an PORTD.2
57
          else                      PORTC |= (1<<7); // Speaker an PORTC.7
58
        }
1 ingob 59
     else  
173 holgerb 60
        {
61
         if(PlatinenVersion == 10) PORTD &= ~(1<<2);
62
         else                      PORTC &= ~(1<<7);
63
        }
64
 
1 ingob 65
 if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
66
 {
67
  if(PINC & 0x10)
68
   {
69
    cntKompass++;
70
   }
71
  else
72
   {
73
    if((cntKompass) && (cntKompass < 4000))
74
    {
693 hbuss 75
     cntKompass += cntKompass / 41;
76
     if(cntKompass > 10) KompassValue = cntKompass - 10; else KompassValue = 0;
1 ingob 77
    }
78
//     if(cntKompass < 10) cntKompass = 10;
79
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
80
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
81
    cntKompass = 0;
82
   }
83
 }
84
}
85
 
86
 
87
void Timer_Init(void)
88
{
89
    tim_main = SetDelay(10);
90
    TCCR0B = CK8;
91
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
92
    OCR0A =  0;
93
    OCR0B = 120;
304 ingob 94
    TCNT0 = (unsigned char)-TIMER_RELOAD_VALUE;  // reload
1 ingob 95
    //OCR1  = 0x00;
96
 
97
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
98
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
99
 
100
//    TIMSK2 |= _BV(TOIE2);
101
TIMSK2 |= _BV(OCIE2A);
102
 
103
    TIMSK0 |= _BV(TOIE0);
104
    OCR2A = 10;
105
    TCNT2 = 0;
106
 
107
}
108
 
109
// -----------------------------------------------------------------------
110
 
111
unsigned int SetDelay (unsigned int t)
112
{
113
//  TIMSK0 &= ~_BV(TOIE0);
114
  return(CountMilliseconds + t + 1);                                            
115
//  TIMSK0 |= _BV(TOIE0);
116
}
117
 
118
// -----------------------------------------------------------------------
119
char CheckDelay(unsigned int t)
120
{
121
//  TIMSK0 &= ~_BV(TOIE0);
122
  return(((t - CountMilliseconds) & 0x8000) >> 9);
123
//  TIMSK0 |= _BV(TOIE0);
124
}
125
 
126
// -----------------------------------------------------------------------
127
void Delay_ms(unsigned int w)
128
{
129
 unsigned int akt;
130
 akt = SetDelay(w);
131
 while (!CheckDelay(akt));
132
}
133
 
395 hbuss 134
void Delay_ms_Mess(unsigned int w)
135
{
136
 unsigned int akt;
137
 akt = SetDelay(w);
138
 while (!CheckDelay(akt)) ANALOG_ON;
139
}
140
 
1 ingob 141
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
142
//  Servo ansteuern
143
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
144
SIGNAL(SIG_OUTPUT_COMPARE2A)
145
{
146
  static unsigned char timer = 10;
147
 
148
  if(!timer--)  
149
    {
150
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
151
     ServoValue =  Parameter_ServoNickControl;
152
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
153
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
154
 
155
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
156
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
157
 
158
     OCR2A = ServoValue;// + 75;
159
     timer = EE_Parameter.ServoNickRefresh;
160
    }
161
    else
162
    {
163
     TCCR2A =3;
164
     PORTD&=~0x80;
165
    }
166
}