214 lines
8.1 KiB
C
214 lines
8.1 KiB
C
|
/*------------------------------------------------------------------------------
|
||
|
|
* convkml.c : google earth kml converter
|
||
|
|
*
|
||
|
|
* Copyright (C) 2007-2017 by T.TAKASU, All rights reserved.
|
||
|
|
*
|
||
|
|
* references :
|
||
|
|
* [1] Open Geospatial Consortium Inc., OGC 07-147r2, OGC(R) KML, 2008-04-14
|
||
|
|
*
|
||
|
|
* version : $Revision: 1.1 $ $Date: 2008/07/17 21:48:06 $
|
||
|
|
* history : 2007/01/20 1.0 new
|
||
|
|
* 2007/03/15 1.1 modify color sequence
|
||
|
|
* 2007/04/03 1.2 add geodetic height option
|
||
|
|
* support input of NMEA GGA sentence
|
||
|
|
* delete altitude info for track
|
||
|
|
* add time stamp option
|
||
|
|
* separate readsol.c file
|
||
|
|
* 2009/01/19 1.3 fix bug on display mark with by-q-flag option
|
||
|
|
* 2010/05/10 1.4 support api readsolt() change
|
||
|
|
* 2010/08/14 1.5 fix bug on readsolt() (2.4.0_p3)
|
||
|
|
* 2017/06/10 1.6 support wild-card in input file
|
||
|
|
*-----------------------------------------------------------------------------*/
|
||
|
|
#include "rtklib.h"
|
||
|
|
|
||
|
|
/* constants -----------------------------------------------------------------*/
|
||
|
|
|
||
|
|
#define SIZP 0.2 /* mark size of rover positions */
|
||
|
|
#define SIZR 0.3 /* mark size of reference position */
|
||
|
|
#define TINT 60.0 /* time label interval (sec) */
|
||
|
|
|
||
|
|
static const char *head1="<?xml version=\"1.0\" encoding=\"UTF-8\"?>";
|
||
|
|
static const char *head2="<kml xmlns=\"http://earth.google.com/kml/2.1\">";
|
||
|
|
static const char *mark="http://maps.google.com/mapfiles/kml/pal2/icon18.png";
|
||
|
|
|
||
|
|
/* output track --------------------------------------------------------------*/
|
||
|
|
static void outtrack(FILE *f, const solbuf_t *solbuf, const char *color,
|
||
|
|
int outalt, int outtime)
|
||
|
|
{
|
||
|
|
double pos[3];
|
||
|
|
int i;
|
||
|
|
|
||
|
|
fprintf(f,"<Placemark>\n");
|
||
|
|
fprintf(f,"<name>Rover Track</name>\n");
|
||
|
|
fprintf(f,"<Style>\n");
|
||
|
|
fprintf(f,"<LineStyle>\n");
|
||
|
|
fprintf(f,"<color>%s</color>\n",color);
|
||
|
|
fprintf(f,"</LineStyle>\n");
|
||
|
|
fprintf(f,"</Style>\n");
|
||
|
|
fprintf(f,"<LineString>\n");
|
||
|
|
if (outalt) fprintf(f,"<altitudeMode>absolute</altitudeMode>\n");
|
||
|
|
fprintf(f,"<coordinates>\n");
|
||
|
|
for (i=0;i<solbuf->n;i++) {
|
||
|
|
ecef2pos(solbuf->data[i].rr,pos);
|
||
|
|
if (outalt==0) pos[2]=0.0;
|
||
|
|
else if (outalt==2) pos[2]-=geoidh(pos);
|
||
|
|
fprintf(f,"%13.9f,%12.9f,%5.3f\n",pos[1]*R2D,pos[0]*R2D,pos[2]);
|
||
|
|
}
|
||
|
|
fprintf(f,"</coordinates>\n");
|
||
|
|
fprintf(f,"</LineString>\n");
|
||
|
|
fprintf(f,"</Placemark>\n");
|
||
|
|
}
|
||
|
|
/* output point --------------------------------------------------------------*/
|
||
|
|
static void outpoint(FILE *fp, gtime_t time, const double *pos,
|
||
|
|
const char *label, int style, int outalt, int outtime)
|
||
|
|
{
|
||
|
|
double ep[6],alt=0.0;
|
||
|
|
char str[256]="";
|
||
|
|
|
||
|
|
fprintf(fp,"<Placemark>\n");
|
||
|
|
if (*label) fprintf(fp,"<name>%s</name>\n",label);
|
||
|
|
fprintf(fp,"<styleUrl>#P%d</styleUrl>\n",style);
|
||
|
|
if (outtime) {
|
||
|
|
if (outtime==2) time=gpst2utc(time);
|
||
|
|
else if (outtime==3) time=timeadd(gpst2utc(time),9*3600.0);
|
||
|
|
time2epoch(time,ep);
|
||
|
|
if (!*label&&fmod(ep[5]+0.005,TINT)<0.01) {
|
||
|
|
sprintf(str,"%02.0f:%02.0f",ep[3],ep[4]);
|
||
|
|
fprintf(fp,"<name>%s</name>\n",str);
|
||
|
|
}
|
||
|
|
sprintf(str,"%04.0f-%02.0f-%02.0fT%02.0f:%02.0f:%05.2fZ",
|
||
|
|
ep[0],ep[1],ep[2],ep[3],ep[4],ep[5]);
|
||
|
|
fprintf(fp,"<TimeStamp><when>%s</when></TimeStamp>\n",str);
|
||
|
|
}
|
||
|
|
fprintf(fp,"<Point>\n");
|
||
|
|
if (outalt) {
|
||
|
|
fprintf(fp,"<extrude>1</extrude>\n");
|
||
|
|
fprintf(fp,"<altitudeMode>absolute</altitudeMode>\n");
|
||
|
|
alt=pos[2]-(outalt==2?geoidh(pos):0.0);
|
||
|
|
}
|
||
|
|
fprintf(fp,"<coordinates>%13.9f,%12.9f,%5.3f</coordinates>\n",pos[1]*R2D,
|
||
|
|
pos[0]*R2D,alt);
|
||
|
|
fprintf(fp,"</Point>\n");
|
||
|
|
fprintf(fp,"</Placemark>\n");
|
||
|
|
}
|
||
|
|
/* save kml file -------------------------------------------------------------*/
|
||
|
|
static int savekml(const char *file, const solbuf_t *solbuf, int tcolor,
|
||
|
|
int pcolor, int outalt, int outtime)
|
||
|
|
{
|
||
|
|
FILE *fp;
|
||
|
|
double pos[3];
|
||
|
|
int i,qcolor[]={0,1,2,5,4,3,0};
|
||
|
|
char *color[]={
|
||
|
|
"ffffffff","ff008800","ff00aaff","ff0000ff","ff00ffff","ffff00ff"
|
||
|
|
};
|
||
|
|
if (!(fp=fopen(file,"w"))) {
|
||
|
|
fprintf(stderr,"file open error : %s\n",file);
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
fprintf(fp,"%s\n%s\n",head1,head2);
|
||
|
|
fprintf(fp,"<Document>\n");
|
||
|
|
for (i=0;i<6;i++) {
|
||
|
|
fprintf(fp,"<Style id=\"P%d\">\n",i);
|
||
|
|
fprintf(fp," <IconStyle>\n");
|
||
|
|
fprintf(fp," <color>%s</color>\n",color[i]);
|
||
|
|
fprintf(fp," <scale>%.1f</scale>\n",i==0?SIZR:SIZP);
|
||
|
|
fprintf(fp," <Icon><href>%s</href></Icon>\n",mark);
|
||
|
|
fprintf(fp," </IconStyle>\n");
|
||
|
|
fprintf(fp,"</Style>\n");
|
||
|
|
}
|
||
|
|
if (tcolor>0) {
|
||
|
|
outtrack(fp,solbuf,color[tcolor-1],outalt,outtime);
|
||
|
|
}
|
||
|
|
if (pcolor>0) {
|
||
|
|
fprintf(fp,"<Folder>\n");
|
||
|
|
fprintf(fp," <name>Rover Position</name>\n");
|
||
|
|
for (i=0;i<solbuf->n;i++) {
|
||
|
|
ecef2pos(solbuf->data[i].rr,pos);
|
||
|
|
outpoint(fp,solbuf->data[i].time,pos,"",
|
||
|
|
pcolor==5?qcolor[solbuf->data[i].stat]:pcolor-1,outalt,outtime);
|
||
|
|
}
|
||
|
|
fprintf(fp,"</Folder>\n");
|
||
|
|
}
|
||
|
|
if (norm(solbuf->rb,3)>0.0) {
|
||
|
|
ecef2pos(solbuf->rb,pos);
|
||
|
|
outpoint(fp,solbuf->data[0].time,pos,"Reference Position",0,outalt,0);
|
||
|
|
}
|
||
|
|
fprintf(fp,"</Document>\n");
|
||
|
|
fprintf(fp,"</kml>\n");
|
||
|
|
fclose(fp);
|
||
|
|
return 1;
|
||
|
|
}
|
||
|
|
/* convert to google earth kml file --------------------------------------------
|
||
|
|
* convert solutions to google earth kml file
|
||
|
|
* args : char *infile I input solutions file (wild-card (*) is expanded)
|
||
|
|
* char *outfile I output google earth kml file ("":<infile>.kml)
|
||
|
|
* gtime_t ts,te I start/end time (gpst)
|
||
|
|
* int tint I time interval (s) (0.0:all)
|
||
|
|
* int qflg I quality flag (0:all)
|
||
|
|
* double *offset I add offset {east,north,up} (m)
|
||
|
|
* int tcolor I track color
|
||
|
|
* (0:none,1:white,2:green,3:orange,4:red,5:yellow)
|
||
|
|
* int pcolor I point color
|
||
|
|
* (0:none,1:white,2:green,3:orange,4:red,5:by qflag)
|
||
|
|
* int outalt I output altitude (0:off,1:elipsoidal,2:geodetic)
|
||
|
|
* int outtime I output time (0:off,1:gpst,2:utc,3:jst)
|
||
|
|
* return : status (0:ok,-1:file read,-2:file format,-3:no data,-4:file write)
|
||
|
|
* notes : see ref [1] for google earth kml file format
|
||
|
|
*-----------------------------------------------------------------------------*/
|
||
|
|
extern int convkml(const char *infile, const char *outfile, gtime_t ts,
|
||
|
|
gtime_t te, double tint, int qflg, double *offset,
|
||
|
|
int tcolor, int pcolor, int outalt, int outtime)
|
||
|
|
{
|
||
|
|
solbuf_t solbuf={0};
|
||
|
|
double rr[3]={0},pos[3],dr[3];
|
||
|
|
int i,j,nfile,stat;
|
||
|
|
char *p,file[1024],*files[MAXEXFILE]={0};
|
||
|
|
|
||
|
|
trace(3,"convkml : infile=%s outfile=%s\n",infile,outfile);
|
||
|
|
|
||
|
|
/* expand wild-card of infile */
|
||
|
|
for (i=0;i<MAXEXFILE;i++) {
|
||
|
|
if (!(files[i]=(char *)malloc(1024))) {
|
||
|
|
for (i--;i>=0;i--) free(files[i]);
|
||
|
|
return -4;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
if ((nfile=expath(infile,files,MAXEXFILE))<=0) {
|
||
|
|
for (i=0;i<MAXEXFILE;i++) free(files[i]);
|
||
|
|
return -3;
|
||
|
|
}
|
||
|
|
if (!*outfile) {
|
||
|
|
if ((p=strrchr(infile,'.'))) {
|
||
|
|
strncpy(file,infile,p-infile);
|
||
|
|
strcpy(file+(p-infile),".kml");
|
||
|
|
}
|
||
|
|
else sprintf(file,"%s.kml",infile);
|
||
|
|
}
|
||
|
|
else strcpy(file,outfile);
|
||
|
|
|
||
|
|
/* read solution file */
|
||
|
|
stat=readsolt(files,nfile,ts,te,tint,qflg,&solbuf);
|
||
|
|
|
||
|
|
for (i=0;i<MAXEXFILE;i++) free(files[i]);
|
||
|
|
|
||
|
|
if (!stat) {
|
||
|
|
return -1;
|
||
|
|
}
|
||
|
|
/* mean position */
|
||
|
|
for (i=0;i<3;i++) {
|
||
|
|
for (j=0;j<solbuf.n;j++) rr[i]+=solbuf.data[j].rr[i];
|
||
|
|
rr[i]/=solbuf.n;
|
||
|
|
}
|
||
|
|
/* add offset */
|
||
|
|
ecef2pos(rr,pos);
|
||
|
|
enu2ecef(pos,offset,dr);
|
||
|
|
for (i=0;i<solbuf.n;i++) {
|
||
|
|
for (j=0;j<3;j++) solbuf.data[i].rr[j]+=dr[j];
|
||
|
|
}
|
||
|
|
if (norm(solbuf.rb,3)>0.0) {
|
||
|
|
for (i=0;i<3;i++) solbuf.rb[i]+=dr[i];
|
||
|
|
}
|
||
|
|
/* save kml file */
|
||
|
|
return savekml(file,&solbuf,tcolor,pcolor,outalt,outtime)?0:-4;
|
||
|
|
}
|