From f7a18ec4494b9c5c9ef3fd440bbf68ffc6425e18 Mon Sep 17 00:00:00 2001 From: yy1717 <fctom1215@outlook.com> Date: 星期四, 08 十二月 2022 15:40:56 +0800 Subject: [PATCH] 智慧驾培首次提交 --- lib/src/main/cpp/rtk_module/rtk.h | 33 +++++++++++++++++++++++++++++++++ 1 files changed, 33 insertions(+), 0 deletions(-) diff --git a/lib/src/main/cpp/rtk_module/rtk.h b/lib/src/main/cpp/rtk_module/rtk.h index ae52e8d..7d66f83 100644 --- a/lib/src/main/cpp/rtk_module/rtk.h +++ b/lib/src/main/cpp/rtk_module/rtk.h @@ -5,6 +5,10 @@ #ifndef RTKDRIVERTEST_RTK_H #define RTKDRIVERTEST_RTK_H +#include <string> +#include <sstream> +#include "../utils/num.h" + typedef struct { uint16_t gps_status; int YY; @@ -21,6 +25,21 @@ double altitude; double speed; double trackTure; + + std::string toString(void) { + std::stringstream sst; + + sst<<"GPS:"<<"qf="<<gps_status + <<" "<<2000+YY<<intw(MM, 2)<<intw(DD, 2)<<intw(hh,2)<<intw(mm, 2)<<intw(ss, 2)<<"."<<intw(mss, 2) + <<" satNum"<<satNum + <<" latitude="<<round(latitude, 6) + <<" longitude="<<round(longitude, 6) + <<" altitude="<<round(altitude, 3) + <<" speed="<<round(speed, 3) + <<" trackTure="<<round(trackTure, 3); + + return sst.str(); + } }gpsStatus_t; typedef struct { @@ -37,6 +56,20 @@ double roll; double x; double y; + + std::string toString(void) { + std::stringstream sst; + + sst<<"RTK:"<<"qf="<<qf + <<" "<<2000+YY<<intw(MM, 2)<<intw(DD, 2)<<intw(hh,2)<<intw(mm, 2)<<intw(ss, 2)<<"."<<intw(dss, 2) + <<" heading="<<round(heading, 3) + <<" pitch="<<round(pitch, 3) + <<" roll="<<round(roll, 3) + <<" x="<<round(x, 3) + <<" y="<<round(y, 3); + + return sst.str(); + } }rtk_info; void RtkCommModeSel(int mode); -- Gitblit v1.8.0