1
0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2025-06-26 07:02:59 +00:00

Code cleaning

git-svn-id: https://svn.code.sf.net/p/gnss-sdr/code/trunk@263 64b25241-fba3-4117-9849-534c7e92360d
This commit is contained in:
Carles Fernandez 2012-10-28 11:38:50 +00:00
parent ae4a867249
commit 9b62455366
9 changed files with 1131 additions and 1165 deletions

View File

@ -56,53 +56,38 @@ gps_l1_ca_make_pvt_cc(unsigned int n_channels, gr_msg_queue_sptr queue, bool dum
*/ */
class gps_l1_ca_pvt_cc : public gr_block class gps_l1_ca_pvt_cc : public gr_block
{ {
private: private:
friend gps_l1_ca_pvt_cc_sptr friend gps_l1_ca_pvt_cc_sptr
gps_l1_ca_make_pvt_cc(unsigned int nchannels, gr_msg_queue_sptr queue, bool dump, std::string dump_filename, int averaging_depth, bool flag_averaging, int output_rate_ms, int display_rate_ms, bool flag_nmea_tty_port, std::string nmea_dump_filename, std::string nmea_dump_devname); gps_l1_ca_make_pvt_cc(unsigned int nchannels, gr_msg_queue_sptr queue, bool dump, std::string dump_filename, int averaging_depth, bool flag_averaging, int output_rate_ms, int display_rate_ms, bool flag_nmea_tty_port, std::string nmea_dump_filename, std::string nmea_dump_devname);
gps_l1_ca_pvt_cc(unsigned int nchannels, gr_msg_queue_sptr queue, bool dump, std::string dump_filename, int averaging_depth, bool flag_averaging, int output_rate_ms, int display_rate_ms, bool flag_nmea_tty_port, std::string nmea_dump_filename, std::string nmea_dump_devname); gps_l1_ca_pvt_cc(unsigned int nchannels, gr_msg_queue_sptr queue, bool dump, std::string dump_filename, int averaging_depth, bool flag_averaging, int output_rate_ms, int display_rate_ms, bool flag_nmea_tty_port, std::string nmea_dump_filename, std::string nmea_dump_devname);
gr_msg_queue_sptr d_queue; gr_msg_queue_sptr d_queue;
bool d_dump; bool d_dump;
bool b_rinex_header_writen; bool b_rinex_header_writen;
Rinex_Printer *rp; Rinex_Printer *rp;
unsigned int d_nchannels; unsigned int d_nchannels;
std::string d_dump_filename; std::string d_dump_filename;
std::ofstream d_dump_file; std::ofstream d_dump_file;
int d_averaging_depth; int d_averaging_depth;
bool d_flag_averaging; bool d_flag_averaging;
int d_output_rate_ms; int d_output_rate_ms;
int d_display_rate_ms; int d_display_rate_ms;
long unsigned int d_sample_counter; long unsigned int d_sample_counter;
Kml_Printer d_kml_dump; Kml_Printer d_kml_dump;
Nmea_Printer *d_nmea_printer; Nmea_Printer *d_nmea_printer;
concurrent_queue<Gps_Navigation_Message> *d_nav_queue; // Navigation ephemeris queue concurrent_queue<Gps_Navigation_Message> *d_nav_queue; // Navigation ephemeris queue
Gps_Navigation_Message d_last_nav_msg; // Last navigation message Gps_Navigation_Message d_last_nav_msg; // Last navigation message
double d_ephemeris_clock_s; double d_ephemeris_clock_s;
double d_ephemeris_timestamp_ms; double d_ephemeris_timestamp_ms;
double d_tx_time; double d_tx_time;
gps_l1_ca_ls_pvt *d_ls_pvt; gps_l1_ca_ls_pvt *d_ls_pvt;
std::map<int,Gps_Navigation_Message> nav_data_map; std::map<int,Gps_Navigation_Message> nav_data_map;
public: public:
~gps_l1_ca_pvt_cc (); //!< Default destructor ~gps_l1_ca_pvt_cc (); //!< Default destructor
/*! /*!
* \brief Set the queue for getting navigation messages from the GpsL1CaTelemetryDecoder * \brief Set the queue for getting navigation messages from the GpsL1CaTelemetryDecoder
*/ */
void set_navigation_queue(concurrent_queue<Gps_Navigation_Message> *nav_queue){d_nav_queue=nav_queue;} void set_navigation_queue(concurrent_queue<Gps_Navigation_Message> *nav_queue){d_nav_queue=nav_queue;}
int general_work (int noutput_items, gr_vector_int &ninput_items, int general_work (int noutput_items, gr_vector_int &ninput_items,
gr_vector_const_void_star &input_items, gr_vector_void_star &output_items); //!< PVT Signal Processing gr_vector_const_void_star &input_items, gr_vector_void_star &output_items); //!< PVT Signal Processing
}; };

View File

@ -47,7 +47,7 @@ gps_l1_ca_ls_pvt::gps_l1_ca_ls_pvt(int nchannels,std::string dump_filename, bool
d_dump_filename = dump_filename; d_dump_filename = dump_filename;
d_flag_dump_enabled = flag_dump_to_file; d_flag_dump_enabled = flag_dump_to_file;
d_averaging_depth = 0; d_averaging_depth = 0;
d_GPS_current_time=0;; d_GPS_current_time = 0;
b_valid_position = false; b_valid_position = false;
// ############# ENABLE DATA FILE LOG ################# // ############# ENABLE DATA FILE LOG #################
if (d_flag_dump_enabled == true) if (d_flag_dump_enabled == true)

View File

@ -38,18 +38,15 @@ bool Kml_Printer::set_headers(std::string filename)
{ {
time_t rawtime; time_t rawtime;
struct tm * timeinfo; struct tm * timeinfo;
time ( &rawtime ); time ( &rawtime );
timeinfo = localtime ( &rawtime ); timeinfo = localtime ( &rawtime );
kml_file.open(filename.c_str()); kml_file.open(filename.c_str());
if (kml_file.is_open()) if (kml_file.is_open())
{ {
DLOG(INFO) << "KML printer writing on " << filename.c_str(); DLOG(INFO) << "KML printer writing on " << filename.c_str();
// Set iostream numeric format and precision // Set iostream numeric format and precision
kml_file.setf(kml_file.fixed,kml_file.floatfield); kml_file.setf(kml_file.fixed,kml_file.floatfield);
kml_file << std::setprecision(14); kml_file << std::setprecision(14);
kml_file << "<?xml version=\"1.0\" encoding=\"UTF-8\"?>" << std::endl kml_file << "<?xml version=\"1.0\" encoding=\"UTF-8\"?>" << std::endl
<< "<kml xmlns=\"http://www.opengis.net/kml/2.2\">" << std::endl << "<kml xmlns=\"http://www.opengis.net/kml/2.2\">" << std::endl
<< " <Document>" << std::endl << " <Document>" << std::endl
@ -83,6 +80,7 @@ bool Kml_Printer::set_headers(std::string filename)
} }
bool Kml_Printer::print_position(gps_l1_ca_ls_pvt* position,bool print_average_values) bool Kml_Printer::print_position(gps_l1_ca_ls_pvt* position,bool print_average_values)
{ {
double latitude; double latitude;

View File

@ -46,17 +46,11 @@
class Kml_Printer class Kml_Printer
{ {
private: private:
std::ofstream kml_file; std::ofstream kml_file;
public: public:
bool set_headers(std::string filename); bool set_headers(std::string filename);
bool print_position(gps_l1_ca_ls_pvt* position, bool print_average_values); bool print_position(gps_l1_ca_ls_pvt* position, bool print_average_values);
bool close_file(); bool close_file();
Kml_Printer(); Kml_Printer();
~Kml_Printer(); ~Kml_Printer();
}; };

View File

@ -58,17 +58,21 @@ Nmea_Printer::Nmea_Printer(std::string filename, bool flag_nmea_tty_port, std::s
nmea_devname = nmea_dump_devname; nmea_devname = nmea_dump_devname;
if (flag_nmea_tty_port == true) if (flag_nmea_tty_port == true)
{ {
nmea_dev_descriptor = init_serial(nmea_devname.c_str()); nmea_dev_descriptor = init_serial(nmea_devname.c_str());
if (nmea_dev_descriptor != -1) if (nmea_dev_descriptor != -1)
{ {
DLOG(INFO) << "NMEA printer writing on " << nmea_devname.c_str(); DLOG(INFO) << "NMEA printer writing on " << nmea_devname.c_str();
} }
}else{ }
else
{
nmea_dev_descriptor = -1; nmea_dev_descriptor = -1;
} }
} }
Nmea_Printer::~Nmea_Printer() Nmea_Printer::~Nmea_Printer()
{ {
if (nmea_file_descriptor.is_open()) if (nmea_file_descriptor.is_open())
@ -79,13 +83,15 @@ Nmea_Printer::~Nmea_Printer()
} }
int Nmea_Printer::init_serial (std::string serial_device) {
int Nmea_Printer::init_serial (std::string serial_device)
{
/*! /*!
* Opens the serial device and sets the deffault baud rate for a NMEA transmission (9600,8,N,1) * Opens the serial device and sets the default baud rate for a NMEA transmission (9600,8,N,1)
*/ */
int fd = 0; int fd = 0;
struct termios options; struct termios options;
long BAUD; long BAUD;
long DATABITS; long DATABITS;
long STOPBITS; long STOPBITS;
@ -115,6 +121,8 @@ int Nmea_Printer::init_serial (std::string serial_device) {
return fd; return fd;
} }
void Nmea_Printer::close_serial () void Nmea_Printer::close_serial ()
{ {
if (nmea_dev_descriptor != -1) if (nmea_dev_descriptor != -1)
@ -123,9 +131,9 @@ void Nmea_Printer::close_serial ()
} }
} }
bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_average_values) bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_average_values)
{ {
std::string GPRMC; std::string GPRMC;
std::string GPGGA; std::string GPGGA;
std::string GPGSA; std::string GPGSA;
@ -146,7 +154,8 @@ bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_averag
GPGSV = get_GPGSV(); GPGSV = get_GPGSV();
// write to log file // write to log file
try{ try
{
//GPRMC //GPRMC
nmea_file_descriptor << GPRMC; nmea_file_descriptor << GPRMC;
//GPGGA (Global Positioning System Fixed Data) //GPGGA (Global Positioning System Fixed Data)
@ -155,8 +164,8 @@ bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_averag
nmea_file_descriptor << GPGSA; nmea_file_descriptor << GPGSA;
//GPGSV //GPGSV
nmea_file_descriptor << GPGSV; nmea_file_descriptor << GPGSV;
}
}catch(std::exception ex) catch(std::exception ex)
{ {
DLOG(INFO) << "NMEA printer can not write on output file" << nmea_filename.c_str();; DLOG(INFO) << "NMEA printer can not write on output file" << nmea_filename.c_str();;
} }
@ -164,7 +173,8 @@ bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_averag
//write to serial device //write to serial device
if (nmea_dev_descriptor!=-1) if (nmea_dev_descriptor!=-1)
{ {
try{ try
{
int n_bytes_written; int n_bytes_written;
//GPRMC //GPRMC
n_bytes_written = write(nmea_dev_descriptor, GPRMC.c_str(), GPRMC.length()); n_bytes_written = write(nmea_dev_descriptor, GPRMC.c_str(), GPRMC.length());
@ -174,26 +184,31 @@ bool Nmea_Printer::Print_Nmea_Line(gps_l1_ca_ls_pvt* pvt_data, bool print_averag
n_bytes_written = write(nmea_dev_descriptor, GPGSA.c_str(), GPGSA.length()); n_bytes_written = write(nmea_dev_descriptor, GPGSA.c_str(), GPGSA.length());
//GPGSV //GPGSV
n_bytes_written = write(nmea_dev_descriptor, GPGSV.c_str(), GPGSV.length()); n_bytes_written = write(nmea_dev_descriptor, GPGSV.c_str(), GPGSV.length());
}
}catch(std::exception ex) catch(std::exception ex)
{ {
DLOG(INFO) << "NMEA printer can not write on serial device" << nmea_filename.c_str();; DLOG(INFO) << "NMEA printer can not write on serial device" << nmea_filename.c_str();;
} }
} }
return true; return true;
} }
char Nmea_Printer::checkSum(std::string sentence) {
char Nmea_Printer::checkSum(std::string sentence)
{
char check = 0; char check = 0;
// iterate over the string, XOR each byte with the total sum: // iterate over the string, XOR each byte with the total sum:
for (unsigned int c = 0; c < sentence.length(); c++) { for (unsigned int c = 0; c < sentence.length(); c++)
{
check = char(check ^ sentence.at(c)); check = char(check ^ sentence.at(c));
} }
// return the result // return the result
return check; return check;
} }
std::string Nmea_Printer::latitude_to_hm(double lat) std::string Nmea_Printer::latitude_to_hm(double lat)
{ {
bool north; bool north;
@ -201,7 +216,9 @@ std::string Nmea_Printer::latitude_to_hm(double lat)
{ {
north = false; north = false;
lat = -lat ; lat = -lat ;
}else{ }
else
{
north = true; north = true;
} }
@ -220,12 +237,16 @@ std::string Nmea_Printer::latitude_to_hm(double lat)
if (north == true) if (north == true)
{ {
out_string << ",N"; out_string << ",N";
}else{ }
else
{
out_string << ",S"; out_string << ",S";
} }
return out_string.str(); return out_string.str();
} }
std::string Nmea_Printer::longitude_to_hm(double longitude) std::string Nmea_Printer::longitude_to_hm(double longitude)
{ {
bool east; bool east;
@ -233,10 +254,11 @@ std::string Nmea_Printer::longitude_to_hm(double longitude)
{ {
east = false; east = false;
longitude = -longitude ; longitude = -longitude ;
}else{ }
else
{
east = true; east = true;
} }
int deg = (int)longitude; int deg = (int)longitude;
double mins = longitude - (double)deg; double mins = longitude - (double)deg;
mins *= 60.0 ; mins *= 60.0 ;
@ -252,10 +274,11 @@ std::string Nmea_Printer::longitude_to_hm(double longitude)
if (east==true) if (east==true)
{ {
out_string << ",E"; out_string << ",E";
}else{ }
else
{
out_string << ",W"; out_string << ",W";
} }
return out_string.str(); return out_string.str();
} }
@ -295,17 +318,20 @@ std::string Nmea_Printer::get_UTC_NMEA_time(boost::posix_time::ptime d_position_
{ {
sentence_str << ".0"; // three digits for ms sentence_str << ".0"; // three digits for ms
sentence_str << utc_milliseconds; sentence_str << utc_milliseconds;
}else }
else
{ {
sentence_str << "."; // three digits for ms sentence_str << "."; // three digits for ms
sentence_str << utc_milliseconds; sentence_str << utc_milliseconds;
} }
return sentence_str.str(); return sentence_str.str();
} }
std::string Nmea_Printer::get_GPRMC() std::string Nmea_Printer::get_GPRMC()
{ {
// Sample -> $GPRMC,161229.487,A,3723.2475,N,12158.3416,W,0.13,309.62,120598,*10 // Sample -> $GPRMC,161229.487,A,3723.2475,N,12158.3416,W,0.13,309.62,120598,*10
bool valid_fix = d_PVT_data->b_valid_position; bool valid_fix = d_PVT_data->b_valid_position;
// ToDo: Compute speed and course over ground // ToDo: Compute speed and course over ground
@ -329,26 +355,24 @@ std::string Nmea_Printer::get_GPRMC()
if (valid_fix == true) if (valid_fix == true)
{ {
sentence_str << ",A"; sentence_str << ",A";
}else{ }
else
{
sentence_str << ",V"; sentence_str << ",V";
}; };
if (d_PVT_data->d_flag_averaging==true) if (d_PVT_data->d_flag_averaging==true)
{ {
// Latitude ddmm.mmmm,(N or S) // Latitude ddmm.mmmm,(N or S)
sentence_str << "," << latitude_to_hm(d_PVT_data->d_avg_latitude_d); sentence_str << "," << latitude_to_hm(d_PVT_data->d_avg_latitude_d);
// longitude dddmm.mmmm,(E or W) // longitude dddmm.mmmm,(E or W)
sentence_str << "," << longitude_to_hm(d_PVT_data->d_avg_longitude_d); sentence_str << "," << longitude_to_hm(d_PVT_data->d_avg_longitude_d);
}else{ }
else
{
// Latitude ddmm.mmmm,(N or S) // Latitude ddmm.mmmm,(N or S)
sentence_str << "," << latitude_to_hm(d_PVT_data->d_latitude_d); sentence_str << "," << latitude_to_hm(d_PVT_data->d_latitude_d);
// longitude dddmm.mmmm,(E or W) // longitude dddmm.mmmm,(E or W)
sentence_str << "," << longitude_to_hm(d_PVT_data->d_longitude_d); sentence_str << "," << longitude_to_hm(d_PVT_data->d_longitude_d);
} }
@ -365,7 +389,6 @@ std::string Nmea_Printer::get_GPRMC()
sentence_str << course_over_ground_deg; sentence_str << course_over_ground_deg;
// Date ddmmyy // Date ddmmyy
boost::gregorian::date sentence_date = d_PVT_data->d_position_UTC_time.date(); boost::gregorian::date sentence_date = d_PVT_data->d_position_UTC_time.date();
unsigned int year = sentence_date.year(); unsigned int year = sentence_date.year();
unsigned int day = sentence_date.day(); unsigned int day = sentence_date.day();
@ -392,11 +415,9 @@ std::string Nmea_Printer::get_GPRMC()
sentence_str << ","; sentence_str << ",";
// Checksum // Checksum
char checksum; char checksum;
std::string tmpstr; std::string tmpstr;
tmpstr = sentence_str.str(); tmpstr = sentence_str.str();
checksum = checkSum(tmpstr.substr(1)); checksum = checkSum(tmpstr.substr(1));
sentence_str << "*"; sentence_str << "*";
sentence_str.width(2); sentence_str.width(2);
@ -405,25 +426,21 @@ std::string Nmea_Printer::get_GPRMC()
// end NMEA sentence // end NMEA sentence
sentence_str << "\r\n"; sentence_str << "\r\n";
return sentence_str.str(); return sentence_str.str();
} }
std::string Nmea_Printer::get_GPGSA() std::string Nmea_Printer::get_GPGSA()
{ {
//$GPGSA,A,3,07,02,26,27,09,04,15, , , , , ,1.8,1.0,1.5*33 //$GPGSA,A,3,07,02,26,27,09,04,15, , , , , ,1.8,1.0,1.5*33
// GSA-GNSS DOP and Active Satellites // GSA-GNSS DOP and Active Satellites
bool valid_fix = d_PVT_data->b_valid_position; bool valid_fix = d_PVT_data->b_valid_position;
int n_sats_used = d_PVT_data->d_valid_observations; int n_sats_used = d_PVT_data->d_valid_observations;
double pdop = d_PVT_data->d_PDOP; double pdop = d_PVT_data->d_PDOP;
double hdop = d_PVT_data->d_HDOP; double hdop = d_PVT_data->d_HDOP;
double vdop = d_PVT_data->d_VDOP; double vdop = d_PVT_data->d_VDOP;
std::stringstream sentence_str; std::stringstream sentence_str;
std::string sentence_header; std::string sentence_header;
sentence_header = "$GPGSA,"; sentence_header = "$GPGSA,";
@ -433,8 +450,8 @@ std::string Nmea_Printer::get_GPGSA()
// (M) Manual-forced to operate in 2D or 3D mode // (M) Manual-forced to operate in 2D or 3D mode
// (A) Automatic-allowed to automatically switch 2D/3D // (A) Automatic-allowed to automatically switch 2D/3D
std::string mode1 = "M"; std::string mode1 = "M";
sentence_str << mode1; sentence_str << mode1;
// mode2: // mode2:
// 1 fix not available // 1 fix not available
// 2 fix 2D // 2 fix 2D
@ -442,7 +459,9 @@ std::string Nmea_Printer::get_GPGSA()
if (valid_fix==true) if (valid_fix==true)
{ {
sentence_str << ",3"; sentence_str << ",3";
}else{ }
else
{
sentence_str << ",1"; sentence_str << ",1";
}; };
@ -472,7 +491,6 @@ std::string Nmea_Printer::get_GPGSA()
sentence_str.precision(1); sentence_str.precision(1);
sentence_str.fill('0'); sentence_str.fill('0');
sentence_str << hdop; sentence_str << hdop;
//VDOP //VDOP
sentence_str << ","; sentence_str << ",";
sentence_str.setf(std::ios::fixed, std::ios::floatfield); sentence_str.setf(std::ios::fixed, std::ios::floatfield);
@ -482,11 +500,9 @@ std::string Nmea_Printer::get_GPGSA()
sentence_str << vdop; sentence_str << vdop;
// Checksum // Checksum
char checksum; char checksum;
std::string tmpstr; std::string tmpstr;
tmpstr = sentence_str.str(); tmpstr = sentence_str.str();
checksum = checkSum(tmpstr.substr(1)); checksum = checkSum(tmpstr.substr(1));
sentence_str << "*"; sentence_str << "*";
sentence_str.width(2); sentence_str.width(2);
@ -495,26 +511,26 @@ std::string Nmea_Printer::get_GPGSA()
// end NMEA sentence // end NMEA sentence
sentence_str<<"\r\n"; sentence_str<<"\r\n";
return sentence_str.str(); return sentence_str.str();
} }
std::string Nmea_Printer::get_GPGSV() std::string Nmea_Printer::get_GPGSV()
{ {
// GSV-GNSS Satellites in View // GSV-GNSS Satellites in View
// Notice that NMEA 2.1 only supports 12 channels // Notice that NMEA 2.1 only supports 12 channels
int n_sats_used=d_PVT_data->d_valid_observations; int n_sats_used=d_PVT_data->d_valid_observations;
std::stringstream sentence_str; std::stringstream sentence_str;
std::stringstream frame_str; std::stringstream frame_str;
std::string sentence_header; std::string sentence_header;
sentence_header = "$GPGSV,"; sentence_header = "$GPGSV,";
char checksum; char checksum;
std::string tmpstr; std::string tmpstr;
// 1st step: How many GPGSV frames we need? (up to 3) // 1st step: How many GPGSV frames we need? (up to 3)
// Each frame countains up to 4 satellites // Each frame contains up to 4 satellites
int n_frames; int n_frames;
n_frames = std::ceil(((double)n_sats_used) / 4.0); n_frames = std::ceil(((double)n_sats_used) / 4.0);
@ -522,9 +538,7 @@ std::string Nmea_Printer::get_GPGSV()
int current_satellite = 0; int current_satellite = 0;
for (int i=1; i<(n_frames+1); i++) for (int i=1; i<(n_frames+1); i++)
{ {
frame_str.str(""); frame_str.str("");
frame_str << sentence_header; frame_str << sentence_header;
// number of messages // number of messages
@ -586,18 +600,18 @@ std::string Nmea_Printer::get_GPGSV()
//add frame to sentence //add frame to sentence
sentence_str << frame_str.str(); sentence_str << frame_str.str();
} }
return sentence_str.str(); return sentence_str.str();
//$GPGSV,2,1,07,07,79,048,42,02,51,062,43,26,36,256,42,27,27,138,42*71 //$GPGSV,2,1,07,07,79,048,42,02,51,062,43,26,36,256,42,27,27,138,42*71
} }
std::string Nmea_Printer::get_GPGGA() std::string Nmea_Printer::get_GPGGA()
{ {
//boost::posix_time::ptime d_position_UTC_time=boost::posix_time::microsec_clock::universal_time(); //boost::posix_time::ptime d_position_UTC_time=boost::posix_time::microsec_clock::universal_time();
bool valid_fix = d_PVT_data->b_valid_position; bool valid_fix = d_PVT_data->b_valid_position;
int n_channels = d_PVT_data->d_valid_observations;//d_nchannels int n_channels = d_PVT_data->d_valid_observations;//d_nchannels
double hdop = d_PVT_data->d_HDOP; double hdop = d_PVT_data->d_HDOP;
double MSL_altitude; double MSL_altitude;
@ -605,7 +619,9 @@ std::string Nmea_Printer::get_GPGGA()
if (d_PVT_data->d_flag_averaging == true) if (d_PVT_data->d_flag_averaging == true)
{ {
MSL_altitude=d_PVT_data->d_avg_height_m; MSL_altitude=d_PVT_data->d_avg_height_m;
}else{ }
else
{
MSL_altitude=d_PVT_data->d_height_m; MSL_altitude=d_PVT_data->d_height_m;
} }
@ -614,29 +630,23 @@ std::string Nmea_Printer::get_GPGGA()
//GPGGA (Global Positioning System Fixed Data) //GPGGA (Global Positioning System Fixed Data)
std::string sentence_header; std::string sentence_header;
sentence_header = "$GPGGA,"; sentence_header = "$GPGGA,";
sentence_str << sentence_header; sentence_str << sentence_header;
//UTC Time: hhmmss.sss //UTC Time: hhmmss.sss
sentence_str << get_UTC_NMEA_time(d_PVT_data->d_position_UTC_time); sentence_str << get_UTC_NMEA_time(d_PVT_data->d_position_UTC_time);
if (d_PVT_data->d_flag_averaging == true) if (d_PVT_data->d_flag_averaging == true)
{ {
// Latitude ddmm.mmmm,(N or S) // Latitude ddmm.mmmm,(N or S)
sentence_str << "," << latitude_to_hm(d_PVT_data->d_avg_latitude_d); sentence_str << "," << latitude_to_hm(d_PVT_data->d_avg_latitude_d);
// longitude dddmm.mmmm,(E or W) // longitude dddmm.mmmm,(E or W)
sentence_str << "," << longitude_to_hm(d_PVT_data->d_avg_longitude_d); sentence_str << "," << longitude_to_hm(d_PVT_data->d_avg_longitude_d);
}else{ }
else
{
// Latitude ddmm.mmmm,(N or S) // Latitude ddmm.mmmm,(N or S)
sentence_str << "," << latitude_to_hm(d_PVT_data->d_latitude_d); sentence_str << "," << latitude_to_hm(d_PVT_data->d_latitude_d);
// longitude dddmm.mmmm,(E or W) // longitude dddmm.mmmm,(E or W)
sentence_str << "," << longitude_to_hm(d_PVT_data->d_longitude_d); sentence_str << "," << longitude_to_hm(d_PVT_data->d_longitude_d);
} }
@ -651,7 +661,9 @@ std::string Nmea_Printer::get_GPGGA()
if (valid_fix == true) if (valid_fix == true)
{ {
sentence_str << ",1"; sentence_str << ",1";
}else{ }
else
{
sentence_str << ",0"; sentence_str << ",0";
} }
@ -660,7 +672,9 @@ std::string Nmea_Printer::get_GPGGA()
if (n_channels < 10) if (n_channels < 10)
{ {
sentence_str << '0' << n_channels; sentence_str << '0' << n_channels;
}else{ }
else
{
sentence_str << n_channels; sentence_str << n_channels;
} }
@ -691,11 +705,9 @@ std::string Nmea_Printer::get_GPGGA()
sentence_str << "0.0,0000"; sentence_str << "0.0,0000";
// Checksum // Checksum
char checksum; char checksum;
std::string tmpstr; std::string tmpstr;
tmpstr = sentence_str.str(); tmpstr = sentence_str.str();
checksum = checkSum(tmpstr.substr(1)); checksum = checkSum(tmpstr.substr(1));
sentence_str << "*"; sentence_str << "*";
sentence_str.width(2); sentence_str.width(2);
@ -704,9 +716,7 @@ std::string Nmea_Printer::get_GPGGA()
// end NMEA sentence // end NMEA sentence
sentence_str << "\r\n"; sentence_str << "\r\n";
return sentence_str.str(); return sentence_str.str();
//$GPGGA,104427.591,5920.7009,N,01803.2938,E,1,05,3.3,78.2,M,23.2,M,0.0,0000*4A //$GPGGA,104427.591,5920.7009,N,01803.2938,E,1,05,3.3,78.2,M,23.2,M,0.0,0000*4A
} }

View File

@ -59,18 +59,14 @@ public:
*/ */
~Nmea_Printer(); ~Nmea_Printer();
private: private:
std::string nmea_filename ; //<! String with the NMEA log filename std::string nmea_filename ; //<! String with the NMEA log filename
std::ofstream nmea_file_descriptor ; //<! Output file stream for NMEA log file std::ofstream nmea_file_descriptor ; //<! Output file stream for NMEA log file
std::string nmea_devname; std::string nmea_devname;
int nmea_dev_descriptor ; //<! NMEA serial device descriptor (i.e. COM port) int nmea_dev_descriptor ; //<! NMEA serial device descriptor (i.e. COM port)
gps_l1_ca_ls_pvt* d_PVT_data; gps_l1_ca_ls_pvt* d_PVT_data;
int init_serial (std::string serial_device); //serial port control int init_serial (std::string serial_device); //serial port control
void close_serial (); void close_serial ();
std::string get_GPGGA(); std::string get_GPGGA();
std::string get_GPGSV(); std::string get_GPGSV();
std::string get_GPGSA(); std::string get_GPGSA();
@ -79,7 +75,6 @@ private:
std::string longitude_to_hm(double longitude); std::string longitude_to_hm(double longitude);
std::string latitude_to_hm(double lat); std::string latitude_to_hm(double lat);
char checkSum(std::string sentence); char checkSum(std::string sentence);
}; };
#endif #endif

View File

@ -14,7 +14,7 @@
* 1) The carrier-phase measurement at one or both carriers (actually being a * 1) The carrier-phase measurement at one or both carriers (actually being a
* measurement on the beat frequency between the received carrier of the * measurement on the beat frequency between the received carrier of the
* satellite signal and a receiver-generated reference frequency). * satellite signal and a receiver-generated reference frequency).
* 2) The pseudorange (code) measuremen , equivalent to the difference * 2) The pseudorange (code) measurement , equivalent to the difference
* of the time of reception (expressed in the time frame of the receiver) * of the time of reception (expressed in the time frame of the receiver)
* and the time of transmission (expressed in the time frame of the satellite) * and the time of transmission (expressed in the time frame of the satellite)
* of a distinct satellite signal. * of a distinct satellite signal.
@ -66,8 +66,6 @@
*/ */
class Rinex_Printer class Rinex_Printer
{ {
public: public:
/*! /*!
* \brief Default constructor. Creates GPS Navigation and Observables RINEX files and their headers * \brief Default constructor. Creates GPS Navigation and Observables RINEX files and their headers
@ -106,30 +104,19 @@ public:
* \brief Writes observables into the RINEX file * \brief Writes observables into the RINEX file
*/ */
void log_rinex_obs(std::ofstream& out, Gps_Navigation_Message nav_msg, std::map<int,double> pseudoranges); void log_rinex_obs(std::ofstream& out, Gps_Navigation_Message nav_msg, std::map<int,double> pseudoranges);
std::map<std::string,std::string> satelliteSystem; //<! GPS, GLONASS, SBAS payload, Galileo or Compass std::map<std::string,std::string> satelliteSystem; //<! GPS, GLONASS, SBAS payload, Galileo or Compass
std::map<std::string,std::string> observationType; //<! PSEUDORANGE, CARRIER_PHASE, DOPPLER, SIGNAL_STRENGTH std::map<std::string,std::string> observationType; //<! PSEUDORANGE, CARRIER_PHASE, DOPPLER, SIGNAL_STRENGTH
std::map<std::string,std::string> observationCode; //<! GNSS observation descriptors std::map<std::string,std::string> observationCode; //<! GNSS observation descriptors
std::string stringVersion; //<! RINEX version (2.10/2.11 or 3.01) std::string stringVersion; //<! RINEX version (2.10/2.11 or 3.01)
private: private:
int version ; // RINEX version (2 for 2.10/2.11 and 3 for 3.01) int version ; // RINEX version (2 for 2.10/2.11 and 3 for 3.01)
int numberTypesObservations; // Number of available types of observable in the system. Should be public? int numberTypesObservations; // Number of available types of observable in the system. Should be public?
/* /*
* Generation of RINEX signal strength indicators * Generation of RINEX signal strength indicators
*/ */
int signalStrength(double snr); int signalStrength(double snr);
/* Creates RINEX file names according to the naming convention /* Creates RINEX file names according to the naming convention
* *
* See http://igscb.jpl.nasa.gov/igscb/data/format/rinex301.pdf * See http://igscb.jpl.nasa.gov/igscb/data/format/rinex301.pdf
@ -426,7 +413,6 @@ inline std::string& Rinex_Printer::sci2for(std::string& aStr,
const std::string::size_type expLen, const std::string::size_type expLen,
const bool checkSwitch) const bool checkSwitch)
{ {
std::string::size_type idx = aStr.find('.', startPos); std::string::size_type idx = aStr.find('.', startPos);
int expAdd = 0; int expAdd = 0;
std::string exp; std::string exp;
@ -505,9 +491,7 @@ inline std::string& Rinex_Printer::sci2for(std::string& aStr,
aStr.insert((std::string::size_type)1, 1, '0'); aStr.insert((std::string::size_type)1, 1, '0');
} }
return aStr; return aStr;
} // end sci2for } // end sci2for