Rev 171 | Rev 201 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
| Rev 171 | Rev 190 | ||
|---|---|---|---|
| Line 68... | Line 68... | ||
| 68 | 68 | ||
| 69 | s8 DisplayBuff[DISPLAYBUFFSIZE] = "Hello World"; |
69 | s8 DisplayBuff[DISPLAYBUFFSIZE] = "Hello World"; |
| Line 70... | Line 70... | ||
| 70 | u8 DispPtr = 0; |
70 | u8 DispPtr = 0; |
| 71 | 71 | ||
| 72 | u8 MenuItem = 0; |
72 | u8 MenuItem = 0; |
| Line 73... | Line 73... | ||
| 73 | u8 MaxMenuItem = 14; |
73 | u8 MaxMenuItem = 15; |
| 74 | u8 RemoteKeys = 0; |
74 | u8 RemoteKeys = 0; |
| 75 | 75 | ||
| Line 281... | Line 281... | ||
| 281 | LCD_printfxy(0,0,"RC-Sticks" ); |
281 | LCD_printfxy(0,0,"RC-Sticks" ); |
| 282 | LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",FC.StickNick, FC.StickRoll); |
282 | LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",FC.StickNick, FC.StickRoll); |
| 283 | LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",FC.StickGas, FC.StickYaw); |
283 | LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",FC.StickGas, FC.StickYaw); |
| 284 | break; |
284 | break; |
| 285 | case 9: // RC poti controls from FC |
285 | case 9: // RC poti controls from FC |
| 286 | LCD_printfxy(0,0,"RC-Potis" ); |
286 | LCD_printfxy(0,0,"RC-Potis 1" ); |
| 287 | LCD_printfxy(0,1,"Po1:%3i Po2:%3i ",FC.Poti1, FC.Poti2); |
287 | LCD_printfxy(0,1,"Po1:%3i Po2:%3i ",FC.Poti[0], FC.Poti[1]); |
| 288 | LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti3, FC.Poti4); |
288 | LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti[2], FC.Poti[3]); |
| - | 289 | break; |
|
| - | 290 | case 10: // RC poti controls from FC |
|
| - | 291 | LCD_printfxy(0,0,"RC-Potis 2" ); |
|
| - | 292 | LCD_printfxy(0,1,"Po5:%3i Po6:%3i ",FC.Poti[4], FC.Poti[5]); |
|
| - | 293 | LCD_printfxy(0,2,"Po7:%3i Po8:%3i ",FC.Poti[6], FC.Poti[7]); |
|
| 289 | break; |
294 | break; |
| 290 | case 10: // attitude from FC |
295 | case 11: // attitude from FC |
| 291 | if(FromFlightCtrl.AngleNick < 0) sign = '-'; |
296 | if(FromFlightCtrl.AngleNick < 0) sign = '-'; |
| 292 | else sign = '+'; |
297 | else sign = '+'; |
| 293 | i1 = abs(FromFlightCtrl.AngleNick)/10; |
298 | i1 = abs(FromFlightCtrl.AngleNick)/10; |
| 294 | i2 = abs(FromFlightCtrl.AngleNick)%10; |
299 | i2 = abs(FromFlightCtrl.AngleNick)%10; |
| 295 | LCD_printfxy(0,0,"GyroNick:%c%03i.%01i", sign, i1, i2); |
300 | LCD_printfxy(0,0,"GyroNick:%c%03i.%01i", sign, i1, i2); |
| Line 307... | Line 312... | ||
| 307 | else sign = '+'; |
312 | else sign = '+'; |
| 308 | i1 = abs(FromFlightCtrl.AccRoll)/10; |
313 | i1 = abs(FromFlightCtrl.AccRoll)/10; |
| 309 | i2 = abs(FromFlightCtrl.AccRoll)%10; |
314 | i2 = abs(FromFlightCtrl.AccRoll)%10; |
| 310 | LCD_printfxy(0,3," AccRoll:%c%03i.%01i", sign, i1, i2); |
315 | LCD_printfxy(0,3," AccRoll:%c%03i.%01i", sign, i1, i2); |
| 311 | break; |
316 | break; |
| 312 | case 11: // gyros from FC |
317 | case 12: // gyros from FC |
| 313 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
318 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
| 314 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
319 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
| 315 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
320 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
| 316 | break; |
321 | break; |
| 317 | case 12: // Remote Control Level from FC |
322 | case 13: // Remote Control Level from FC |
| 318 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
323 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
| 319 | LCD_printfxy(0,1,"Ubat: %2i.%1i V", FC.UBat/10, FC.UBat%10); |
324 | LCD_printfxy(0,1,"Ubat: %2i.%1i V", FC.UBat/10, FC.UBat%10); |
| 320 | LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading); |
325 | LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading); |
| 321 | if(GeoMagDec < 0) sign = '-'; |
326 | if(GeoMagDec < 0) sign = '-'; |
| 322 | else sign = '+'; |
327 | else sign = '+'; |
| 323 | LCD_printfxy(0,3,"GeoMagDec: %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10); |
328 | LCD_printfxy(0,3,"GeoMagDec: %c%i.%1i", sign, abs(GeoMagDec)/10,abs(GeoMagDec)%10); |
| 324 | break; |
329 | break; |
| 325 | case 13: // User Parameter |
330 | case 14: // User Parameter |
| 326 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i",Parameter.User1,Parameter.User2); |
331 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i",Parameter.User1,Parameter.User2); |
| 327 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i",Parameter.User3,Parameter.User4); |
332 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i",Parameter.User3,Parameter.User4); |
| 328 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i",Parameter.User5,Parameter.User6); |
333 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i",Parameter.User5,Parameter.User6); |
| 329 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i",Parameter.User7,Parameter.User8); |
334 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i",Parameter.User7,Parameter.User8); |
| 330 | break; |
335 | break; |
| 331 | case 14: // MK3MAG |
336 | case 15: // MK3MAG |
| 332 | I2C1_SendCommand(I2C_CMD_READ_MAG); |
337 | I2C1_SendCommand(I2C_CMD_READ_MAG); |
| 333 | LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch); |
338 | LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch); |
| 334 | LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX); |
339 | LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX); |
| 335 | LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY); |
340 | LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY); |
| 336 | LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ); |
341 | LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ); |