Subversion Repositories FlightCtrl

Rev

Rev 1134 | Rev 1142 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1134 Rev 1140
Line 3... Line 3...
3
#include "parameter.h"
3
#include "parameter.h"
Line 4... Line 4...
4
 
4
 
5
unsigned char J16Blinkcount = 0, J16Mask = 1, J16Brightness = 0, J16 = 0;
5
unsigned char J16Blinkcount = 0, J16Mask = 1, J16Brightness = 0, J16 = 0;
Line 6... Line -...
6
unsigned char J17Blinkcount = 0, J17Mask = 1, J17Brightness = 0, J17 = 0;
-
 
7
 
-
 
8
unsigned char pwmJ16 = 0, pwmJ17 = 0;
-
 
9
static unsigned char pwmtable[32] ={0, 1, 2, 2, 2, 3, 3, 4, 5, 6, 7, 8, 10, 11,
-
 
10
    13, 16, 19, 23, 27, 32, 38, 45, 54, 64, 76,
-
 
11
    91, 108, 128, 152, 181, 215, 250};
6
unsigned char J17Blinkcount = 0, J17Mask = 1, J17Brightness = 0, J17 = 0;
Line 12... Line 7...
12
 
7
 
Line 13... Line 8...
13
unsigned char lightsEnabled = 0, lightsOn = 0;
8
unsigned char lightsEnabled = 0, lightsOn = 0;
14
 
-
 
15
extern char MotorenEin;
-
 
16
 
-
 
17
void setJ16(char enabled) {
-
 
18
    /*  if( PARAM_LED_NEGATE )
-
 
19
                    enabled = !enabled;
-
 
20
            if( enabled && forceEnabled )
-
 
21
                    J16_ON;
9
 
22
            else
10
extern char MotorenEin;
23
                    J16_OFF;*/
11
 
24
 
12
void setJ16(char enabled) {
25
    if ((enabled && lightsOn) ^ LED_NEGATE_J16)
13
    if ((enabled && lightsOn) ^ LED_NEGATE_J16)
Line 26... Line 14...
26
        J16_ON;
14
        J16_ON;
27
    else
-
 
28
        J16_OFF;
-
 
29
}
-
 
30
 
-
 
31
void setJ17(char enabled) {
-
 
32
    /*  if( PARAM_LED_NEGATE )
-
 
33
                    enabled = !enabled;
-
 
34
            if( enabled && forceEnabled )
15
    else
35
                    J17_ON;
16
        J16_OFF;
36
            else
17
}
37
                    J17_OFF;*/
18
 
38
 
19
void setJ17(char enabled) {
Line 62... Line 43...
62
void checkLightsEnabled(void) {
43
void checkLightsEnabled(void) {
Line 63... Line 44...
63
 
44
 
64
    // Mit dem Gier-Stick rechts lassen sich bei stehenden Motoren die LED's ein- und mit links ausschalten
45
    // Mit dem Gier-Stick rechts lassen sich bei stehenden Motoren die LED's ein- und mit links ausschalten
65
    if (!MotorenEin) {
46
    if (!MotorenEin) {
66
        if (PARAM_LED_STICK_ENABLED) {
47
        if (PARAM_LED_STICK_ENABLED) {
67
            if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35 - 125
48
            if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] > 35 - 120
68
                    && PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 125 - 35) {
49
                    && PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ] < 120 - 35) {
69
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75)
50
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] < -75)
70
                    lightsEnabled = 1;
51
                    lightsEnabled = 1;
71
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75)
52
                if (PPM_in[ EE_Parameter.Kanalbelegung[ K_GIER ] ] > 75)
72
                    lightsEnabled = 0;
53
                    lightsEnabled = 0;
Line 111... Line 92...
111
            J16Blinkcount = Parameter_J16Timing - 1;
92
            J16Blinkcount = Parameter_J16Timing - 1;
112
            J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1);
93
            J16Mask = (J16Mask == 1 ? 0x80 : J16Mask >> 1);
Line 113... Line 94...
113
 
94
 
Line 114... Line 95...
114
            J16 = EE_Parameter.J16Bitmask & J16Mask;
95
            J16 = EE_Parameter.J16Bitmask & J16Mask;
115
 
-
 
116
            if (EE_Parameter.J16Bitmask & J16Mask) {
96
 
117
                pwmJ16 = pwmtable[(Parameter_J16Brightness + 6) / 4];
97
            if (EE_Parameter.J16Bitmask & J16Mask)
118
                J16Brightness = Parameter_J16Brightness / 23;
98
                J16Brightness = Parameter_J16Brightness / 23;
119
            } else
99
            else
Line 120... Line 100...
120
                pwmJ16 = J16Brightness = 0;
100
                J16Brightness = 0;
121
        }
101
        }
122
 
102
 
Line 129... Line 109...
129
            J17Blinkcount = Parameter_J17Timing - 1;
109
            J17Blinkcount = Parameter_J17Timing - 1;
130
            J17Mask = (J17Mask == 1 ? 0x80 : J17Mask >> 1);
110
            J17Mask = (J17Mask == 1 ? 0x80 : J17Mask >> 1);
Line 131... Line 111...
131
 
111
 
Line 132... Line 112...
132
            J17 = EE_Parameter.J17Bitmask & J17Mask;
112
            J17 = EE_Parameter.J17Bitmask & J17Mask;
133
 
-
 
134
            if (EE_Parameter.J17Bitmask & J17Mask) {
113
 
135
                pwmJ17 = pwmtable[(Parameter_J17Brightness + 6) / 4];
114
            if (EE_Parameter.J17Bitmask & J17Mask)
136
                J17Brightness = Parameter_J17Brightness / 23;
115
                J17Brightness = Parameter_J17Brightness / 23;
137
            } else
116
            else
138
                pwmJ17 = J17Brightness = 0;
117
                J17Brightness = 0;
Line 139... Line 118...
139
        }
118
        }
140
    }
119
    }