Subversion Repositories NaviCtrl

Rev

Rev 66 | Rev 72 | 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);