Rev 55 | Rev 61 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed
Rev 55 | Rev 59 | ||
---|---|---|---|
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 = 12; |
73 | u8 MaxMenuItem = 14; |
74 | u8 RemoteKeys = 0; |
74 | u8 RemoteKeys = 0; |
75 | 75 | ||
Line 210... | Line 210... | ||
210 | LCD_printfxy(0,2,"Date: %02i/%02i/%04i",SystemTime.Month, SystemTime.Day, SystemTime.Year); |
210 | LCD_printfxy(0,2,"Date: %02i/%02i/%04i",SystemTime.Month, SystemTime.Day, SystemTime.Year); |
211 | LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec); |
211 | LCD_printfxy(0,3,"Time: %02i:%02i:%02i.%03i", SystemTime.Hour, SystemTime.Min, SystemTime.Sec, SystemTime.mSec); |
Line 212... | Line 212... | ||
212 | 212 | ||
213 | } |
213 | } |
214 | break; |
214 | break; |
215 | case 4: // Navi Params from FC |
215 | case 4: // Navi Params 1 from FC |
216 | LCD_printfxy(0,0,"NaviMode: %3i" , Parameter.NaviGpsModeControl); |
216 | LCD_printfxy(0,0,"NaviMode: %3i" , Parameter.NaviGpsModeControl); |
217 | LCD_printfxy(0,1,"G :%3i P :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP); |
217 | LCD_printfxy(0,1,"G :%3i P :%3i ",Parameter.NaviGpsGain, Parameter.NaviGpsP); |
218 | LCD_printfxy(0,2,"I :%3i D :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD); |
218 | LCD_printfxy(0,2,"I :%3i D :%3i ",Parameter.NaviGpsI, Parameter.NaviGpsD); |
219 | LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat); |
219 | LCD_printfxy(0,3,"ACC:%3i SAT:%3i ",Parameter.NaviGpsACC, Parameter.NaviGpsMinSat); |
- | 220 | break; |
|
- | 221 | case 5: // Navi Params 2 from FC |
|
- | 222 | LCD_printfxy(0,0,"Stick TS: %3i", Parameter.NaviStickThreshold); |
|
- | 223 | LCD_printfxy(0,1,"MaxRadius: %3i m", Parameter.NaviOperatingRadius); |
|
- | 224 | LCD_printfxy(0,2,"WindCorr: %3i", Parameter.NaviWindCorrection); |
|
- | 225 | LCD_printfxy(0,3,"SpeedComp: %3i", Parameter.NaviSpeedCompensation); |
|
- | 226 | break; |
|
- | 227 | case 6: // Navi Params 3 from FC |
|
- | 228 | LCD_printfxy(0,0,"Angle-Limit: %3i", Parameter.NaviAngleLimitation); |
|
- | 229 | LCD_printfxy(0,1," P-Limit: %3i", Parameter.NaviGpsPLimit); |
|
- | 230 | LCD_printfxy(0,2," I-Limit: %3i", Parameter.NaviGpsILimit); |
|
- | 231 | LCD_printfxy(0,3," D-Limit: %3i", Parameter.NaviGpsDLimit); |
|
220 | break; |
232 | break; |
221 | case 5: |
233 | case 7: |
222 | LCD_printfxy(0,0,"Home Position"); |
234 | LCD_printfxy(0,0,"Home Position"); |
223 | if(GPS_HomePosition.Status == INVALID) |
235 | if(GPS_HomePosition.Status == INVALID) |
224 | { |
236 | { |
225 | LCD_printfxy(0,1," "); |
237 | LCD_printfxy(0,1," "); |
Line 243... | Line 255... | ||
243 | i1 = abs(GPS_HomePosition.Altitude)/1000L; |
255 | i1 = abs(GPS_HomePosition.Altitude)/1000L; |
244 | i2 = abs(GPS_HomePosition.Altitude)%1000L; |
256 | i2 = abs(GPS_HomePosition.Altitude)%1000L; |
245 | LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2); |
257 | LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2); |
246 | } |
258 | } |
247 | break; |
259 | break; |
248 | case 6: // RC stick controls from FC |
260 | case 8: // RC stick controls from FC |
249 | LCD_printfxy(0,0,"RC-Sticks" ); |
261 | LCD_printfxy(0,0,"RC-Sticks" ); |
250 | LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",FC.StickNick, FC.StickRoll); |
262 | LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",FC.StickNick, FC.StickRoll); |
251 | LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",FC.StickGas, FC.StickYaw); |
263 | LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",FC.StickGas, FC.StickYaw); |
252 | break; |
264 | break; |
253 | case 7: // RC poti controls from FC |
265 | case 9: // RC poti controls from FC |
254 | LCD_printfxy(0,0,"RC-Potis" ); |
266 | LCD_printfxy(0,0,"RC-Potis" ); |
255 | LCD_printfxy(0,1,"Po1:%3i Po2:%3i ",FC.Poti1, FC.Poti2); |
267 | LCD_printfxy(0,1,"Po1:%3i Po2:%3i ",FC.Poti1, FC.Poti2); |
256 | LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti3, FC.Poti4); |
268 | LCD_printfxy(0,2,"Po3:%3i Po4:%3i ",FC.Poti3, FC.Poti4); |
257 | break; |
269 | break; |
258 | case 8: // attitude from FC |
270 | case 10: // attitude from FC |
259 | LCD_printfxy(0,0,"IntNick: %5i", FromFlightCtrl.IntegralNick); |
271 | LCD_printfxy(0,0,"IntNick: %5i", FromFlightCtrl.IntegralNick); |
260 | LCD_printfxy(0,1,"IntRoll: %5i", FromFlightCtrl.IntegralRoll); |
272 | LCD_printfxy(0,1,"IntRoll: %5i", FromFlightCtrl.IntegralRoll); |
261 | LCD_printfxy(0,2,"AccNick: %5i", FromFlightCtrl.AccNick); |
273 | LCD_printfxy(0,2,"AccNick: %5i", FromFlightCtrl.AccNick); |
262 | LCD_printfxy(0,3,"AccRoll: %5i", FromFlightCtrl.AccRoll); |
274 | LCD_printfxy(0,3,"AccRoll: %5i", FromFlightCtrl.AccRoll); |
263 | break; |
275 | break; |
264 | case 9: // gyros from FC |
276 | case 11: // gyros from FC |
265 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
277 | LCD_printfxy(0,0,"GyroNick: %4i", FromFlightCtrl.GyroNick); |
266 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
278 | LCD_printfxy(0,1,"GyroRoll: %4i", FromFlightCtrl.GyroRoll); |
267 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
279 | LCD_printfxy(0,2,"GyroYaw: %4i", FromFlightCtrl.GyroYaw); |
268 | break; |
280 | break; |
269 | case 10: // Remote Control Level from FC |
281 | case 12: // Remote Control Level from FC |
270 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
282 | LCD_printfxy(0,0,"RC-Level: %3i", FC.RC_Quality); |
271 | LCD_printfxy(0,1,"Ubat: %3i", FC.UBat); |
283 | LCD_printfxy(0,1,"Ubat: %3i.%i V", FC.UBat/10, FC.UBat%10); |
272 | LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading); |
284 | LCD_printfxy(0,2,"CompHeading: %3i", I2C_Heading.Heading); |
273 | LCD_printfxy(0,3,"GyroHeading: %3i", FromFlightCtrl.GyroHeading); |
285 | LCD_printfxy(0,3,"GyroHeading: %3i", FromFlightCtrl.GyroHeading); |
274 | break; |
286 | break; |
275 | case 11: // User Parameter |
287 | case 13: // User Parameter |
276 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i ",Parameter.User1,Parameter.User2); |
288 | LCD_printfxy(0,0,"UP1:%3i UP2:%3i ",Parameter.User1,Parameter.User2); |
277 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i ",Parameter.User3,Parameter.User4); |
289 | LCD_printfxy(0,1,"UP3:%3i UP4:%3i ",Parameter.User3,Parameter.User4); |
278 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i ",Parameter.User5,Parameter.User6); |
290 | LCD_printfxy(0,2,"UP5:%3i UP6:%3i ",Parameter.User5,Parameter.User6); |
279 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i ",Parameter.User7,Parameter.User8); |
291 | LCD_printfxy(0,3,"UP7:%3i UP8:%3i ",Parameter.User7,Parameter.User8); |
280 | break; |
292 | break; |
281 | case 12: // MK3MAG |
293 | case 14: // MK3MAG |
282 | I2C1_SendCommand(I2C_CMD_READ_MAG); |
294 | I2C1_SendCommand(I2C_CMD_READ_MAG); |
283 | LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch); |
295 | LCD_printfxy(0,0,"MK3MAG V%i.%i%c",MK3MAG_Version.Major, MK3MAG_Version.Minor, 'a'+ MK3MAG_Version.Patch); |
284 | LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX); |
296 | LCD_printfxy(0,1,"MagX: %4i ",I2C_Mag.MagX); |
285 | LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY); |
297 | LCD_printfxy(0,2,"MagY: %4i ",I2C_Mag.MagY); |
286 | LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ); |
298 | LCD_printfxy(0,3,"MagZ: %4i ",I2C_Mag.MagZ); |