Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-17 21:35:44 +03:00
Code Issues Wiki Activity

Disable ADC debug output and enable AltHold debugging output.

Browse source
This commit is contained in:
Dominic Clifton 2014-06-23 22:05:26 +01:00
parent 91bfdf05ca
commit e30a373c92
2 changed files with 13 additions and 11 deletions
Download patch file Download diff file Expand all files Collapse all files

2
src/main/drivers/adc.c
View file

@ -32,7 +32,7 @@ extern int16_t debug[4];
uint16_t adcGetChannel(uint8_t channel)
{
#if 1
#if 0
if (adcConfig[0].enabled) {
debug[0] = adcValues[adcConfig[0].dmaIndex];
}

22
src/main/flight/imu.c
View file

@ -42,6 +42,8 @@
#include "flight/mixer.h"
#include "flight/imu.h"
extern int16_t debug[4];
int16_t gyroADC[XYZ_AXIS_COUNT], accADC[XYZ_AXIS_COUNT], accSmooth[XYZ_AXIS_COUNT];
int32_t accSum[XYZ_AXIS_COUNT];
@ -374,12 +376,12 @@ bool isThrustFacingDownwards(rollAndPitchInclination_t *inclination)
int32_t calculateBaroPid(int32_t vel_tmp, float accZ_tmp, float accZ_old)
{
uint32_t baroPID = 0;
uint32_t newBaroPID = 0;
int32_t error;
int32_t setVel;
if (!isThrustFacingDownwards(&inclination)) {
return baroPID;
return newBaroPID;
}
// Altitude P-Controller
@ -392,17 +394,17 @@ int32_t calculateBaroPid(int32_t vel_tmp, float accZ_tmp, float accZ_old)
// P
error = setVel - vel_tmp;
baroPID = constrain((pidProfile->P8[PIDVEL] * error / 32), -300, +300);
newBaroPID = constrain((pidProfile->P8[PIDVEL] * error / 32), -300, +300);
// I
errorAltitudeI += (pidProfile->I8[PIDVEL] * error) / 8;
errorAltitudeI = constrain(errorAltitudeI, -(1024 * 200), (1024 * 200));
baroPID += errorAltitudeI / 1024; // I in range +/-200
newBaroPID += errorAltitudeI / 1024; // I in range +/-200
// D
baroPID -= constrain(pidProfile->D8[PIDVEL] * (accZ_tmp + accZ_old) / 64, -150, 150);
newBaroPID -= constrain(pidProfile->D8[PIDVEL] * (accZ_tmp + accZ_old) / 64, -150, 150);
return baroPID;
return newBaroPID;
}
void calculateEstimatedAltitude(uint32_t currentTime)
@ -444,10 +446,10 @@ void calculateEstimatedAltitude(uint32_t currentTime)
EstAlt = accAlt;
vel += vel_acc;
#if 0
debug[0] = accSum[2] / accSumCount; // acceleration
debug[1] = vel; // velocity
debug[2] = accAlt; // height
#if 1
debug[1] = accSum[2] / accSumCount; // acceleration
debug[2] = vel; // velocity
debug[3] = accAlt; // height
#endif
accSum_reset();