272,14 → 272,22 |
else sign = '+'; |
i1 = abs(FromFlightCtrl.AngleNick)/10; |
i2 = abs(FromFlightCtrl.AngleNick)%10; |
LCD_printfxy(0,0,"AngleNick: %c%3i.%1i", sign, i1, i2); |
LCD_printfxy(0,0,"GyroNick:%c%03i.%01i", sign, i1, i2); |
if(FromFlightCtrl.AngleRoll < 0) sign = '-'; |
else sign = '+'; |
i1 = abs(FromFlightCtrl.AngleRoll)/10; |
i2 = abs(FromFlightCtrl.AngleRoll)%10; |
LCD_printfxy(0,0,"AngleRoll: %c%3i.%1i", sign, i1, i2); |
LCD_printfxy(0,2," AccNick: %5i", FromFlightCtrl.AccNick); |
LCD_printfxy(0,3," AccRoll: %5i", FromFlightCtrl.AccRoll); |
LCD_printfxy(0,1,"GyroRoll:%c%03i.%01i", sign, i1, i2); |
if(FromFlightCtrl.AccNick < 0) sign = '-'; |
else sign = '+'; |
i1 = abs(FromFlightCtrl.AccNick)/10; |
i2 = abs(FromFlightCtrl.AccNick)%10; |
LCD_printfxy(0,2," AccNick:%c%03i.%01i", sign, i1, i2); |
if(FromFlightCtrl.AccRoll < 0) sign = '-'; |
else sign = '+'; |
i1 = abs(FromFlightCtrl.AccRoll)/10; |
i2 = abs(FromFlightCtrl.AccRoll)%10; |
LCD_printfxy(0,3," AccRoll:%c%03i.%01i", sign, i1, i2); |
break; |
case 11: // gyros from FC |
LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |