158 lines
5.2 KiB
C++
158 lines
5.2 KiB
C++
/******************** (C) COPYRIGHT 2022 Geek************************************
|
|
* File Name : PDR_KmlSupport.cpp
|
|
* Current Version : V1.0
|
|
* Author : logzhan
|
|
* Date of Issued : 2022.09.15
|
|
* Comments : PDR Google地图KML格式输出
|
|
********************************************************************************/
|
|
#include "KmlSupport.h"
|
|
#include <vector>
|
|
|
|
using namespace PDR;
|
|
|
|
/**----------------------------------------------------------------------
|
|
* Function : KmlWrite
|
|
* Description : 将pdr算法输出的gps和pdr轨迹写为kml形式
|
|
* path : kml文件的输出文件路径
|
|
* name : kml文件主体名称
|
|
* postfix ：在主体名称后面添加的后缀，用于区分类型或者版本
|
|
* Date : 2020/11/1 logzhan
|
|
*---------------------------------------------------------------------**/
|
|
void KmlWrite(string path, string name, string postfix, vector<KmlTracks_t>& gps,
|
|
vector<KmlTracks_t>& pdr)
|
|
{
|
|
string pdrColor = "ff0000ff";
|
|
string gpsColor = "ff00ffff";
|
|
|
|
if (path == "") {
|
|
return;
|
|
}
|
|
|
|
string kmlPath = path + name + postfix + ".kml";
|
|
string kmlName = name + postfix;
|
|
FILE* fid = NULL;
|
|
|
|
fopen_s(&fid,kmlPath.c_str(), "w");
|
|
|
|
if (fid == NULL) {
|
|
return;
|
|
}
|
|
|
|
fprintf(fid, "<?xml version=\"1.0\" encoding=\"utf-8\"?>\n");
|
|
fprintf(fid, "<kml xmlns=\"http://www.opengis.net/kml/2.2\">\n");
|
|
fprintf(fid, "\t<Document>\n");
|
|
fprintf(fid, "\t\t<name>%s</name>\n", kmlName.c_str());
|
|
|
|
fprintf(fid, "\t\t<Folder id=\"ID1\">\n");
|
|
fprintf(fid, "\t\t<name>GPS Fixs</name>\n");
|
|
|
|
// 写gps结果
|
|
for (int i = 0; i < gps.size(); i++) {
|
|
fprintf(fid, "\t\t<Placemark>\n");
|
|
fprintf(fid, "\t\t\t<Style>\n");
|
|
fprintf(fid, "\t\t\t\t<IconStyle>\n");
|
|
fprintf(fid, "\t\t\t\t\t<Icon>\n");
|
|
fprintf(fid, "\t\t\t\t\t\t<href>%s</href>\n",
|
|
"http://maps.google.com/mapfiles/kml/shapes/arrow.png");
|
|
fprintf(fid, "\t\t\t\t\t</Icon>\n");
|
|
fprintf(fid, "\t\t\t\t\t<scale>%.2f</scale>\n", 0.4);
|
|
|
|
// 描述轨迹方向信息
|
|
fprintf(fid, "\t\t\t\t\t<heading>%.7f</heading>\n", gps[i].heading);
|
|
fprintf(fid, "\t\t\t\t\t<color>%s</color>\n", gpsColor.c_str());
|
|
fprintf(fid, "\t\t\t\t</IconStyle>\n");
|
|
fprintf(fid, "\t\t\t</Style>\n");
|
|
|
|
// 写入时间信息
|
|
//double h, m, s;
|
|
//pdr_utc2hms(gps[i].utcTime, &h, &m, &s);
|
|
//fprintf(fid, "\t\t\t<TimeStamp>\n");
|
|
//fprintf(fid, "\t\t\t\t<when>2021-01-22T%s:%s:%s</when>\n", time2str(h).c_str(),
|
|
// time2str(m).c_str(), time2str(s).c_str());
|
|
//fprintf(fid, "\t\t\t</TimeStamp>\n");
|
|
|
|
// 写入描述信息
|
|
fprintf(fid, "\t\t\t<description>\n");
|
|
fprintf(fid, "\t\t\t\t<![CDATA[\n");
|
|
fprintf(fid, "\t\t\t\t<dl>\n");
|
|
fprintf(fid, "\t\t\t\t<dd>East : 0.0 (m/s)</dd>\n");
|
|
fprintf(fid, "\t\t\t\t<dd>HDOP : %.2f (m/s)</dd>\n",
|
|
gps[i].hdop);
|
|
fprintf(fid, "\t\t\t\t<dd>accuracy : %.2f (m)</dd>\n",
|
|
gps[i].accuracy);
|
|
fprintf(fid, "\t\t\t\t<dd>speed : %.2f (m/s)</dd>\n",
|
|
gps[i].vel);
|
|
fprintf(fid, "\t\t\t\t<dd>Heading : %.2f (degrees) </dd>\n",
|
|
gps[i].heading);
|
|
fprintf(fid, "\t\t\t\t</dl><hr>]]>\n");
|
|
fprintf(fid, "\t\t\t</description>\n");
|
|
// 写入坐标信息
|
|
fprintf(fid, "\t\t\t<Point>\n");
|
|
fprintf(fid, "\t\t\t\t<coordinates>%.10f,%.10f</coordinates>\n",
|
|
gps[i].lon,
|
|
gps[i].lat);
|
|
fprintf(fid, "\t\t\t</Point>\n");
|
|
fprintf(fid, "\t\t</Placemark>\n");
|
|
}
|
|
fprintf(fid, "\t\t</Folder>\n");
|
|
|
|
fprintf(fid, "\t\t<Folder id=\"ID2\">\n");
|
|
fprintf(fid, "\t\t<name>PDR Fixs</name>\n");
|
|
// 写pdr结果
|
|
for (int i = 0; i < pdr.size(); i++) {
|
|
fprintf(fid, "\t\t<Placemark>\n");
|
|
fprintf(fid, "\t\t\t<Style>\n");
|
|
fprintf(fid, "\t\t\t\t<IconStyle>\n");
|
|
fprintf(fid, "\t\t\t\t\t<Icon>\n");
|
|
fprintf(fid, "\t\t\t\t\t\t<href>%s</href>\n",
|
|
"http://maps.google.com/mapfiles/kml/shapes/arrow.png");
|
|
fprintf(fid, "\t\t\t\t\t</Icon>\n");
|
|
fprintf(fid, "\t\t\t\t\t<scale>%.2f</scale>\n", 0.4);
|
|
fprintf(fid, "\t\t\t\t\t<heading>%.7f</heading>\n",
|
|
pdr[i].heading);
|
|
|
|
fprintf(fid, "\t\t\t\t\t<color>%s</color>\n", pdrColor.c_str());
|
|
fprintf(fid, "\t\t\t\t</IconStyle>\n");
|
|
fprintf(fid, "\t\t\t</Style>\n");
|
|
|
|
// 写入时间信息
|
|
//double h, m, s;
|
|
//pdr_utc2hms(resTracks.pdrTrack[i].time, &h, &m, &s);
|
|
//fprintf(fid, "\t\t\t<TimeStamp>\n");
|
|
//fprintf(fid, "\t\t\t\t<when>2021-01-22T%s:%s:%s</when>\n", time2str(h).c_str(),
|
|
// time2str(m).c_str(), time2str(s).c_str());
|
|
//fprintf(fid, "\t\t\t</TimeStamp>\n");
|
|
|
|
// description
|
|
fprintf(fid, "\t\t\t<description>\n");
|
|
fprintf(fid, "\t\t\t\t<![CDATA[\n");
|
|
fprintf(fid, "\t\t\t\t<dl>\n");
|
|
fprintf(fid, "\t\t\t\t<dd>East : 0.0 (m/s)</dd>\n");
|
|
fprintf(fid, "\t\t\t\t<dd>HDOP : %.2f (m/s)</dd>\n",
|
|
pdr[i].hdop);
|
|
|
|
//fprintf(fid, "\t\t\t\t<dd>MOTION TYPE : %s (m/s)</dd>\n",
|
|
// motionType2Str(resTracks.pdrTrack[i].motionType));
|
|
|
|
fprintf(fid, "\t\t\t\t<dd>accuracy : %.2f (m/s)</dd>\n",
|
|
pdr[i].accuracy);
|
|
fprintf(fid, "\t\t\t\t<dd>Heading : %.2f (degrees) </dd>\n",
|
|
pdr[i].heading);
|
|
fprintf(fid, "\t\t\t\t</dl><hr>]]>\n");
|
|
fprintf(fid, "\t\t\t</description>\n");
|
|
|
|
fprintf(fid, "\t\t\t<Point>\n");
|
|
fprintf(fid, "\t\t\t\t<coordinates>%.10f,%.10f</coordinates>\n",
|
|
pdr[i].lon,
|
|
pdr[i].lat);
|
|
fprintf(fid, "\t\t\t</Point>\n");
|
|
fprintf(fid, "\t\t</Placemark>\n");
|
|
}
|
|
fprintf(fid, "\t\t</Folder>\n");
|
|
|
|
fprintf(fid, "\t</Document>\n");
|
|
fprintf(fid, "</kml>\n");
|
|
|
|
fclose(fid);
|
|
}
|