Subversion Repositories FlightCtrl

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
366 Nick666 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 beeptime = 0;
7
volatile unsigned int cntKompass = 800;
8
int ServoValue = 0;
9
 
10
enum {
11
  STOP             = 0,
12
  CK               = 1,
13
  CK8              = 2,
14
  CK64             = 3,
15
  CK256            = 4,
16
  CK1024           = 5,
17
  T0_FALLING_EDGE  = 6,
18
  T0_RISING_EDGE   = 7
19
};
20
 
21
 
378 Nick666 22
SIGNAL (SIG_OVERFLOW0)    // 9,8kHz
366 Nick666 23
{
24
    static unsigned char cnt_1ms = 1,cnt = 0;
25
//    TCNT0 -= 250;//TIMER_RELOAD_VALUE;
26
 
27
   if(!cnt--)
28
    {
378 Nick666 29
     cnt = 10;
366 Nick666 30
     cnt_1ms++;
31
     cnt_1ms %= 2;
32
     if(!cnt_1ms) UpdateMotor = 1;
33
     CountMilliseconds++;
34
     if(Timeout) Timeout--;
35
     }  
36
 
37
     if(beeptime > 1)
38
        {
39
        beeptime--;
370 Nick666 40
        PORTD |= (1<<PD2);
366 Nick666 41
        }
42
     else  
43
        PORTD &= ~(1<<PD2);
44
 
45
        if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
46
        {
371 Nick666 47
                timer0_MM3();           // Kompass auslesen
366 Nick666 48
 
378 Nick666 49
                if (!cntKompass--)              // Aufruf mit 10 Hz
366 Nick666 50
                {
371 Nick666 51
                        KompassValue = heading_MM3();
366 Nick666 52
                        KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
378 Nick666 53
                        cntKompass = 980;
366 Nick666 54
                }
55
        }
56
}
57
 
58
 
59
void Timer_Init(void)
60
{
61
    tim_main = SetDelay(10);
62
    TCCR0B = CK8;
63
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
64
    OCR0A =  0;
65
    OCR0B = 120;
66
    //TCNT0 = -TIMER_RELOAD_VALUE;  // reload
67
    //OCR1  = 0x00;
68
 
69
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
70
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
71
 
72
//    TIMSK2 |= _BV(TOIE2);
73
TIMSK2 |= _BV(OCIE2A);
74
 
75
    TIMSK0 |= _BV(TOIE0);
76
    OCR2A = 10;
77
    TCNT2 = 0;
78
 
79
}
80
 
81
// -----------------------------------------------------------------------
82
 
83
unsigned int SetDelay (unsigned int t)
84
{
85
//  TIMSK0 &= ~_BV(TOIE0);
86
  return(CountMilliseconds + t + 1);                                            
87
//  TIMSK0 |= _BV(TOIE0);
88
}
89
 
90
// -----------------------------------------------------------------------
91
char CheckDelay(unsigned int t)
92
{
93
//  TIMSK0 &= ~_BV(TOIE0);
94
  return(((t - CountMilliseconds) & 0x8000) >> 9);
95
//  TIMSK0 |= _BV(TOIE0);
96
}
97
 
98
// -----------------------------------------------------------------------
99
void Delay_ms(unsigned int w)
100
{
101
 unsigned int akt;
102
 akt = SetDelay(w);
103
 while (!CheckDelay(akt));
104
}
105
 
106
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
107
//  Servo ansteuern
108
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++                
109
SIGNAL(SIG_OUTPUT_COMPARE2A)
110
{
111
  static unsigned char timer = 10;
112
 
113
  if(!timer--)  
114
    {
115
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;  
116
     ServoValue =  Parameter_ServoNickControl;
117
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
118
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
119
 
120
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
121
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
122
 
123
     //DebugOut.Analog[10] = ServoValue;     
124
     OCR2A = ServoValue;// + 75;
125
     timer = EE_Parameter.ServoNickRefresh;
126
    }
127
    else
128
    {
129
     TCCR2A =3;
130
     PORTD&=~0x80;
131
    }
132
}