Subversion Repositories FlightCtrl

Rev

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

Rev Author Line No. Line
1 ingob 1
/*#######################################################################################
2
Decodieren eines RC Summen Signals
3
#######################################################################################*/
4
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
5
// + Copyright (c) 04.2007 Holger Buss
6
// + only for non-profit use
7
// + www.MikroKopter.com
8
// + see the File "License.txt" for further Informations
9
// ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
10
 
11
#include "rc.h"
12
#include "main.h"
13
 
14
volatile int PPM_in[11];
15
volatile int PPM_diff[11];  // das diffenzierte Stick-Signal
1268 hbuss 16
volatile char Channels,tmpChannels = 0;
1 ingob 17
volatile unsigned char NewPpmData = 1;
18
 
19
//############################################################################
20
//zum decodieren des PPM-Signals wird Timer1 mit seiner Input
21
//Capture Funktion benutzt:
22
void rc_sum_init (void)
23
//############################################################################
24
{
25
        TCCR1B=(1<<CS11)|(1<<CS10)|(1<<ICES1)|(1<<ICNC1);//|(1 << WGM12); //timer1 prescale 64
1171 hbuss 26
//      TCCR1B=(1<<CS11)|(0<<CS10)|(1<<ICES1)|(1<<ICNC1); //timer1 prescale 64
1 ingob 27
    TIMSK1 |= _BV(ICIE1);
28
    AdNeutralGier = 0;
29
    AdNeutralRoll = 0;
30
    AdNeutralNick = 0;
31
    return;
32
}
33
 
34
//############################################################################
35
//Diese Routine startet und inizialisiert den Timer für RC
36
SIGNAL(SIG_INPUT_CAPTURE1)
37
//############################################################################
38
 
39
{
40
        static unsigned int AltICR=0;
1268 hbuss 41
    static int ppm_in[11];
42
    static int ppm_diff[11];  
43
    static int old_ppm_in[11];
44
    static int old_ppm_diff[11];  
173 holgerb 45
    signed int signal = 0,tmp;
1268 hbuss 46
        static unsigned char index, okay_cnt = 0;              
1 ingob 47
        signal = (unsigned int) ICR1 - AltICR;         
48
        AltICR = ICR1; 
49
    //Syncronisationspause?
513 hbuss 50
        if((signal > 1100) && (signal < 8000))   
1 ingob 51
        {
1268 hbuss 52
        tmpChannels = index;
53
        if(tmpChannels >= 4 && Channels == tmpChannels)  
54
                 {
55
          if(okay_cnt > 5)
56
                   {
57
                   NewPpmData = 0;  // Null bedeutet: Neue Daten
58
                   for(index = 0; index < 11; index++)
59
                    {
60
                         if(okay_cnt > 30)
61
                          {
62
                           old_ppm_in[index] = PPM_in[index];
63
                           old_ppm_diff[index] = PPM_diff[index];
64
                          }
65
                     PPM_in[index] = ppm_in[index];
66
                     PPM_diff[index] = ppm_diff[index];
67
                    }
68
                   }
69
          if(okay_cnt < 255) okay_cnt++;
70
                 }
71
         else okay_cnt = 0;
1 ingob 72
        index = 1;             
1268 hbuss 73
        if(!MotorenEin) Channels = tmpChannels;
1 ingob 74
        }
75
        else
76
        {
77
        if(index < 10)
78
            {
79
            if((signal > 250) && (signal < 687))
80
                {
81
                signal -= 466;
82
                // Stabiles Signal
1268 hbuss 83
                if((abs(signal - ppm_in[index]) < 6) && okay_cnt > 30) { if(SenderOkay < 200) SenderOkay += 5; else SenderOkay = 200;}
84
                tmp = (3 * (ppm_in[index]) + signal) / 4;  
604 hbuss 85
                if(tmp > signal+1) tmp--; else
86
                if(tmp < signal-1) tmp++;
1268 hbuss 87
                if(SenderOkay >= 190)  ppm_diff[index] = ((tmp - ppm_in[index]) / 3) * 3;
88
                else ppm_diff[index] = 0;
89
                ppm_in[index] = tmp;
1 ingob 90
                }
1268 hbuss 91
                        else ROT_ON;
92
            if(index == 5) J3High; else J3Low;  // Servosignal an J3 anlegen
93
            if(index == 6) J4High; else J4Low;  // Servosignal an J4 anlegen
94
            if(index == 7) J5High; else J5Low;  // Servosignal an J5 anlegen 
95
          }
96
                  else ROT_ON;
97
                  if(index < 20) index++;
98
                  else
99
                  {
100
                   unsigned char i;
101
            for(i=0;i<11;i++) // restore from older data
102
                         {
103
                      PPM_in[i] = old_ppm_in[index];
104
                      PPM_diff[index] = 0;
105
                          okay_cnt = 0;
106
                 }
107
                  }
108
            }
109
DebugOut.Analog[16] = okay_cnt;
1171 hbuss 110
}
111
 
112
/*
113
//############################################################################
114
//Diese Routine startet und inizialisiert den Timer für RC
115
SIGNAL(SIG_INPUT_CAPTURE1)
116
//############################################################################
117
 
118
{
119
        static unsigned int AltICR=0;
120
    signed int signal = 0,tmp;
121
        static int index;              
122
 
123
        signal = (unsigned int) ICR1 - AltICR;         
124
DebugOut.Analog[16] = signal;
125
        signal /= 2;
126
        AltICR = ICR1; 
127
    //Syncronisationspause?
128
        if((signal > 1100*2) && (signal < 8000*2))       
129
        {
130
        if(index >= 4)  NewPpmData = 0;  // Null bedeutet: Neue Daten
131
        index = 1;             
132
        }
133
        else
134
        {
135
        if(index < 10)
136
            {
137
            if((signal > 250) && (signal < 687*2))
138
                {
139
                signal -= 962;
140
                // Stabiles Signal
141
                if(abs(signal - PPM_in[index]) < 6) { if(SenderOkay < 200) SenderOkay += 10;}
142
                tmp = (3 * (PPM_in[index]) + signal) / 4;  
143
                if(tmp > signal+1) tmp--; else
144
                if(tmp < signal-1) tmp++;
145
                if(SenderOkay >= 195)  PPM_diff[index] = ((tmp - PPM_in[index]) / 3) * 3;
146
                else PPM_diff[index] = 0;
147
                PPM_in[index] = tmp;
148
                }
149
            index++;  
1155 hbuss 150
         if(index == 5) J3High; else J3Low;  // Servosignal an J3 anlegen
1171 hbuss 151
         if(index == 2) J4High; else J4Low;  // Servosignal an J4 anlegen
1155 hbuss 152
         if(index == 7) J5High; else J5Low;  // Servosignal an J5 anlegen
1 ingob 153
        }
154
        }
155
}
1171 hbuss 156
*/
1 ingob 157
 
158
 
159