Subversion Repositories FlightCtrl

Rev

Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
376 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 = 800;
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
        PORTD |= (1<<PD2);
42
        if(beeptime & BeepMuster)
43
         {
44
          pieper_ein = 1;
45
         }
46
         else pieper_ein = 0;
47
        }
48
     else
49
      {
50
       pieper_ein = 0;
51
       BeepMuster = 0xffff;
52
      }
53
 
54
 
55
     if(pieper_ein)
56
        {
57
          if(PlatinenVersion == 10) PORTD |= (1<<2); // Speaker an PORTD.2
58
          else                      PORTC |= (1<<7); // Speaker an PORTC.7
59
        }
60
     else
61
        {
62
         if(PlatinenVersion == 10) PORTD &= ~(1<<2);
63
         else                      PORTC &= ~(1<<7);
64
        }
65
 
66
 PORTD &= ~(1<<PD2);
67
 
68
 if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV)
69
	{
70
		MM3_timer0();		// Kompass auslesen
71
 
72
		if (!cntKompass--)		// Aufruf mit 10 Hz
73
		{
74
		//	KompassValue = MM3_heading();
75
 
76
		//	OsiAir hier machen wir den den KompassValue zu 0-359 damit das GPS damit weiterarbeiten kann
77
		if (MM3_heading() > 0) { KompassValue = 360-MM3_heading();}
78
		if (MM3_heading() < 0 ) { KompassValue = MM3_heading()*-1;}
79
 
80
 
81
			KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
82
			cntKompass = 800;
83
		}
84
	}
85
 
86
 }
87
 
88
 
89
 /*
90
 if(EE_Parameter.GlobalConfig & CFG_KOMPASS_AKTIV || EE_Parameter.GlobalConfig & CFG_GPS_AKTIV) //Abfrage um GPS_AKTIV erweitert, damit auch bei nur eingeschaltetem GPS OHNE Kompass der benötigte Kompassvalue berechnet wird (200907Kr)
91
 {
92
  if(PINC & 0x10)
93
   {
94
    cntKompass++;
95
   }
96
  else
97
   {
98
    if((cntKompass) && (cntKompass < 4000))
99
    {
100
     KompassValue = cntKompass;
101
    }
102
//     if(cntKompass < 10) cntKompass = 10;
103
//     KompassValue = (unsigned long)((unsigned long)(cntKompass-10)*720L + 1L) / 703L;
104
     KompassRichtung = ((540 + KompassValue - KompassStartwert) % 360) - 180;
105
    cntKompass = 0;
106
   }
107
 }
108
}
109
*/
110
 
111
void Timer_Init(void)
112
{
113
    tim_main = SetDelay(10);
114
    TCCR0B = CK8;
115
    TCCR0A = (1<<COM0A1)|(1<<COM0B1)|3;//fast PWM
116
    OCR0A =  0;
117
    OCR0B = 120;
118
    //TCNT0 = -TIMER_RELOAD_VALUE;  // reload
119
    //OCR1  = 0x00;
120
 
121
    TCCR2A=(1<<COM2A1)|(1<<COM2A0)|3;
122
    TCCR2B=(0<<CS20)|(1<<CS21)|(1<<CS22);
123
 
124
//    TIMSK2 |= _BV(TOIE2);
125
TIMSK2 |= _BV(OCIE2A);
126
 
127
    TIMSK0 |= _BV(TOIE0);
128
    OCR2A = 10;
129
    TCNT2 = 0;
130
 
131
}
132
 
133
// -----------------------------------------------------------------------
134
 
135
unsigned int SetDelay (unsigned int t)
136
{
137
//  TIMSK0 &= ~_BV(TOIE0);
138
  return(CountMilliseconds + t + 1);
139
//  TIMSK0 |= _BV(TOIE0);
140
}
141
 
142
// -----------------------------------------------------------------------
143
char CheckDelay(unsigned int t)
144
{
145
//  TIMSK0 &= ~_BV(TOIE0);
146
  return(((t - CountMilliseconds) & 0x8000) >> 9);
147
//  TIMSK0 |= _BV(TOIE0);
148
}
149
 
150
// -----------------------------------------------------------------------
151
void Delay_ms(unsigned int w)
152
{
153
 unsigned int akt;
154
 akt = SetDelay(w);
155
 while (!CheckDelay(akt));
156
}
157
 
158
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
159
//  Servo ansteuern
160
// +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
161
SIGNAL(SIG_OUTPUT_COMPARE2A)
162
{
163
  static unsigned char timer = 10;
164
 
165
  if(!timer--)
166
    {
167
     TCCR2A=(1<<COM2A1)|(0<<COM2A0)|3;
168
     ServoValue =  Parameter_ServoNickControl;
169
     if(EE_Parameter.ServoNickCompInvert & 0x01) ServoValue += ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
170
     else ServoValue -= ((long) EE_Parameter.ServoNickComp * (IntegralNick / 128)) / 512;
171
 
172
     if(ServoValue < EE_Parameter.ServoNickMin) ServoValue = EE_Parameter.ServoNickMin;
173
     else if(ServoValue > EE_Parameter.ServoNickMax) ServoValue = EE_Parameter.ServoNickMax;
174
 
175
     OCR2A = ServoValue;// + 75;
176
     timer = EE_Parameter.ServoNickRefresh;
177
    }
178
    else
179
    {
180
     TCCR2A =3;
181
     PORTD&=~0x80;
182
    }
183
}