Subversion Repositories NaviCtrl

Rev

Rev 292 | Rev 320 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 292 Rev 318
Line 272... Line 272...
272 
                                i1 = abs(NaviData.HomePosition.Altitude)/1000L;
 272 
                                i1 = abs(NaviData.HomePosition.Altitude)/1000L;
273 
                                i2 = abs(NaviData.HomePosition.Altitude)%1000L;
 273 
                                i2 = abs(NaviData.HomePosition.Altitude)%1000L;
274 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
 274 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
275 
                        }
 275 
                        }
276 
                        break;
 276 
                        break;
- 
 
 277 
                case 8:
- 
 
 278 
                        LCD_printfxy(0,0,"Target Position");
- 
 
 279 
                        if(NaviData.TargetPosition.Status == INVALID)
- 
 
 280 
                        {
- 
 
 281 
                                LCD_printfxy(0,1,"                     ");
- 
 
 282 
                                LCD_printfxy(0,2,"    Is not set.      ");
- 
 
 283 
                                LCD_printfxy(0,3,"                     ");
- 
 
 284 
                        }
- 
 
 285 
                        else
- 
 
 286 
                        {
- 
 
 287 
                                if(NaviData.TargetPosition.Longitude < 0) sign = '-';
- 
 
 288 
                                else sign = '+';
- 
 
 289 
                                i1 = abs(NaviData.TargetPosition.Longitude)/10000000L;
- 
 
 290 
                                i2 = abs(NaviData.TargetPosition.Longitude)%10000000L;
- 
 
 291 
                                LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
- 
 
 292 
                                if(NaviData.TargetPosition.Latitude < 0) sign = '-';
- 
 
 293 
                                else sign = '+';
- 
 
 294 
                                i1 = abs(NaviData.TargetPosition.Latitude)/10000000L;
- 
 
 295 
                                i2 = abs(NaviData.TargetPosition.Latitude)%10000000L;
- 
 
 296 
                                LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
- 
 
 297 
                                if(NaviData.HomePosition.Altitude < 0) sign = '-';
- 
 
 298 
                                else sign = '+';
- 
 
 299 
                                i1 = abs(NaviData.TargetPosition.Altitude)/1000L;
- 
 
 300 
                                i2 = abs(NaviData.TargetPosition.Altitude)%1000L;
- 
 
 301 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
- 
 
 302 
                        }
- 
 
 303 
                        break;
277 
                case 8: // RC stick controls from FC
 304 
                case 9: // RC stick controls from FC
278 
                        LCD_printfxy(0,0,"RC-Sticks" );
 305 
                        LCD_printfxy(0,0,"RC-Sticks" );
279 
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
 306 
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
280 
            LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",FC.StickGas, FC.StickYaw);
 307 
            LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",FC.StickGas, FC.StickYaw);
281 
                        break;
 308 
                        break;
282 
                case 9: // RC poti controls from FC
 309 
                case 10: // RC poti controls from FC
283 
                        LCD_printfxy(0,0,"RC-Potis 1" );
 310 
                        LCD_printfxy(0,0,"RC-Potis 1" );
284 
            LCD_printfxy(0,1,"Po1:%3i  Po2:%3i ",FC.Poti[0], FC.Poti[1]);
 311 
            LCD_printfxy(0,1,"Po1:%3i  Po2:%3i ",FC.Poti[0], FC.Poti[1]);
285 
            LCD_printfxy(0,2,"Po3:%3i  Po4:%3i ",FC.Poti[2], FC.Poti[3]);
 312 
            LCD_printfxy(0,2,"Po3:%3i  Po4:%3i ",FC.Poti[2], FC.Poti[3]);
286 
                        break;
 313 
                        break;
287 
                case 10: // RC poti controls from FC
 314 
                case 11: // RC poti controls from FC
288 
                        LCD_printfxy(0,0,"RC-Potis 2" );
 315 
                        LCD_printfxy(0,0,"RC-Potis 2" );
289 
            LCD_printfxy(0,1,"Po5:%3i  Po6:%3i ",FC.Poti[4], FC.Poti[5]);
 316 
            LCD_printfxy(0,1,"Po5:%3i  Po6:%3i ",FC.Poti[4], FC.Poti[5]);
