Mirror/betaflight
1
0
Fork 0
mirror of https://github.com/betaflight/betaflight.git synced 2025-07-25 17:25:20 +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

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;
}