[Bugfix][T106][bug-view-111]Fix the issue of GNSS frame dropping after setting the frequency to 5Hz
Only Configure: Yes
Affected branch: master
Affected module: GNSS
Is it affected on both ZXIC and MTK: only ZXIC
Self-test: yes
Doc Update: No
Change-Id: I55c25bf7a1e29a854fabcd7451d97db10215e11e
diff --git a/cap/zx297520v3/src/lynq/lib/liblynq-qser-gnss/src/mbtk_gnss.cpp b/cap/zx297520v3/src/lynq/lib/liblynq-qser-gnss/src/mbtk_gnss.cpp
index 04ab964..dace72f 100755
--- a/cap/zx297520v3/src/lynq/lib/liblynq-qser-gnss/src/mbtk_gnss.cpp
+++ b/cap/zx297520v3/src/lynq/lib/liblynq-qser-gnss/src/mbtk_gnss.cpp
@@ -715,11 +715,18 @@
memset(buf,0,sizeof(result));
}
- if((data[0] == '$' || data[0] == '#') &&
- data[data_len - 1] == '\n' &&
- data_len < 128) {
- process_gnss_callback(handle, data, data_len);
+ int i = 0;
+ for (i = 0; i < data_len; i++)
+ {
+ if (data[i] == '$')
+ break;
}
+ if (i >= data_len)
+ return -1;
+
+ data += i;
+ data_len -= i;
+ process_gnss_callback(handle, data, data_len);
return 1;
}