1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-21 15:25:36 +03:00

Removing TODOs.

If it needs to be done it will be done.
This commit is contained in:
Dominic Clifton 2015-01-31 22:08:03 +01:00
parent a0cca0c889
commit 7c2c5eb152

View file

@ -82,7 +82,6 @@ void configureIMU(
pidProfile_t *initialPidProfile, pidProfile_t *initialPidProfile,
accDeadband_t *initialAccDeadband, accDeadband_t *initialAccDeadband,
float accz_lpf_cutoff, float accz_lpf_cutoff,
//TODO: Move throttle angle correction code into flight/throttle_angle_correction.c
uint16_t throttle_correction_angle uint16_t throttle_correction_angle
) )
{ {
@ -90,7 +89,6 @@ void configureIMU(
pidProfile = initialPidProfile; pidProfile = initialPidProfile;
accDeadband = initialAccDeadband; accDeadband = initialAccDeadband;
fc_acc = calculateAccZLowPassFilterRCTimeConstant(accz_lpf_cutoff); fc_acc = calculateAccZLowPassFilterRCTimeConstant(accz_lpf_cutoff);
//TODO: Move throttle angle correction code into flight/throttle_angle_correction.c
throttleAngleScale = calculateThrottleAngleScale(throttle_correction_angle); throttleAngleScale = calculateThrottleAngleScale(throttle_correction_angle);
} }
@ -101,7 +99,6 @@ void initIMU()
gyroScaleRad = gyro.scale * (M_PIf / 180.0f) * 0.000001f; gyroScaleRad = gyro.scale * (M_PIf / 180.0f) * 0.000001f;
} }
//TODO: Move throttle angle correction code into flight/throttle_angle_correction.c
float calculateThrottleAngleScale(uint16_t throttle_correction_angle) float calculateThrottleAngleScale(uint16_t throttle_correction_angle)
{ {
return (1800.0f / M_PIf) * (900.0f / throttle_correction_angle); return (1800.0f / M_PIf) * (900.0f / throttle_correction_angle);
@ -333,7 +330,6 @@ void computeIMU(rollAndPitchTrims_t *accelerometerTrims, uint8_t mixerMode)
} }
} }
//TODO: Move throttle angle correction code into flight/throttle_angle_correction.c
int16_t calculateThrottleAngleCorrection(uint8_t throttle_correction_value) int16_t calculateThrottleAngleCorrection(uint8_t throttle_correction_value)
{ {
float cosZ = EstG.V.Z / sqrtf(EstG.V.X * EstG.V.X + EstG.V.Y * EstG.V.Y + EstG.V.Z * EstG.V.Z); float cosZ = EstG.V.Z / sqrtf(EstG.V.X * EstG.V.X + EstG.V.Y * EstG.V.Y + EstG.V.Z * EstG.V.Z);