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