common: Restart NMEA message parsing when a '$' character is seen.

The GPS module sometimes sends incomplete NMEA messages such as this:
  $GP$GGA...*
This changeset makes it so we'd only parse the second, complete message
in that example.

diff --git a/src/common/gps.rs b/src/common/gps.rs
index b9fcbc3f23d9a732676082fbc3cccac4d2535310..b0539173272bbe5b5a0fc833deb8eb8b4899f278 100644 (file)
--- a/src/common/gps.rs
+++ b/src/common/gps.rs
@@ -209,13 +209,17 @@ impl Gps {
         let hexdigits = b"0123456789abcdef";
 
         while let Some(received) = try_read() {
         let hexdigits = b"0123456789abcdef";
 
         while let Some(received) = try_read() {

+            if received == b'$' {
+                self.state = ParseState::InPacket;
+                self.offset = 0;
+                self.checksum = 0x00;
+
+                continue;
+            }
+

             match self.state {
                 ParseState::Start => {
             match self.state {
                 ParseState::Start => {

-                    if received == b'$' {
-                        self.state = ParseState::InPacket;
-                        self.offset = 0;
-                        self.checksum = 0x00;
-                    }
+                    // Empty.

                 },
                 ParseState::InPacket => {
                     if received == b'*' {
                 },
                 ParseState::InPacket => {
                     if received == b'*' {