Subversion Repositories NaviCtrl

Rev

Rev 213 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 213 Rev 215
Line 242... Line 242...
242 
            LCD_printfxy(0,2,"    I-Limit: %3i", Parameter.NaviGpsILimit);
 242 
            LCD_printfxy(0,2,"    I-Limit: %3i", Parameter.NaviGpsILimit);
243 
                    LCD_printfxy(0,3,"    D-Limit: %3i", Parameter.NaviGpsDLimit);
 243 
                    LCD_printfxy(0,3,"    D-Limit: %3i", Parameter.NaviGpsDLimit);
244 
                        break;
 244 
                        break;
245 
                case 7:
 245 
                case 7:
246 
                        LCD_printfxy(0,0,"Home Position");
 246 
                        LCD_printfxy(0,0,"Home Position");
247 
                        if(GPS_HomePosition.Status == INVALID)
 247 
                        if(NaviData.HomePosition.Status == INVALID)
248 
                        {
 248 
                        {
249 
                                LCD_printfxy(0,1,"                     ");
 249 
                                LCD_printfxy(0,1,"                     ");
250 
                                LCD_printfxy(0,2,"    Is not set.      ");
 250 
                                LCD_printfxy(0,2,"    Is not set.      ");
251 
                                LCD_printfxy(0,3,"                     ");
 251 
                                LCD_printfxy(0,3,"                     ");
252 
                        }
 252 
                        }
253 
                        else
 253 
                        else
254 
                        {
 254 
                        {
255 
                                if(GPS_HomePosition.Longitude < 0) sign = '-';
 255 
                                if(NaviData.HomePosition.Longitude < 0) sign = '-';
256 
                                else sign = '+';
 256 
                                else sign = '+';
257 
                                i1 = abs(GPS_HomePosition.Longitude)/10000000L;
 257 
                                i1 = abs(NaviData.HomePosition.Longitude)/10000000L;
258 
                                i2 = abs(GPS_HomePosition.Longitude)%10000000L;
 258 
                                i2 = abs(NaviData.HomePosition.Longitude)%10000000L;
259 
                                LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
 259 
                                LCD_printfxy(0,1,"Lon:%c%03ld.%07ld deg",sign, i1, i2);
260 
                                if(GPS_HomePosition.Latitude < 0) sign = '-';
 260 
                                if(NaviData.HomePosition.Latitude < 0) sign = '-';
261 
                                else sign = '+';
 261 
                                else sign = '+';
262 
                                i1 = abs(GPS_HomePosition.Latitude)/10000000L;
 262 
                                i1 = abs(NaviData.HomePosition.Latitude)/10000000L;
263 
                                i2 = abs(GPS_HomePosition.Latitude)%10000000L;
 263 
                                i2 = abs(NaviData.HomePosition.Latitude)%10000000L;
264 
                                LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
 264 
                                LCD_printfxy(0,2,"Lat:%c%03ld.%07ld deg",sign, i1, i2);
265 
                                if(GPS_HomePosition.Altitude < 0) sign = '-';
 265 
                                if(NaviData.HomePosition.Altitude < 0) sign = '-';
266 
                                else sign = '+';
 266 
                                else sign = '+';
267 
                                i1 = abs(GPS_HomePosition.Altitude)/1000L;
 267 
                                i1 = abs(NaviData.HomePosition.Altitude)/1000L;
268 
                                i2 = abs(GPS_HomePosition.Altitude)%1000L;
 268 
                                i2 = abs(NaviData.HomePosition.Altitude)%1000L;
269 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
 269 
                                LCD_printfxy(0,3,"Alt:%c%04ld.%03ld m",sign, i1, i2);
270 
                        }
 270 
                        }
271 
                        break;
 271 
                        break;
272 
                case 8: // RC stick controls from FC
 272 
                case 8: // RC stick controls from FC
273 
                        LCD_printfxy(0,0,"RC-Sticks" );
 273 
                        LCD_printfxy(0,0,"RC-Sticks" );