| 0,0 → 1,532 |
|---|
| //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| //++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++ |
| |
| //############################################################################ |
| //# HISTORY gpsmouse.c |
| //# |
| //# 30.07.2015 CB |
| //# - add: Anzeige von CRC Fehlern im NMEA Datensatz in GPSMouse_ShowData |
| //# |
| //# 28.07.2015 CB |
| //# - fix: Überprüfung von führenden 00 in der MAC-Adresse der BT Maus abgeschaltet |
| //# |
| //# 28.06.2014 OG |
| //# - fix: GPSMouse_ShowData() - wenn BT-Datenverlust dann immer GPSMouse_Disconnect() |
| //# auch wenn waitsatfix Modus aktiv ist |
| //# - fix: GPSMouse_ShowData() - Rueckgabe von 0 wenn Verbindung bereits vorhanden war |
| //# und dabei aber ein Verbindungsverlust zur BT GPS-Maus auftrat |
| //# |
| //# 27.06.2014 OG |
| //# - chg: GPSMouse_Disconnect() - Anzeige von BT-Datenverlust optimiert |
| //# - chg: GPSMouse_ShowData() - nach GPSMouse_Connect ein clear_key_all() eingefuegt |
| //# |
| //# 24.06.2014 OG |
| //# - add: GPSMouse_Connect(), GPSMouse_Disconnect() |
| //# |
| //# 23.06.2014 OG |
| //# - chg: GPSMouse_ShowData() - neue Parameter und Return-Codes fuer |
| //# hoehere Flexibilitaet |
| //# |
| //# 22.06.2014 OG - NEU |
| //# ehemals BT_ShowGPSData() in setup.c |
| //############################################################################ |
| |
| #include "../cpu.h" |
| #include <avr/io.h> |
| #include <avr/interrupt.h> |
| #include <avr/pgmspace.h> |
| #include <string.h> |
| #include <util/delay.h> |
| |
| #include "../main.h" |
| #include "../lcd/lcd.h" |
| #include "../setup/setup.h" |
| #include "../eeprom/eeprom.h" |
| #include "../lipo/lipo.h" |
| #include "../timer/timer.h" |
| #include "../bluetooth/fifo.h" |
| #include "../bluetooth/bluetooth.h" |
| #include "../uart/uart1.h" |
| #include "../utils/menuctrl.h" |
| #include "../utils/xutils.h" |
| #include "../pkt/pkt.h" |
| #include "../messages.h" |
| //#include "../gps/gps_nmea.h" |
| #include "../avr-nmea-gps-library/nmea.h" |
| #include "../gps/gpsmouse.h" |
| |
| |
| static const char STR_FIX0[] PROGMEM = " no"; |
| static const char STR_FIX1[] PROGMEM = " GPS"; |
| static const char STR_FIX2[] PROGMEM = "DGPS"; |
| static const char STR_FIX6[] PROGMEM = "esti"; |
| static const char STR_FIX[] PROGMEM = " ---"; |
| |
| |
| |
| |
| |
| //-------------------------------------------------------------- |
| // retcode = GPSMouse_Connect() |
| // |
| // RUECKGABE: |
| // -2: kein BTM222 eingebaut |
| // -1: keine GPS Maus konfiguriert |
| // 0: Fehler bei connect, kein connect durchgeführt (evtl. GPS Maus nicht eingeschaltet) |
| // 1: verbunden |
| //-------------------------------------------------------------- |
| int8_t GPSMouse_Connect( void ) |
| { |
| uint8_t status; |
| |
| if( !BT_CheckBTM222() ) |
| { |
| // PKT_Message_P( text, error, timeout, beep, clearscreen) |
| PKT_Message_P( strGet(STR_NOBTM222), true, 1000, true, true); // 1000 = max. 10 Sekunden anzeigen; "kein BTM222 vorh." |
| return -2; // -2: kein BTM222 eingebaut |
| } |
| |
| // deaktiviert, MAC Adressen von Handys haben keine 00 in der MAC-Adresse |
| // if( (Config.gps_UsedMac[5] == '0') || (Config.gps_UsedMac[6] == '0') ) |
| // { |
| // PKT_Message_P( text, error, timeout, beep, clearscreen) |
| // PKT_Message_P( strGet(STR_NOGPSMOUSE), true, 1000, true, true); // 1000 = max. 10 Sekunden anzeigen; "keine GPS-Maus!" |
| // return -1; // -1: keine GPS Maus konfiguriert |
| // } |
| |
| |
| //-------------------- |
| // verbinde BT GPS-Maus |
| //-------------------- |
| PKT_Title( Config.gps_UsedDevName, true, true); // PKT_Title( text, lShowLipo, clearscreen ) |
| |
| lcdx_printp_center( 2, strGet(STR_GPSMOUSECONNECT), MNORMAL, 0,1); // "suche GPS-Maus" |
| |
| PKT_Gauge_Begin( 0 ); // Gauge: 0 = Default fuer y verwenden |
| |
| set_BTOn(); |
| |
| if( Config.BTIsSlave ) |
| { |
| bt_downlink_init(); |
| } |
| |
| status = bt_connect( Config.gps_UsedMac ); |
| |
| uart1_flush(); |
| fifo_clear(&in_fifo); |
| |
| UART1_receiveNMEA = true; // Uartflag setzen zur Erkennung der NMEA Datensätze |
| |
| PKT_Gauge_End(); // Gauge: Ende |
| |
| if( !status ) // keine Verbindung zum BT-Device |
| { |
| set_BTOff(); |
| |
| // PKT_Message_P( text, error, timeout, beep, clearscreen) |
| PKT_Message_P( strGet(STR_GPSMOUSECONNECTION), true, 1000, true, true); // 1000 = max. 10 Sekunden anzeigen; "GPS-Maus Verbindung" |
| return 0; // 0: Fehler bei connect, kein connect durchgeführt (evtl. GPS Maus nicht eingeschaltet) |
| } |
| |
| return 1; // 1 = ok, Verbindung steht |
| } |
| |
| |
| |
| //-------------------------------------------------------------- |
| // GPSMouse_Disconnect() |
| //-------------------------------------------------------------- |
| void GPSMouse_Disconnect( void ) |
| { |
| PKT_Title( Config.gps_UsedDevName, true, true); //PKT_Title( text, lShowLipo, clearscreen ) |
| |
| //--------------------- |
| // GPS beenden |
| //--------------------- |
| UART1_receiveNMEA = false; |
| if( !receiveNMEA ) // ggf. anders implementieren, z.B. via Parameter; aber erstmal geht's auch so |
| { |
| //lcdx_cls_row( y, mode, yoffs ) |
| lcdx_cls_row( 7, MINVERSX, 0 ); |
| lcdx_printp_center( 7, strGet(STR_BT_LOSTDATA), MINVERSX, 0,0); // "BT Datenverlust" |
| set_beep( 600, 0xffff, BeepNormal); |
| } |
| |
| lcdx_printp_center( 2, strGet(STR_GPSMOUSEDISCONNECT), MNORMAL, 0,1); // "trenne GPS-Maus" |
| |
| PKT_Gauge_Begin( 0 ); // Gauge: 0 = Default fuer y verwenden |
| |
| receiveNMEA = false; // Uartflag zurücksetzen, es kommen keine NMEA Datensätze mehr |
| |
| if (!bt_disconnect()); |
| { |
| // lcdx_printp_center( 2, PSTR("Error on disconnect"), MNORMAL, 0,1); // Fehler beim Disconncet aufgetreten |
| // _delay_ms(2000); // 09.08.2015 cebra, muss noch untersucht werden, ist aber jetzt kein Problem |
| } |
| |
| set_BTOff(); |
| |
| PKT_Gauge_End(); // Gauge: Ende |
| } |
| |
| |
| |
| //-------------------------------------------------------------- |
| // retcode = GPSMouse_ShowData( mode, waitsatfix ) |
| // |
| // zeigt GPS-Daten der aktuellen BT-Maus an |
| // |
| // PARAMETER: |
| // show: |
| // was soll in der 2. Zeile angezeigt werden |
| // GPSMOUSE_SHOW_TIME || GPSMOUSE_SHOW_WAITSATFIX |
| // |
| // waitsatifix: |
| // 0 = Verbindungsaufbau; Daten anzeigen und beenden der |
| // BT-Verbindung (fuer setup.c) |
| // n = Zeit (via timer) die nach einem erfolgreichen Satfix gewartet wird bis |
| // GPSMouse_ShowData() beendet wird - die Verbindung zur GPS-Maus bleibt erhalten |
| // und kann weiterverwendet werden! (z.B. in followme.c) |
| // |
| // RUECKGABE: |
| // -2: kein BTM222 eingebaut |
| // -1: keine GPS Maus konfiguriert |
| // 0: Fehler bei connect, kein connect durchgeführt (evtl. GPS Maus nicht eingeschaltet) |
| // 1: connect zur GPS Maus ok, Benutzer hat Anzeige beenden |
| // 2: connect zur GPS Maus ok, Satix hat Anzeige beendet |
| // |
| // zusammengefasst: |
| // >0 : Ok |
| // <=0: Fehler |
| //-------------------------------------------------------------- |
| int8_t GPSMouse_ShowData( uint8_t show, uint16_t waitsatfix ) |
| { |
| uint8_t redraw = true; |
| uint8_t state_posfix = 0; |
| const char *pStr; |
| int8_t yoffs; |
| int8_t retcode; |
| |
| |
| |
| //-------------------- |
| // BT GPS-Maus verbinden |
| //-------------------- |
| retcode = GPSMouse_Connect(); |
| if( retcode <= 0 ) |
| { |
| return retcode; |
| } |
| timer_nmea_timeout = NMEA_TIMEOUT; // Timeout Timer setzen |
| clear_key_all(); |
| |
| |
| |
| //--------------------- |
| // zeige GPS-Daten |
| //--------------------- |
| |
| receiveNMEA = true; |
| |
| |
| do |
| { |
| //------------------------- |
| // Screen redraw |
| //------------------------- |
| if( redraw ) |
| { |
| PKT_Title( Config.gps_UsedDevName, true, true); //PKT_Title( text, lShowLipo, clearscreen ) |
| |
| if( show == GPSMOUSE_SHOW_TIME ) // Zeile 2: GPS-Zeit |
| { |
| lcdx_printp_at( 6, 1, PSTR("["), MNORMAL, -1,2); // Mitte: GPS Time |
| lcdx_printp_at(15, 1, PSTR("]"), MNORMAL, -2,2); // .. |
| lcd_line( 0, 13, 34, 13, 1); // .. |
| lcd_line(92, 13, 127, 13, 1); // .. |
| } |
| |
| if( show == GPSMOUSE_SHOW_WAITSATFIX ) // Zeile 2: "warte auf Satfix..." |
| { |
| yoffs = 1; |
| lcdx_cls_row( 1, MINVERS, yoffs); |
| lcdx_printp_center( 1, strGet(STR_WAITSATFIX), MINVERS, 0,yoffs); // "warte auf Satfix..." |
| } |
| |
| // yoffs = 1; |
| // lcdx_cls_row( 1, MINVERS, yoffs); |
| // lcdx_printp_center( 1,strGet(STR_WAITNMEA), MINVERS, 0,yoffs); // "warte auf NMEA..." |
| |
| lcdx_printp_at( 0, 2, PSTR("Fix:") , MNORMAL, 0,3); // Links; Fix |
| lcdx_printp_at( 0, 3, PSTR("Sat:") , MNORMAL, 0,3); // Links; Sat |
| lcdx_printp_at( 0, 4, PSTR("Alt:") , MNORMAL, 0,3); // Links; Alt |
| |
| lcdx_printp_at(11, 2, PSTR("RCnt:"), MNORMAL, 0,3); // Rechts: RCnt - Zaehler empfangener GPGGA Datenpakete |
| lcdx_printp_at(11, 3, PSTR("CErr:"), MNORMAL, 0,3); // Rechts: RErr - Zaehler fehlerhafte NMEA Pakete |
| lcdx_printp_at(11, 4, PSTR("HDOP:"), MNORMAL, 0,3); // Rechts: HDOP |
| |
| lcdx_cls_row( 5, MINVERS, 4); // Hintergrund invers |
| lcdx_printp_at( 1, 5, strGet(START_LASTPOS1), MINVERS, 0,4); // "Breitengr. Längengr." |
| |
| lcd_rect( 0, (4*8)+11, 127, (2*8)+4, 1); // Rahmen |
| |
| redraw = false; |
| } |
| |
| |
| //------------------------- |
| // PKT-LiPo anzeigen |
| //------------------------- |
| show_Lipo(); |
| |
| |
| //------------------------- |
| // PKT-Update geht hier nicht... |
| // wegen der Hardware-Verbindung |
| //------------------------- |
| //if( PKT_CtrlHook() ) |
| //{ |
| // redraw = true; |
| //} |
| |
| //------------------------- |
| //------------------------- |
| |
| if(NMEA_isdataready()) // NMEA Daten vorhanden? |
| { |
| |
| if( show == GPSMOUSE_SHOW_TIME ) |
| { |
| lcdx_print_at(7, 1, (uint8_t *)NMEA.Time, MNORMAL, -2,2); // Mitte: GPS Time |
| } |
| |
| //-------------- |
| // Sat-Fix |
| //-------------- |
| //writex_ndigit_number_u( 6, 2, NMEA.SatFix , 2,0, MNORMAL, 0,3); // Links: Fix (als Zahl) |
| switch( NMEA.SatFix ) |
| { |
| case 0: pStr = STR_FIX0; break; // kein Sat-Fix! |
| case 1: pStr = STR_FIX1; break; // GPS - Fix: OK |
| case 2: pStr = STR_FIX2; break; // DGPS - Fix: OK |
| case 6: pStr = STR_FIX6; break; // Estimated - wird hier als nicht Ok angesehen weil nicht klar was es bedeutet |
| default: pStr = 0; // Sat-Fix Code unbekannt! |
| lcdx_printf_at_P( 4, 2, MNORMAL, 1,3, PSTR(" ? %d"), NMEA.SatFix); // -> Zahl wird angezeigt - ggf. recherchieren was da bedeutet (Fix ok oder nicht) |
| break; |
| } |
| |
| if( pStr ) |
| { |
| lcdx_printf_at_P( 4, 2, MNORMAL, 1,3, PSTR("%4S"), pStr); // GPS Fix als String ausgeben |
| } |
| |
| if( NMEA.SatFix==1 || NMEA.SatFix==2 ) // Sat-Fix OK => einen Haken anzeigen |
| lcdx_putc( 8, 2, SYMBOL_CHECK, MNORMAL, 2,3 ); |
| else |
| lcdx_putc( 8, 2, ' ', MNORMAL, 2,3 ); |
| |
| |
| //-------------- |
| // Sat-Anzahl |
| //-------------- |
| writex_ndigit_number_u( 6, 3, NMEA.SatsInUse, 2,0, MNORMAL, 1,3); // Links: Sat-Anzahl |
| if( NMEA.SatsInUse >= GPSMOUSE_MINSAT ) // Haken angezeigt wenn MINSAT ok |
| lcdx_putc( 8, 3, SYMBOL_CHECK, MNORMAL, 2,3 ); |
| else |
| lcdx_putc( 8, 3, ' ', MNORMAL, 2,3 ); |
| |
| |
| //-------------- |
| // Altitude |
| //-------------- |
| lcdx_printf_at_P( 4, 4, MNORMAL, 1,3, PSTR("%4.1d"), NMEA.Altitude); // Links: Altitude |
| |
| |
| //-------------- |
| // empfangene GPGGA Datenpakete |
| //-------------- |
| lcdx_printf_at_P(16, 2, MNORMAL, 0,3, PSTR("%5ld"), NMEA.Counter ); // Rechts: Anzahl empfangener NMEA GPGGA-Pakete |
| |
| |
| //-------------- |
| // NMEA CRC Fehler |
| //-------------- |
| lcdx_printf_at_P(16, 3, MNORMAL, 0,3, PSTR("%5ld"), NMEA_getCRCerror() ); // Rechts: Anzahl CRC Fehler im NMEA GPGGA-Pakete |
| // lcdx_printf_at( 15, 3, mode, 0, 3, "%3.5ld", (uint32_t)NMEA_getBearing()); |
| // writex_ndigit_number_u_10th(15, 3, NMEA_getBearing(), 4,0, MNORMAL, 0,3); |
| |
| //-------------- |
| // HDOP |
| //-------------- |
| if( NMEA.HDOP == 0 ) // Rechts:: HDOP |
| lcdx_printp_at(16, 4, PSTR(" ---"), MNORMAL, 0,3); |
| else |
| writex_ndigit_number_u_10th(16, 4, NMEA.HDOP, 4,0, MNORMAL, 0,3); |
| |
| |
| //-------------- |
| // Lat / Lon |
| //-------------- |
| writex_gpspos( 1, 6, NMEA.Latitude , MNORMAL, 0,6 ); // unten links: Latitude |
| writex_gpspos(12, 6, NMEA.Longitude, MNORMAL, 0,6 ); // unten rechts: Longitude |
| |
| |
| //-------------- |
| //-------------- |
| if( waitsatfix > 0 ) |
| { |
| if( (NMEA.SatFix==1 || NMEA.SatFix==2) && (state_posfix==0) ) |
| { |
| state_posfix = 1; |
| timer = waitsatfix; // Verzoegerung bzgl. Exit (z.B. 600 = 6 Sekunden) |
| } |
| |
| if( (NMEA.SatFix!=1 && NMEA.SatFix!=2) && (state_posfix==1) && (timer!=0) ) |
| { |
| state_posfix = 0; |
| } |
| |
| if( (NMEA.SatFix==1 || NMEA.SatFix==2) && (state_posfix==1) && (timer==0) ) |
| { |
| clear_key_all(); |
| return 2; // 2: connect zur GPS Maus ok, Satix hat Anzeige beendet |
| } |
| } |
| |
| } |
| |
| if (timer_nmea_timeout == 0) receiveNMEA = false; |
| |
| } while( !get_key_press(1 << KEY_ESC) && receiveNMEA ); |
| |
| |
| |
| //--------------------- |
| // GPS beenden |
| //--------------------- |
| if( (waitsatfix == 0) || !receiveNMEA ) |
| { |
| |
| GPSMouse_Disconnect(); |
| } |
| |
| clear_key_all(); |
| return (receiveNMEA ? 1 : 0); // 1: connect zur GPS Maus ok, Benutzer hat Anzeige beenden |
| } |
| |
| |
| // save, Anzeige der Daten im Format der neuen NMEA Routinen, nach Umbau auf NMEA Structur nicht mehr notwendig |
| // { |
| // |
| // |
| // if( show == GPSMOUSE_SHOW_TIME ) |
| // { |
| //// lcdx_print_at(7, 1, (uint8_t *)NMEA.Time, MNORMAL, -2,2); // Mitte: GPS Time |
| // |
| // writex_ndigit_number_u( 7, 1, NMEA_getHour(), 2,0, MNORMAL, -2,2); |
| // lcdx_printp_at( 9, 1, PSTR(":") , MNORMAL, -2,2); |
| // writex_ndigit_number_u( 10, 1, NMEA_getMinute(), 2,0, MNORMAL, -2,2); |
| // lcdx_printp_at( 12, 1, PSTR(":") , MNORMAL, -2,2); |
| // writex_ndigit_number_u( 13, 1, NMEA_getSecond(), 2,0, MNORMAL, -2,2); |
| // |
| // } |
| // |
| // //-------------- |
| // // Sat-Fix |
| // //-------------- |
| // //writex_ndigit_number_u( 6, 2, NMEA.SatFix , 2,0, MNORMAL, 0,3); // Links: Fix (als Zahl) |
| // switch( NMEA_getGPSfix() ) |
| // { |
| // case 0: pStr = STR_FIX0; break; // kein Sat-Fix! |
| // case 1: pStr = STR_FIX1; break; // GPS - Fix: OK |
| // case 2: pStr = STR_FIX2; break; // DGPS - Fix: OK |
| // case 6: pStr = STR_FIX6; break; // Estimated - wird hier als nicht Ok angesehen weil nicht klar was es bedeutet |
| // default: pStr = 0; // Sat-Fix Code unbekannt! |
| // lcdx_printf_at_P( 4, 2, MNORMAL, 1,3, PSTR(" ? %d"), NMEA_getGPSfix()); // -> Zahl wird angezeigt - ggf. recherchieren was da bedeutet (Fix ok oder nicht) |
| // break; |
| // } |
| // |
| // if( pStr ) |
| // { |
| // lcdx_printf_at_P( 4, 2, MNORMAL, 1,3, PSTR("%4S"), pStr); // GPS Fix als String ausgeben |
| // } |
| // |
| // if( NMEA_getGPSfix()==1 || NMEA_getGPSfix()==2 ) // Sat-Fix OK => einen Haken anzeigen |
| // lcdx_putc( 8, 2, SYMBOL_CHECK, MNORMAL, 2,3 ); |
| // else |
| // lcdx_putc( 8, 2, ' ', MNORMAL, 2,3 ); |
| // |
| // |
| // //-------------- |
| // // Sat-Anzahl |
| // //-------------- |
| // writex_ndigit_number_u( 6, 3, NMEA_getSatellites(), 2,0, MNORMAL, 1,3); // Links: Sat-Anzahl |
| // if( NMEA_getSatellites() >= GPSMOUSE_MINSAT ) // Haken angezeigt wenn MINSAT ok |
| // lcdx_putc( 8, 3, SYMBOL_CHECK, MNORMAL, 2,3 ); |
| // else |
| // lcdx_putc( 8, 3, ' ', MNORMAL, 2,3 ); |
| // |
| // |
| // //-------------- |
| // // Altitude |
| // //-------------- |
| // lcdx_printf_at_P( 4, 4, MNORMAL, 1,3, PSTR("%4.1d"), NMEA_getAltitude()); // Links: Altitude |
| // |
| // |
| // //-------------- |
| // // empfangene GPGGA Datenpakete |
| // //-------------- |
| // lcdx_printf_at_P(16, 2, MNORMAL, 0,3, PSTR("%5ld"), NMEA_getNMEAcounter() ); // Rechts: Anzahl empfangener NMEA GPGGA-Pakete |
| // |
| // |
| // //-------------- |
| // // NMEA CRC Fehler |
| // //-------------- |
| // lcdx_printf_at_P(16, 3, MNORMAL, 0,3, PSTR("%5ld"), NMEA_getCRCerror() ); // Rechts: Anzahl empfangener NMEA GPGGA-Pakete |
| // |
| //// writex_ndigit_number_u(1, 5, UART1_GPGGA , 4,0, MNORMAL, 0,3); |
| //// writex_ndigit_number_u(5, 5, bt_overrun , 4,0, MNORMAL, 0,3); |
| //// writex_ndigit_number_u(10, 5, bt_bufferoverflow , 4,0, MNORMAL, 0,3); |
| // |
| // |
| // //-------------- |
| // // HDOP |
| // //-------------- |
| // if(NMEA_getHDOP() == 0 ) // Rechts:: HDOP |
| // lcdx_printp_at(16, 4, PSTR(" ---"), MNORMAL, 0,3); |
| // else |
| // writex_ndigit_number_u_10th(16, 4, NMEA_getHDOP(), 4,0, MNORMAL, 0,3); |
| // |
| // |
| // //-------------- |
| // // Lat / Lon |
| // //-------------- |
| // writex_gpspos( 1, 6, NMEA_getLatitude() , MNORMAL, 0,6 ); // unten links: Latitude |
| // writex_gpspos(12, 6, NMEA_getLongitude(), MNORMAL, 0,6 ); // unten rechts: Longitude |
| // |
| // |
| // //-------------- |
| // //-------------- |
| // if( waitsatfix > 0 ) |
| // { |
| // if( (NMEA_getGPSfix()==1 || NMEA_getGPSfix()==2) && (state_posfix==0) ) |
| // { |
| // state_posfix = 1; |
| // timer = waitsatfix; // Verzoegerung bzgl. Exit (z.B. 600 = 6 Sekunden) |
| // } |
| // |
| // if( (NMEA_getGPSfix()!=1 && NMEA_getGPSfix()!=2) && (state_posfix==1) && (timer!=0) ) |
| // { |
| // state_posfix = 0; |
| // } |
| // |
| // if( (NMEA_getGPSfix()==1 || NMEA_getGPSfix()==2) && (state_posfix==1) && (timer==0) ) |
| // { |
| // clear_key_all(); |
| // return 2; // 2: connect zur GPS Maus ok, Satix hat Anzeige beendet |
| // } |
| // } |
| // |
| // } |
| |
| Property changes: |
|---|
| Added: svn:mime-type |
|---|
| +text/plain |
|---|
| \ No newline at end of property |
|---|