Subversion Repositories Projects

Rev

Blame | Last modification | View Log | RSS feed

//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++

//############################################################################
//# 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
//                    }
//                }
//
//          }