paregnrmc.cpp 2.4 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586
  1. #include "paregnrmc.h"
  2. #include <QDebug>
  3. PareGNRMC::PareGNRMC() {}
  4. bool PareGNRMC::verifyChecksum(const QString& sentence) {
  5. int index = sentence.indexOf('*');
  6. if (index == -1) {
  7. return false;
  8. }
  9. QString checksumStr = sentence.mid(index + 1);
  10. bool ok;
  11. int receivedChecksum = checksumStr.toInt(&ok, 16);
  12. if (!ok) {
  13. return false;
  14. }
  15. int calculatedChecksum = 0;
  16. for (int i = 1; i < index; ++i) {
  17. calculatedChecksum ^= sentence.at(i).toLatin1();
  18. }
  19. return calculatedChecksum == receivedChecksum;
  20. }
  21. RMCData PareGNRMC::parseRMC(const QString& input) {
  22. RMCData data;
  23. if (!input.startsWith("$GNRMC")) {
  24. data.isValid = false;
  25. return data;
  26. }
  27. QStringList sentences = input.split("\r\n");
  28. QString sentence = sentences.first();
  29. if (!verifyChecksum(sentence)) {
  30. data.isValid = false;
  31. return data;
  32. }
  33. QStringList fields = sentence.split(',');
  34. if (fields.size() < 13) {
  35. data.isValid = false;
  36. return data;
  37. }
  38. data.time = fields[1];
  39. data.isValid = (fields[2] == "A");
  40. if (data.isValid) {
  41. // 解析纬度
  42. QString latStr = fields[3];
  43. int latDeg = latStr.left(2).toInt();
  44. double latMin = latStr.mid(2).toDouble();
  45. data.latitude = latDeg + latMin / 60.0;
  46. data.latDirection = fields[4].at(0).toLatin1();
  47. // 解析经度
  48. QString lonStr = fields[5];
  49. int lonDeg = lonStr.left(3).toInt();
  50. double lonMin = lonStr.mid(3).toDouble();
  51. data.longitude = lonDeg + lonMin / 60.0;
  52. data.lonDirection = fields[6].at(0).toLatin1();
  53. data.speed = fields[7].toDouble();
  54. data.date = fields[9];
  55. }
  56. return data;
  57. }
  58. // 将 RMCData 转换为 QString
  59. QString PareGNRMC::rmcDataToString(const RMCData& data) {
  60. QString result;
  61. result += "Time: " + data.time + "\n";
  62. result += "Is Valid: " + QString(data.isValid ? "Yes" : "No") + "\n";
  63. if (data.isValid) {
  64. result += "Latitude: " + QString::number(data.latitude) + " " + data.latDirection + "\n";
  65. result += "Longitude: " + QString::number(data.longitude) + " " + data.lonDirection + "\n";
  66. } else {
  67. result += "Latitude: 未知\n";
  68. result += "Longitude: 未知\n";
  69. }
  70. result += "Speed: " + QString::number(data.speed) + "\n";
  71. result += "Date: " + data.date + "\n";
  72. return result;
  73. }