268,8 → 268,16 |
LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti3, FC.Poti4); |
break; |
case 10: // attitude from FC |
LCD_printfxy(0,0,"AngleNick: %3i.%1i", FromFlightCtrl.AngleNick/10, FromFlightCtrl.AngleNick%10); |
LCD_printfxy(0,1,"AngleRoll: %3i.%1i", FromFlightCtrl.AngleRoll/10, FromFlightCtrl.AngleRoll%10); |
if(FromFlightCtrl.AngleNick < 0) sign = '-'; |
else sign = '+'; |
i1 = abs(FromFlightCtrl.AngleNick)/10; |
i2 = abs(FromFlightCtrl.AngleNick)%10; |
LCD_printfxy(0,0,"AngleNick: %c%3i.%1i", 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); |
break; |