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