| 10,13 → 10,12 |
|---|
| #include "pitch.h" |
| |
| #define STICK_FACTOR ((int16_t) 256) |
| //#define GAS_SCALE ((uint8_t) 4) |
| |
| static int16_t stickValue = 0; // Aktueller Stick-Wert |
| static int16_t stickValue = INT16_MIN; // Aktueller Stick-Wert |
| |
| int pitch_inc_value( void ) { |
| |
| long rawStickValue = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]; |
| int32_t rawStickValue = PPM_in[EE_Parameter.Kanalbelegung[K_GAS]]; |
| |
| DebugOut.Analog[25] = rawStickValue; |
| |
| 23,8 → 22,8 |
|---|
| rawStickValue = ((rawStickValue * rawStickValue * rawStickValue) / (PARAM_INC_GAS_SCALE+1)) / (PARAM_INC_GAS_SCALE+1); |
| |
| // Neuer Stick-Wert |
| if (rawStickValue < 0 && stickValue < -INT16_MAX - rawStickValue) // ToDo |
| stickValue = -INT16_MAX; |
| if (rawStickValue < 0 && stickValue < INT16_MIN - rawStickValue) // ToDo |
| stickValue = INT16_MIN; |
| else if (rawStickValue > 0 && stickValue > INT16_MAX - rawStickValue ) |
| stickValue = INT16_MAX; |
| else if (rawStickValue != 0) |
| 40,7 → 39,7 |
|---|
| |
| printf("\r\npitch_inc_init()"); |
| |
| stickValue = (int) MIN_GAS * STICK_FACTOR; |
| stickValue = INT16_MIN; |
| |
| pitchValueFP = pitch_inc_value; |
| } |