1 files changed, 15 insertions, 19 deletions

diff --git a/noncore/net/wellenreiter/gui/gps.cpp b/noncore/net/wellenreiter/gui/gps.cpp
index b814427..5b1b4a4 100644
--- a/noncore/net/wellenreiter/gui/gps.cpp
+++ b/noncore/net/wellenreiter/gui/gps.cpp
@@ -47,2 +47,4 @@ GpsLocation GPS::position() const
     char buf[256];
+    double lat = -111.0;
+    double lon = -111.0;
 
@@ -55,15 +57,15 @@ GpsLocation GPS::position() const
         if ( numAvail )
-        {
-            QTextStream stream( _socket );
-
-            QString str;
-            stream.readRawBytes( &buf[0], 7 );
-            float lat = -111;
-            stream >> lat;
-            stream.skipWhiteSpace();
-            float lon = -111;
-            stream >> lon;
-            stream.readRawBytes( &buf[0], 200 ); // read and discard the stuff until EOF
-
-            return GpsLocation( lat, lon );
+        {                     
+            int numRead = _socket->readBlock( &buf[0], sizeof buf );
+            int numScan = sscanf( &buf[0], "GPSD,P=%lg %lg", &lat, &lon);
+            
+            if ( numRead < 7 || numScan != 2 )
+            {
+                qDebug( "GPS read %d bytes succeeded, invalid response: '%s'", numRead, &buf[0] );
+                return GpsLocation( -111, -111 );
+            }
+            else
+            {
+                return GpsLocation( lat, lon );
+            }
         }
@@ -125,7 +127 @@ QString GpsLocation::dmsPosition() const
 }
-
-
-
-
-
-