Rev 66 | Rev 119 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 66 | Rev 67 | ||
---|---|---|---|
Line 270... | Line 270... | ||
270 | case 10: // attitude from FC |
270 | case 10: // attitude from FC |
271 | if(FromFlightCtrl.AngleNick < 0) sign = '-'; |
271 | if(FromFlightCtrl.AngleNick < 0) sign = '-'; |
272 | else sign = '+'; |
272 | else sign = '+'; |
273 | i1 = abs(FromFlightCtrl.AngleNick)/10; |
273 | i1 = abs(FromFlightCtrl.AngleNick)/10; |
274 | i2 = abs(FromFlightCtrl.AngleNick)%10; |
274 | i2 = abs(FromFlightCtrl.AngleNick)%10; |
275 | LCD_printfxy(0,0,"AngleNick: %c%3i.%1i", sign, i1, i2); |
275 | LCD_printfxy(0,0,"GyroNick:%c%03i.%01i", sign, i1, i2); |
276 | if(FromFlightCtrl.AngleRoll < 0) sign = '-'; |
276 | if(FromFlightCtrl.AngleRoll < 0) sign = '-'; |
277 | else sign = '+'; |
277 | else sign = '+'; |
278 | i1 = abs(FromFlightCtrl.AngleRoll)/10; |
278 | i1 = abs(FromFlightCtrl.AngleRoll)/10; |
279 | i2 = abs(FromFlightCtrl.AngleRoll)%10; |
279 | i2 = abs(FromFlightCtrl.AngleRoll)%10; |
280 | LCD_printfxy(0,0,"AngleRoll: %c%3i.%1i", sign, i1, i2); |
280 | LCD_printfxy(0,1,"GyroRoll:%c%03i.%01i", sign, i1, i2); |
- | 281 | if(FromFlightCtrl.AccNick < 0) sign = '-'; |
|
- | 282 | else sign = '+'; |
|
- | 283 | i1 = abs(FromFlightCtrl.AccNick)/10; |
|
- | 284 | i2 = abs(FromFlightCtrl.AccNick)%10; |
|
281 | LCD_printfxy(0,2," AccNick: %5i", FromFlightCtrl.AccNick); |
285 | LCD_printfxy(0,2," AccNick:%c%03i.%01i", sign, i1, i2); |
- | 286 | if(FromFlightCtrl.AccRoll < 0) sign = '-'; |
|
- | 287 | else sign = '+'; |
|
- | 288 | i1 = abs(FromFlightCtrl.AccRoll)/10; |
|
- | 289 | i2 = abs(FromFlightCtrl.AccRoll)%10; |
|
282 | LCD_printfxy(0,3," AccRoll: %5i", FromFlightCtrl.AccRoll); |
290 | LCD_printfxy(0,3," AccRoll:%c%03i.%01i", sign, i1, i2); |
283 | break; |
291 | break; |
284 | case 11: // gyros from FC |
292 | case 11: // gyros from FC |
285 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
293 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
286 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
294 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
287 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
295 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |