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
    {
75
     KompassValue = cntKompass;
76
    }
77
//     if(cntKompass < 10) cntKompass = 10;
78
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
79
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
80
    cntKompass = 0;
81
   }
82
 }
83
}
84
 
85
 
86
void Timer_Init(void)
87
{
88
    tim_main = SetDelay(10);
89
    TCCR0B = CK8;
90
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
91
    OCR0A =  0;
92
    OCR0B = 120;
304 ingob 93
    TCNT0 = (unsigned char)-TIMER_RELOAD_VALUE;  // reload
1 ingob 94
    //OCR1  = 0x00;
95
 
96
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
97
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
98
 
99
//    TIMSK2 |= _BV(TOIE2);
100
TIMSK2 |= _BV(OCIE2A);
101
 
102
    TIMSK0 |= _BV(TOIE0);
103
    OCR2A = 10;
104
    TCNT2 = 0;
105
 
106
}
107
 
108
// -----------------------------------------------------------------------
109
 
110
unsigned int SetDelay (unsigned int t)
111
{
112
//  TIMSK0 &= ~_BV(TOIE0);
113
  return(CountMilliseconds + t + 1);                                            
114
//  TIMSK0 |= _BV(TOIE0);
115
}
116
 
117
// -----------------------------------------------------------------------
118
char CheckDelay(unsigned int t)
119
{
120
//  TIMSK0 &= ~_BV(TOIE0);
121
  return(((t - CountMilliseconds) & 0x8000) >> 9);
122
//  TIMSK0 |= _BV(TOIE0);
123
}
124
 
125
// -----------------------------------------------------------------------
126
void Delay_ms(unsigned int w)
127
{
128
 unsigned int akt;
129
 akt = SetDelay(w);
130
 while (!CheckDelay(akt));
131
}
132
 
133
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
134
//  Servo ansteuern
135
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
136
SIGNAL(SIG_OUTPUT_COMPARE2A)
137
{
138
  static unsigned char timer = 10;
139
 
140
  if(!timer--)  
141
    {
142
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
143
     ServoValue =  Parameter_ServoNickControl;
144
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
145
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
146
 
147
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
148
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
149
 
150
     OCR2A = ServoValue;// + 75;
151
     timer = EE_Parameter.ServoNickRefresh;
152
    }
153
    else
154
    {
155
     TCCR2A =3;
156
     PORTD&=~0x80;
157
    }
158
}