633,12 → 633,22 |
set_beep( 25, 0xffff, BeepNormal ); // kurzer Bestaetigungs-Beep |
redraw = true; |
|
//#define OFFLINE |
#ifndef OFFLINE |
int retcode = GPSMouse_Connect(); // Abfrage der GPS-Daten zum testen Quick an Dirty ;-) |
if( retcode <= 0 ) |
{ |
return; |
} |
#endif |
|
/* // DEBUG |
NMEApos.lat = 520000000; |
NMEApos.lon = 0; |
Config.FM_Azimuth = 90; |
Config.FM_Distance = 10000; |
*/ |
|
while( true ) |
{ |
NMEApos.lat = NMEA.Latitude; |
655,44 → 665,50 |
redraw = false; |
} |
|
//################# |
//# DISTANCE TO TARGET |
//################# |
writex_gpspos( 1, 2, NMEApos.lat, MNORMAL, 0,0 ); // GPS-Maus: Latitude |
writex_gpspos(10, 2, NMEApos.lon, MNORMAL, 0,0 ); // GPS-Maus: Longitude |
|
//lcdx_printf_at_P( 0, 1, MNORMAL,0,0, PSTR("Distance: %3d Meter"), Config.FM_Distance ); |
followme_calculate_offset(Config.FM_Distance, Config.FM_Azimuth, &followMeOffset); |
|
//################# |
//# TARGET Azimuth |
//################# |
//lcdx_printf_at_P( 0, 2, MNORMAL, 0,0, PSTR(" Azimuth: %3d Grad"), Config.FM_Azimuth); |
// DEBUG |
writex_gpspos( 1, 6, (int32_t)Config.FM_Azimuth*100 , MNORMAL, 0, 0 ); |
writex_gpspos( 10, 6, (int32_t)Config.FM_Distance*100 , MNORMAL, 0, 0 ); |
writex_gpspos( 1, 7, (int32_t)followMeOffset.offset_lat*100 , MNORMAL, 0, 0 ); |
writex_gpspos( 10, 7, (int32_t)followMeOffset.offset_long*100 , MNORMAL, 0, 0 ); |
|
|
writex_gpspos( 1, 2, NMEApos.lat , MNORMAL,0,0 ); // GPS-Maus: Latitude |
writex_gpspos(10, 2, NMEApos.lon, MNORMAL, 0,0 ); // GPS-Maus: Longitude |
|
//followMeOffset.offset_lat = 10000; |
//followMeOffset.offset_long = 10000; |
|
followme_calculate_offset(Config.FM_Distance, Config.FM_Azimuth, &followMeOffset); |
followme_add_offset(&NMEApos, &NMEATarget, &followMeOffset); |
|
writex_gpspos( 1, 4, (int32_t)NMEATarget.lat , MNORMAL, 0,0 ); // Ziel Latitude |
writex_gpspos(10, 4, (int32_t)NMEATarget.lon , MNORMAL, 0,0 ); // Ziel Longitude |
writex_gpspos( 1, 4, (int32_t)NMEATarget.lat , MNORMAL, 0, 0 ); // Ziel Latitude |
writex_gpspos(10, 4, (int32_t)NMEATarget.lon , MNORMAL, 0, 0 ); // Ziel Longitude |
|
|
if( get_key_press(1 << KEY_ESC) ) |
{ |
#ifndef OFFLINE |
GPSMouse_Disconnect(); |
#endif |
break; |
} |
|
|
if( get_key_press(1 << KEY_ENTER) ) |
{ |
redraw = true; |
redraw = true; |
// break; |
} |
} |
|
if( get_key_press(1 << KEY_MINUS) ) |
{ |
Config.FM_Azimuth -= 10; |
redraw = true; |
} |
if( get_key_press(1 << KEY_PLUS) ) |
{ |
Config.FM_Azimuth += 10; |
redraw = true; |
} |
} |
} |
|
|
|