Subversion Repositories FlightCtrl

Rev

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

Rev Author Line No. Line
333 osiair 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;
8
unsigned int BeepMuster = 0xffff;
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;
26
    unsigned char pieper_ein = 0;
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
        {
40
        beeptime--;      
41
        if(beeptime & BeepMuster)
42
         {
43
          pieper_ein = 1;
44
         }
45
         else pieper_ein = 0;
46
        }
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
        }
59
     else  
60
        {
61
         if(PlatinenVersion == 10) PORTD &= ~(1<<2);
62
         else                      PORTC &= ~(1<<7);
63
        }
64
 
65
 if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
66
 {
67
 
68
                MM3_timer0();           // Kompass auslesen
69
 
70
                if (!cntKompass--)              // Aufruf mit 25 Hz
71
                {
72
 
73
 
74
                if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();}
75
                if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;}
76
 
77
 
78
 
79
 
80
                KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360)-180;
81
                            cntKompass = 320; // 320 
82
   }
83
 }
84
}
85
 
86
 
87
 
88
void Timer_Init(void)
89
{
90
    tim_main = SetDelay(10);
91
    TCCR0B = CK8;
92
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
93
    OCR0A =  0;
94
    OCR0B = 120;
95
    TCNT0 = -TIMER_RELOAD_VALUE;  // reload
96
    //OCR1  = 0x00;
97
 
98
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
99
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
100
 
101
//    TIMSK2 |= _BV(TOIE2);
102
TIMSK2 |= _BV(OCIE2A);
103
 
104
    TIMSK0 |= _BV(TOIE0);
105
    OCR2A = 10;
106
    TCNT2 = 0;
107
 
108
}
109
 
110
// -----------------------------------------------------------------------
111
 
112
unsigned int SetDelay (unsigned int t)
113
{
114
//  TIMSK0 &= ~_BV(TOIE0);
115
  return(CountMilliseconds + t + 1);                                            
116
//  TIMSK0 |= _BV(TOIE0);
117
}
118
 
119
// -----------------------------------------------------------------------
120
char CheckDelay(unsigned int t)
121
{
122
//  TIMSK0 &= ~_BV(TOIE0);
123
  return(((t - CountMilliseconds) & 0x8000) >> 9);
124
//  TIMSK0 |= _BV(TOIE0);
125
}
126
 
127
// -----------------------------------------------------------------------
128
void Delay_ms(unsigned int w)
129
{
130
 unsigned int akt;
131
 akt = SetDelay(w);
132
 while (!CheckDelay(akt));
133
}
134
 
135
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
136
//  Servo ansteuern
137
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
138
SIGNAL(SIG_OUTPUT_COMPARE2A)
139
{
140
  static unsigned char timer = 10;
141
 
142
  if(!timer--)  
143
    {
144
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
145
     ServoValue =  Parameter_ServoNickControl;
146
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
147
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
148
 
149
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
150
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
151
 
152
     OCR2A = ServoValue;// + 75;
153
     timer = EE_Parameter.ServoNickRefresh;
154
    }
155
    else
156
    {
157
     TCCR2A =3;
158
     PORTD&=~0x80;
159
    }
160
}