Subversion Repositories NaviCtrl

Rev

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

Rev 51 Rev 53
Line 148... Line 148...
148 
                                        LCD_printfxy(0,0,"Sats:%02d Fix:??  ", GPSData.NumOfSats);
 148 
                                        LCD_printfxy(0,0,"Sats:%02d Fix:??  ", GPSData.NumOfSats);
149 
                                        break;
 149 
                                        break;
150 
                                }
 150 
                                }
151 
                                if(GPSData.Position.Longitude < 0) sign = '-';
 151 
                                if(GPSData.Position.Longitude < 0) sign = '-';
152 
                                else sign = '+';
 152 
                                else sign = '+';
153 
                                i1 = abs(GPSData.Position.Longitude/10000000L);
 153 
                                i1 = abs(GPSData.Position.Longitude)/10000000L;
154 
                                i2 = abs(GPSData.Position.Longitude%10000000L);
 154 
                                i2 = abs(GPSData.Position.Longitude)%10000000L;
155 
                                LCD_printfxy(0,1,"Lon:%c%3ld.%07ld deg",sign, i1, i2);
 155 
                                LCD_printfxy(0,1,"Lon:%c%3ld.%07ld deg",sign, i1, i2);
156 
                                if(GPSData.Position.Latitude < 0) sign = '-';
 156 
                                if(GPSData.Position.Latitude < 0) sign = '-';
157 
                                else sign = '+';
 157 
                                else sign = '+';
158 
                                i1 = abs(GPSData.Position.Latitude/10000000L);
 158 
                                i1 = abs(GPSData.Position.Latitude)/10000000L;
159 
                                i2 = abs(GPSData.Position.Latitude%10000000L);
 159 
                                i2 = abs(GPSData.Position.Latitude)%10000000L;
160 
                                LCD_printfxy(0,2,"Lat:%c%3ld.%07ld deg",sign, i1, i2);
 160 
                                LCD_printfxy(0,2,"Lat:%c%3ld.%07ld deg",sign, i1, i2);
161 
                                if(GPSData.Position.Altitude < 0) sign = '-';
 161 
                                if(GPSData.Position.Altitude < 0) sign = '-';
162 
                                else sign = '+';
 162 
                                else sign = '+';
163 
                                i1 = abs(GPSData.Position.Altitude/1000L);
 163 
                                i1 = abs(GPSData.Position.Altitude)/1000L;
164 
                                i2 = abs(GPSData.Position.Altitude%1000L);
 164 
                                i2 = abs(GPSData.Position.Altitude)%1000L;
165 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",i1, i2);
 165 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",i1, i2);
166 
                        }
 166 
                        }
167 
                        break;
 167 
                        break;
168 
                case 2:
 168 
                case 2:
169 
                        if (GPSData.Status == INVALID)
 169 
                        if (GPSData.Status == INVALID)
Line 228... Line 228...
228 
                        }
 228 
                        }
229 
                        else
 229 
                        else
230 
                        {
 230 
                        {
231 
                                if(GPS_HomePosition.Longitude < 0) sign = '-';
 231 
                                if(GPS_HomePosition.Longitude < 0) sign = '-';
232 
                                else sign = '+';
 232 
                                else sign = '+';
233 
                                i1 = abs(GPS_HomePosition.Longitude/10000000L);
 233 
                                i1 = abs(GPS_HomePosition.Longitude)/10000000L;
234 
                                i2 = abs(GPS_HomePosition.Longitude%10000000L);
 234 
                                i2 = abs(GPS_HomePosition.Longitude)%10000000L;
235 
                                LCD_printfxy(0,1,"Lon: %c%3ld.%07ld deg",sign, i1, i2);
 235 
                                LCD_printfxy(0,1,"Lon: %c%3ld.%07ld deg",sign, i1, i2);
236 
                                if(GPS_HomePosition.Latitude < 0) sign = '-';
 236 
                                if(GPS_HomePosition.Latitude < 0) sign = '-';
237 
                                else sign = '+';
 237 
                                else sign = '+';
238 
                                i1 = abs(GPS_HomePosition.Latitude/10000000L);
 238 
                                i1 = abs(GPS_HomePosition.Latitude)/10000000L;
239 
                                i2 = abs(GPS_HomePosition.Latitude%10000000L);
 239 
                                i2 = abs(GPS_HomePosition.Latitude)%10000000L;
240 
                                LCD_printfxy(0,2,"Lat: %c%3ld.%07ld deg",sign, i1, i2);
 240 
                                LCD_printfxy(0,2,"Lat: %c%3ld.%07ld deg",sign, i1, i2);
241 
                                if(GPS_HomePosition.Altitude < 0) sign = '-';
 241 
                                if(GPS_HomePosition.Altitude < 0) sign = '-';
242 
                                else sign = '+';
 242 
                                else sign = '+';
243 
                                i1 = abs(GPS_HomePosition.Altitude/1000L);
 243 
                                i1 = abs(GPS_HomePosition.Altitude)/1000L;
244 
                                i2 = abs(GPS_HomePosition.Altitude%1000L);
 244 
                                i2 = abs(GPS_HomePosition.Altitude)%1000L;
245 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",sign, i1, i2);
 245 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",sign, i1, i2);
246 
                        }
 246 
                        }
247 
                        break;
 247 
                        break;
248 
                case 6: // RC stick controls from FC
 248 
                case 6: // RC stick controls from FC
249 
                        LCD_printfxy(0,0,"RC-Sticks" );
 249 
                        LCD_printfxy(0,0,"RC-Sticks" );