Rev 1122 | Go to most recent revision | Only display areas with differences | Regard whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 1122 | Rev 1132 | ||
---|---|---|---|
1 | /* pitch.c |
1 | /* pitch.c |
2 | * |
2 | * |
3 | * Copyright 2009 Thomas Jachmann |
3 | * Copyright 2009 Thomas Jachmann |
4 | * |
4 | * |
5 | * Pitch-Steuerung |
5 | * Pitch-Steuerung |
6 | */ |
6 | */ |
7 | 7 | ||
8 | #include "main.h" |
8 | #include "main.h" |
9 | #include "parameter.h" |
9 | #include "parameter.h" |
10 | #include "pitch_neutral.h" |
10 | #include "pitch_neutral.h" |
11 | #include "pitch_md.h" |
11 | #include "pitch_md.h" |
12 | #include "pitch.h" |
12 | #include "pitch.h" |
13 | 13 | ||
14 | 14 | ||
15 | // Zeiger auf den durch das Setting bestimmten Pitch-Steuerungsalgorithmus |
15 | // Zeiger auf den durch das Setting bestimmten Pitch-Steuerungsalgorithmus |
16 | int (* pitch_value_ptr)( void ); |
16 | int (* pitch_value_ptr)( void ); |
17 | 17 | ||
18 | // Prototyp |
18 | // Prototyp |
19 | int pitch_mk_value( void ); |
19 | int pitch_mk_value( void ); |
20 | 20 | ||
21 | 21 | ||
22 | /* |
22 | /* |
23 | * Führt die Initialisierung der Pitch-Steuerung durch. Diese Funktion |
23 | * Führt die Initialisierung der Pitch-Steuerung durch. Diese Funktion |
24 | * wird nach jeder Setting-Auswahl sowie nach jeder Setting-Änderung |
24 | * wird nach jeder Setting-Auswahl sowie nach jeder Setting-Änderung |
25 | * aufgerufen. |
25 | * aufgerufen. |
26 | */ |
26 | */ |
27 | void pitch_init( void ) { |
27 | void pitch_init( void ) { |
28 | 28 | ||
29 | // FIXME Funktioniert noch nicht |
29 | // FIXME Funktioniert noch nicht |
30 | switch( PARAM_PITCH_MODE ) { |
30 | switch( PARAM_PITCH_MODE ) { |
31 | case PARAM_PITCH_MODE_NEUTRAL: |
31 | case PARAM_PITCH_MODE_NEUTRAL: |
32 | pitch_value_ptr = pitch_neutral_value; |
32 | pitch_value_ptr = pitch_neutral_value; |
33 | break; |
33 | break; |
34 | 34 | ||
35 | case PARAM_PITCH_MODE_MD: |
35 | case PARAM_PITCH_MODE_MD: |
36 | pitch_value_ptr = pitch_md_value; |
36 | pitch_value_ptr = pitch_md_value; |
37 | break; |
37 | break; |
38 | 38 | ||
39 | default: |
39 | default: |
40 | pitch_value_ptr = pitch_mk_value; |
40 | pitch_value_ptr = pitch_mk_value; |
41 | } |
41 | } |
42 | 42 | ||
43 | // Hier können weitere Initialisierungen folgen |
43 | // Hier können weitere Initialisierungen folgen |
44 | } |
44 | } |
45 | 45 | ||
46 | 46 | ||
47 | int pitch_value( void ) { |
47 | int pitch_value( void ) { |
48 | switch( PARAM_PITCH_MODE ) { |
48 | switch( PARAM_PITCH_MODE ) { |
49 | case PARAM_PITCH_MODE_NEUTRAL: |
49 | case PARAM_PITCH_MODE_NEUTRAL: |
50 | return pitch_neutral_value(); |
50 | return pitch_neutral_value(); |
51 | 51 | ||
52 | case PARAM_PITCH_MODE_MD: |
52 | case PARAM_PITCH_MODE_MD: |
53 | return pitch_md_value(); |
53 | return pitch_md_value(); |
54 | 54 | ||
55 | default: |
55 | default: |
56 | return pitch_mk_value(); |
56 | return pitch_mk_value(); |
57 | } |
57 | } |
58 | } |
58 | } |
59 | 59 | ||
60 | 60 | ||
61 | /* |
61 | /* |
62 | * Führt eine Pitch-Berechnung aus, die der Original-SW entspricht. |
62 | * Führt eine Pitch-Berechnung aus, die der Original-SW entspricht. |
63 | */ |
63 | */ |
64 | int pitch_mk_value( void ) { |
64 | int pitch_mk_value( void ) { |
65 | register int stickValue = PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ]; |
65 | register int stickValue = PPM_in[ EE_Parameter.Kanalbelegung[ K_GAS ] ]; |
- | 66 | // Warum 120? Gas= 0 ist -125 |
|
- | 67 | // register int pitchCount = stickValue + 120; |
|
66 | register int pitchCount = stickValue + 120; |
68 | register int pitchCount = stickValue + 125; |
67 | 69 | ||
68 | DebugOut.Analog[26] = stickValue; |
70 | DebugOut.Analog[26] = stickValue; |
69 | DebugOut.Analog[28] = pitchCount; |
71 | DebugOut.Analog[28] = pitchCount; |
70 | 72 | ||
71 | return pitchCount; |
73 | return pitchCount; |
72 | } |
74 | } |
73 | 75 |