1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
|
/***********************************************/
/**
* @file grailCdr2StarCamera.cpp
*
* @brief read CDR GRAIL data.
*
* @author Beate Klinger
* @date 2013-01-22
*
*/
/***********************************************/
// Latex documentation
#define DOCSTRING docstring
static const char *docstring = R"(
This program converts orientation data measured by a star camera (SRF to CRF)
from the GRAIL SDS format into \file{instrument file (STARCAMERA)}{instrument}.
For further information see \program{GraceL1b2Accelerometer}.
)";
/***********************************************/
#include "programs/program.h"
#include "base/string.h"
#include "files/fileInstrument.h"
/***** CLASS ***********************************/
/** @brief read CDR GRAIL data.
* @ingroup programsConversionGroup */
class GrailCdr2StarCamera
{
void readFile(const FileName fileName, StarCameraArc &arc);
public:
void run(Config &config, Parallel::CommunicatorPtr comm);
};
GROOPS_REGISTER_PROGRAM(GrailCdr2StarCamera, SINGLEPROCESS, "read CDR GRAIL data", Conversion, Instrument)
/***********************************************/
void GrailCdr2StarCamera::run(Config &config, Parallel::CommunicatorPtr /*comm*/)
{
try
{
FileName outName;
std::vector<FileName> fileNames;
readConfig(config, "outputfileStarCamera", outName, Config::OPTIONAL, "", "");
readConfig(config, "inputfile", fileNames, Config::MUSTSET, "", "");
if(isCreateSchema(config)) return;
logStatus<<"read input files"<<Log::endl;
StarCameraArc arc;
for(auto &fileName : fileNames)
{
logStatus<<"read file <"<<fileName<<">"<<Log::endl;
readFile(fileName, arc);
}
logStatus<<"write data to <"<<outName.str()<<">"<<Log::endl;
InstrumentFile::write(outName, arc);
Arc::printStatistics(arc);
}
catch(std::exception &e)
{
GROOPS_RETHROW(e)
}
}
/***********************************************/
void GrailCdr2StarCamera::readFile(const FileName fileName, StarCameraArc &arc)
{
try
{
InFile file(fileName);
if(!file.good())
{
logWarning<<"cannot open file: "<<fileName.str()<<", continue..."<<Log::endl;
return;
}
file.exceptions(std::ios::badbit|std::ios::failbit);
// Header einlesen
UInt numberOfRecords = 0;
std::string line;
for(;;)
{
getline(file, line);
if(line.find("NUMBER OF DATA RECORDS")==0)
numberOfRecords = String::toInt(line.substr(31, 10));
// Header fertig ?
if(line.find("END OF HEADER")==0)
break;
}
// Eigentliche Daten einlesen
for(UInt i=0; i<numberOfRecords; i++)
{
std::string line;
try
{
getline(file, line);
}
catch(std::exception &/*e*/)
{
//logWarning<<std::endl<<e.what()<<" continue..."<<Log::endl;
break;
}
std::stringstream ss(line);
// time (TDB) >> receiver time, seconds past 12:00:00 noon 01-Jan-2000
Int32 seconds;
ss>>seconds;
StarCameraEpoch epoch;
epoch.time = mjd2time(51544.5) + seconds2time(seconds);
// satellite ID, SCA identification number
Byte AB;
Int SCA;
ss>>AB>>SCA;
// quaternions + formal error of quaternions
Vector q(4);
Double q_res;
ss>>q(0)>>q(1)>>q(2)>>q(3)>>q_res;
epoch.rotary = Rotary3d(q);
// data quality flags >> not defined yet
//Byte flag;
//ss>>flag;
arc.push_back(epoch);
}
}
catch(std::exception &e)
{
GROOPS_RETHROW(e)
}
}
/***********************************************/
|
