Subversion Repositories NaviCtrl

Rev

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