Subversion Repositories NaviCtrl

Rev

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

Rev 41 Rev 51
Line 94... Line 94...
94 
/************************************/
 94 
/************************************/
95 
// Display with 20 characters in 4 lines
 95 
// Display with 20 characters in 4 lines
96 
void LCD_PrintMenu(void)
 96 
void LCD_PrintMenu(void)
97 
{
 97 
{
98 
        s32 i1,i2;
 98 
        s32 i1,i2;
- 
 
 99 
        u8 sign;
99 
        if(RemoteKeys & KEY1) { if(MenuItem) MenuItem--; else MenuItem = MaxMenuItem;}
 100 
        if(RemoteKeys & KEY1) { if(MenuItem) MenuItem--; else MenuItem = MaxMenuItem;}
100 
        if(RemoteKeys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
 101 
        if(RemoteKeys & KEY2) { if(MenuItem == MaxMenuItem) MenuItem = 0; else MenuItem++;}
101 
        if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuItem = 0;
 102 
        if((RemoteKeys & KEY1) && (RemoteKeys & KEY2)) MenuItem = 0;
Line 102... Line 103...
102 
 
 103 
 
Line 145... Line 146...
145 
                                        break;
 146 
                                        break;
146 
                                default:
 147 
                                default:
147 
                                        LCD_printfxy(0,0,"Sats:%02d Fix:??  ", GPSData.NumOfSats);
 148 
                                        LCD_printfxy(0,0,"Sats:%02d Fix:??  ", GPSData.NumOfSats);
148 
                                        break;
 149 
                                        break;
149 
                                }
 150 
                                }
- 
 
 151 
                                if(GPSData.Position.Longitude < 0) sign = '-';
- 
 
 152 
                                else sign = '+';
150 
                                i1 = GPSData.Position.Longitude/10000000L;
 153 
                                i1 = abs(GPSData.Position.Longitude/10000000L);
151 
                                i2 = abs(GPSData.Position.Longitude%10000000L);
 154 
                                i2 = abs(GPSData.Position.Longitude%10000000L);
152 
                                LCD_printfxy(0,1,"Lon:%+3ld.%07ld deg",i1, i2);
 155 
                                LCD_printfxy(0,1,"Lon:%c%3ld.%07ld deg",sign, i1, i2);
- 
 
 156 
                                if(GPSData.Position.Latitude < 0) sign = '-';
- 
 
 157 
                                else sign = '+';
153 
                                i1 = GPSData.Position.Latitude/10000000L;
 158 
                                i1 = abs(GPSData.Position.Latitude/10000000L);
154 
                                i2 = abs(GPSData.Position.Latitude%10000000L);
 159 
                                i2 = abs(GPSData.Position.Latitude%10000000L);
155 
                                LCD_printfxy(0,2,"Lat:%+3ld.%07ld deg",i1, i2);
 160 
                                LCD_printfxy(0,2,"Lat:%c%3ld.%07ld deg",sign, i1, i2);
- 
 
 161 
                                if(GPSData.Position.Altitude < 0) sign = '-';
- 
 
 162 
                                else sign = '+';
156 
                                i1 = GPSData.Position.Altitude/1000L;
 163 
                                i1 = abs(GPSData.Position.Altitude/1000L);
157 
                                i2 = abs(GPSData.Position.Altitude%1000L);
 164 
                                i2 = abs(GPSData.Position.Altitude%1000L);
158 
                                LCD_printfxy(0,3,"Alt:%4ld.%03ld m",i1, i2);
 165 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",i1, i2);
159 
                        }
 166 
                        }
160 
                        break;
 167 
                        break;
161 
                case 2:
 168 
                case 2:
162 
                        if (GPSData.Status == INVALID)
 169 
                        if (GPSData.Status == INVALID)
163 
                        {
 170 
                        {
Line 219... Line 226...
219 
                                LCD_printfxy(0,2,"    Is not set.      ");
 226 
                                LCD_printfxy(0,2,"    Is not set.      ");
220 
                                LCD_printfxy(0,3,"                     ");
 227 
                                LCD_printfxy(0,3,"                     ");
221 
                        }
 228 
                        }
222 
                        else
 229 
                        else
223 
                        {
 230 
                        {
- 
 
 231 
                                if(GPS_HomePosition.Longitude < 0) sign = '-';
- 
 
 232 
                                else sign = '+';
224 
                                i1 = GPS_HomePosition.Longitude/10000000L;
 233 
                                i1 = abs(GPS_HomePosition.Longitude/10000000L);
225 
                                i2 = abs(GPS_HomePosition.Longitude%10000000L);
 234 
                                i2 = abs(GPS_HomePosition.Longitude%10000000L);
226 
                                LCD_printfxy(0,1,"Lon: %3ld.%07ld deg",i1, i2);
 235 
                                LCD_printfxy(0,1,"Lon: %c%3ld.%07ld deg",sign, i1, i2);
- 
 
 236 
                                if(GPS_HomePosition.Latitude < 0) sign = '-';
- 
 
 237 
                                else sign = '+';
227 
                                i1 = GPS_HomePosition.Latitude/10000000L;
 238 
                                i1 = abs(GPS_HomePosition.Latitude/10000000L);
228 
                                i2 = abs(GPS_HomePosition.Latitude%10000000L);
 239 
                                i2 = abs(GPS_HomePosition.Latitude%10000000L);
229 
                                LCD_printfxy(0,2,"Lat: %3ld.%07ld deg",i1, i2);
 240 
                                LCD_printfxy(0,2,"Lat: %c%3ld.%07ld deg",sign, i1, i2);
- 
 
 241 
                                if(GPS_HomePosition.Altitude < 0) sign = '-';
- 
 
 242 
                                else sign = '+';
230 
                                i1 = GPS_HomePosition.Altitude/1000L;
 243 
                                i1 = abs(GPS_HomePosition.Altitude/1000L);
231 
                                i2 = abs(GPS_HomePosition.Altitude%1000L);
 244 
                                i2 = abs(GPS_HomePosition.Altitude%1000L);
232 
                                LCD_printfxy(0,3,"Alt:%4ld.%03ld m",i1, i2);
 245 
                                LCD_printfxy(0,3,"Alt:%c%4ld.%03ld m",sign, i1, i2);
233 
                        }
 246 
                        }
234 
                        break;
 247 
                        break;
235 
                case 6: // RC stick controls from FC
 248 
                case 6: // RC stick controls from FC
236 
                        LCD_printfxy(0,0,"RC-Sticks" );
 249 
                        LCD_printfxy(0,0,"RC-Sticks" );
237 
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);
 250 
            LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",FC.StickNick, FC.StickRoll);