Subversion Repositories FlightCtrl

Rev

Rev 871 | Rev 910 | Go to most recent revision | Details | Compare with Previous | 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
 
872 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;
872 hbuss 100
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
1 ingob 101
 
872 hbuss 102
//    TIMSK2 |= _BV(TOIE2);
103
TIMSK2 |= _BV(OCIE2A);
1 ingob 104
 
105
    TIMSK0 |= _BV(TOIE0);
106
    OCR2A = 10;
107
    TCNT2 = 0;
108
 
109
}
110
 
111
// -----------------------------------------------------------------------
112
 
113
unsigned int SetDelay (unsigned int t)
114
{
115
//  TIMSK0 &= ~_BV(TOIE0);
116
  return(CountMilliseconds + t + 1);                                            
117
//  TIMSK0 |= _BV(TOIE0);
118
}
119
 
120
// -----------------------------------------------------------------------
121
char CheckDelay(unsigned int t)
122
{
123
//  TIMSK0 &= ~_BV(TOIE0);
124
  return(((t - CountMilliseconds) & 0x8000) >> 9);
125
//  TIMSK0 |= _BV(TOIE0);
126
}
127
 
128
// -----------------------------------------------------------------------
129
void Delay_ms(unsigned int w)
130
{
131
 unsigned int akt;
132
 akt = SetDelay(w);
133
 while (!CheckDelay(akt));
134
}
135
 
395 hbuss 136
void Delay_ms_Mess(unsigned int w)
137
{
138
 unsigned int akt;
139
 akt = SetDelay(w);
140
 while (!CheckDelay(akt)) ANALOG_ON;
141
}
142
 
1 ingob 143
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
144
//  Servo ansteuern
145
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
146
SIGNAL(SIG_OUTPUT_COMPARE2A)
147
{
872 hbuss 148
  static unsigned char timer = 10;
1 ingob 149
 
150
  if(!timer--)  
151
    {
152
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
153
     ServoValue =  Parameter_ServoNickControl;
154
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
155
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
156
 
157
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
158
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
159
 
160
     OCR2A = ServoValue;// + 75;
161
     timer = EE_Parameter.ServoNickRefresh;
162
    }
163
    else
164
    {
165
     TCCR2A =3;
166
     PORTD&=~0x80;
872 hbuss 167
    }
1 ingob 168
}