290 
            LCD_printfxy(0,2,"Po7:%3i  Po8:%3i ",FC.Poti[6], FC.Poti[7]);
 317 
            LCD_printfxy(0,2,"Po7:%3i  Po8:%3i ",FC.Poti[6], FC.Poti[7]);
291 
                        break;
 318 
                        break;
292 
                case 11: // attitude from FC
 319 
                case 12: // attitude from FC
293 
                        if(FromFlightCtrl.AngleNick < 0) sign = '-';
 320 
                        if(FromFlightCtrl.AngleNick < 0) sign = '-';
294 
                        else sign = '+';
 321 
                        else sign = '+';
295 
                        i1 = abs(FromFlightCtrl.AngleNick)/10;
 322 
                        i1 = abs(FromFlightCtrl.AngleNick)/10;
296 
                        i2 = abs(FromFlightCtrl.AngleNick)%10;
 323 
                        i2 = abs(FromFlightCtrl.AngleNick)%10;
297 
                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
 324 
                        LCD_printfxy(0,0,"GyroNick:%c%03ld.%01ld", sign, i1, i2);
Line 309... Line 336...
309 
                        else sign = '+';
 336 
                        else sign = '+';
310 
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
 337 
                        i1 = abs(FromFlightCtrl.AccRoll)/10;
311 
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
 338 
                        i2 = abs(FromFlightCtrl.AccRoll)%10;
312 
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
 339 
            LCD_printfxy(0,3," AccRoll:%c%03ld.%01ld", sign, i1, i2);
313 
                        break;
 340 
                        break;
314 
                case 12: // gyros from FC
 341 
                case 13: // gyros from FC
315 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
 342 
                        LCD_printfxy(0,0,"GyroNick:  %4i", FromFlightCtrl.GyroNick);
316 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
 343 
            LCD_printfxy(0,1,"GyroRoll:  %4i", FromFlightCtrl.GyroRoll);
317 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
 344 
                        LCD_printfxy(0,2,"GyroYaw:   %4i", FromFlightCtrl.GyroYaw);
318 
                        break;
 345 
                        break;
319 
                case 13: // Remote Control Level from FC
 346 
                case 14: // Remote Control Level from FC
320 
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
 347 
            LCD_printfxy(0,0,"RC-Level:    %3i", FC.RC_Quality);
321 
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
 348 
                        LCD_printfxy(0,1,"Ubat:        %2i.%1i V", FC.BAT_Voltage/10, FC.BAT_Voltage%10);
322 
                        LCD_printfxy(0,2,"CompHeading: %3i", Compass_Heading);
 349 
                        LCD_printfxy(0,2,"CompHeading: %3i", Compass_Heading);
323 
                        if(GeoMagDec < 0) sign = '-';
 350 
                        if(GeoMagDec < 0) sign = '-';
324 
                        else sign = '+';
 351 
                        else sign = '+';
325 
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
 352 
                        LCD_printfxy(0,3,"GeoMagDec:  %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10);
326 
            break;
 353 
            break;
327 
                case 14: // User Parameter
 354 
                case 15: // User Parameter
328 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
 355 
                        LCD_printfxy(0,0,"UP1:%3i  UP2:%3i",Parameter.User1,Parameter.User2);
329 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
 356 
                        LCD_printfxy(0,1,"UP3:%3i  UP4:%3i",Parameter.User3,Parameter.User4);
330 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
 357 
                        LCD_printfxy(0,2,"UP5:%3i  UP6:%3i",Parameter.User5,Parameter.User6);
331 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
 358 
                        LCD_printfxy(0,3,"UP7:%3i  UP8:%3i",Parameter.User7,Parameter.User8);
332 
                        break;
 359 
                        break;
333 
                case 15: // magnetic field
 360 
                case 16: // magnetic field
334 
                        if(Compass_CalState)
 361 
                        if(Compass_CalState)
335 
                        {
 362 
                        {
336 
                                LCD_printfxy(0,0,"Calibration:");
 363 
                                LCD_printfxy(0,0,"Calibration:");
337 
                                LCD_printfxy(0,1,"Step %d/", Compass_CalState);
 364 
                                LCD_printfxy(0,1,"Step %d/", Compass_CalState);
338 
                                LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);
 365 
                                LCD_printfxy(0,2,"X %4i Y %4i Z %4i",MagVector.X,MagVector.Y,MagVector.Z);