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

Added 'small_angle' indicator to OSD flip arrow.

Browse source
This commit is contained in:
mikeller 2018-12-20 00:41:20 +13:00
parent 6c9dc765b3
commit 468d8a3af5
4 changed files with 40 additions and 20 deletions
Download patch file Download diff file Expand all files Collapse all files

3
src/main/fc/core.c
View file

@ -519,8 +519,9 @@ void updateMagHold(void)
if (dif >= +180)
dif -= 360;
dif *= -GET_DIRECTION(rcControlsConfig()->yaw_control_reversed);
if (STATE(SMALL_ANGLE))
if (STATE(SMALL_ANGLE)) {
rcCommand[YAW] -= dif * currentPidProfile->pid[PID_MAG].P / 30; // 18 deg
}
} else
magHold = DECIDEGREES_TO_DEGREES(attitude.values.yaw);
}

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

@ -157,7 +157,8 @@ void imuConfigure(uint16_t throttle_correction_angle, uint8_t throttle_correctio
{
imuRuntimeConfig.dcm_kp = imuConfig()->dcm_kp / 10000.0f;
imuRuntimeConfig.dcm_ki = imuConfig()->dcm_ki / 10000.0f;
imuRuntimeConfig.small_angle = imuConfig()->small_angle;
smallAngleCosZ = cos_approx(degreesToRadians(imuConfig()->small_angle));
fc_acc = calculateAccZLowPassFilterRCTimeConstant(5.0f); // Set to fix value
throttleAngleScale = calculateThrottleAngleScale(throttle_correction_angle);
@ -167,7 +168,6 @@ void imuConfigure(uint16_t throttle_correction_angle, uint8_t throttle_correctio
void imuInit(void)
{
smallAngleCosZ = cos_approx(degreesToRadians(imuRuntimeConfig.small_angle));
accVelScale = 9.80665f * acc.dev.acc_1G_rec / 10000.0f;
#ifdef USE_GPS

1
src/main/flight/imu.h
View file

@ -67,7 +67,6 @@ PG_DECLARE(imuConfig_t, imuConfig);
typedef struct imuRuntimeConfig_s {
float dcm_ki;
float dcm_kp;
uint8_t small_angle;
} imuRuntimeConfig_t;
void imuConfigure(uint16_t throttle_correction_angle, uint8_t throttle_correction_value);

52
src/main/io/osd.c
View file

@ -528,7 +528,6 @@ void changeOsdProfileIndex(uint8_t profileIndex)
}
#endif
static bool osdDrawSingleElement(uint8_t item)
{
if (!VISIBLE(osdConfig()->item_pos[item]) || BLINK(item)) {
@ -542,25 +541,46 @@ static bool osdDrawSingleElement(uint8_t item)
switch (item) {
case OSD_FLIP_ARROW:
{
const int angleR = attitude.values.roll / 10;
const int angleP = attitude.values.pitch / 10; // still gotta update all angleR and angleP pointers.
if (isFlipOverAfterCrashActive()) {
if (angleP > 0 && ((angleR > 175 && angleR < 180) || (angleR > -180 && angleR < -175))) {
buff[0] = SYM_ARROW_SOUTH;
} else if (angleP > 0 && angleR > 0 && angleR < 175) {
buff[0] = (SYM_ARROW_EAST + 2);
} else if (angleP > 0 && angleR < 0 && angleR > -175) {
buff[0] = (SYM_ARROW_WEST + 2);
} else if (angleP <= 0 && ((angleR > 175 && angleR < 180) || (angleR > -180 && angleR < -175))) {
buff[0] = SYM_ARROW_NORTH;
} else if (angleP <= 0 && angleR > 0 && angleR < 175) {
buff[0] = (SYM_ARROW_NORTH + 2);
} else if (angleP <= 0 && angleR < 0 && angleR > -175) {
buff[0] = (SYM_ARROW_SOUTH + 2);
int rollAngle = attitude.values.roll / 10;
const int pitchAngle = attitude.values.pitch / 10;
if (abs(rollAngle) > 90) {
rollAngle = (rollAngle < 0 ? -180 : 180) - rollAngle;
}
if ((isFlipOverAfterCrashActive() || (!ARMING_FLAG(ARMED) && !STATE(SMALL_ANGLE))) && !((imuConfig()->small_angle < 180) && STATE(SMALL_ANGLE)) && (rollAngle || pitchAngle)) {
if (abs(pitchAngle) < 2 * abs(rollAngle) && abs(rollAngle) < 2 * abs(pitchAngle)) {
if (pitchAngle > 0) {
if (rollAngle > 0) {
buff[0] = SYM_ARROW_WEST + 2;
} else {
buff[0] = SYM_ARROW_EAST - 2;
}
} else {
if (rollAngle > 0) {
buff[0] = SYM_ARROW_WEST - 2;
} else {
buff[0] = SYM_ARROW_EAST + 2;
}
}
} else {
if (abs(pitchAngle) > abs(rollAngle)) {
if (pitchAngle > 0) {
buff[0] = SYM_ARROW_SOUTH;
} else {
buff[0] = SYM_ARROW_NORTH;
}
} else {
if (rollAngle > 0) {
buff[0] = SYM_ARROW_WEST;
} else {
buff[0] = SYM_ARROW_EAST;
}
}
}
} else {
buff[0] = ' ';
}
buff[1] = '\0';
break;
}