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); |