mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-06-24 22:13:15 +00:00
Code Issues Releases Wiki Activity

adding message types 1006 and 1008

Browse Source
This commit is contained in:
Carles Fernandez 2015-12-23 14:05:00 +01:00
parent 06d9f21e68
commit 0f6bc1054e
2 changed files with 138 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

119
src/core/system_parameters/rtcm.cc
View File

@ -914,6 +914,109 @@ std::string Rtcm::print_MT1005_test()
return Rtcm::build_message(mt1005.to_string());
}
// ********************************************************
//
// MESSAGE TYPE 1006 (STATION DESCRIPTION PLUS HEIGHT INFORMATION)
//
// ********************************************************
std::string Rtcm::print_MT1006( unsigned int ref_id, double ecef_x, double ecef_y, double ecef_z, bool gps, bool glonass, bool galileo, bool non_physical, bool single_oscillator, unsigned int quarter_cycle_indicator, double height)
{
unsigned int msg_number = 1006;
std::bitset<1> DF001_;
Rtcm::set_DF002(msg_number);
Rtcm::set_DF003(ref_id);
Rtcm::set_DF021();
Rtcm::set_DF022(gps);
Rtcm::set_DF023(glonass);
Rtcm::set_DF024(galileo);
DF141 = std::bitset<1>(non_physical);
DF001_ = std::bitset<1>("0");
Rtcm::set_DF025(ecef_x);
DF142 = std::bitset<1>(single_oscillator);
Rtcm::set_DF026(ecef_y);
DF364 = std::bitset<2>(quarter_cycle_indicator);
Rtcm::set_DF027(ecef_z);
Rtcm::set_DF028(height);
std::string data = DF002.to_string() +
DF003.to_string() +
DF021.to_string() +
DF022.to_string() +
DF023.to_string() +
DF024.to_string() +
DF141.to_string() +
DF025.to_string() +
DF142.to_string() +
DF001_.to_string() +
DF026.to_string() +
DF364.to_string() +
DF027.to_string() +
DF028.to_string();
std::string message = build_message(data);
return message;
}
// ********************************************************
//
// MESSAGE TYPE 1008 (ANTENNA DESCRIPTOR & SERIAL NUMBER)
//
// ********************************************************
std::string Rtcm::print_MT1008(unsigned int ref_id, const std::string & antenna_descriptor, unsigned int antenna_setup_id, const std::string & antenna_serial_number)
{
unsigned int msg_number = 1008;
std::bitset<12> DF002_ = std::bitset<12>(msg_number);
Rtcm::set_DF003(ref_id);
std::string ant_descriptor = antenna_descriptor;
unsigned int len = ant_descriptor.length();
if (len > 31)
{
ant_descriptor = ant_descriptor.substr(0, 31);
len = 31;
}
DF029 = std::bitset<8>(len);
std::string DF030_str_;
for(auto it = ant_descriptor.begin(); it != ant_descriptor.end(); it++)
{
char c = *it;
std::bitset<8> character = std::bitset<8>(c);
DF030_str_ += character.to_string();
}
Rtcm::set_DF031(antenna_setup_id);
std::string ant_sn(antenna_serial_number);
unsigned int len2 = ant_sn.length();
if (len2 > 31)
{
ant_sn = ant_sn.substr(0, 31);
len2 = 31;
}
DF032 = std::bitset<8>(len2);
std::string DF033_str_;
for(auto it = ant_sn.begin(); it != ant_sn.end(); it++)
{
char c = *it;
std::bitset<8> character = std::bitset<8>(c);
DF033_str_ += character.to_string();
}
std::string data = DF002_.to_string() +
DF003.to_string() +
DF029.to_string() +
DF030_str_ +
DF031.to_string() +
DF032.to_string() +
DF033_str_;
std::string message = build_message(data);
return message;
}
// ********************************************************
@ -2899,7 +3002,7 @@ int Rtcm::set_DF026(double antenna_ECEF_Y_m)
}
int Rtcm::set_DF027(double antenna_ECEF_Z_m)
int Rtcm::set_DF027(double antenna_ECEF_Z_m)
{
long long int ant_ref_z = static_cast<long long int>(std::round( antenna_ECEF_Z_m * 10000));
DF027 = std::bitset<38>(ant_ref_z);
@ -2907,6 +3010,20 @@ int Rtcm::set_DF027(double antenna_ECEF_Z_m)
}
int Rtcm::set_DF028(double height)
{
unsigned int h_ = static_cast<unsigned int>(std::round( height * 10000));
DF028 = std::bitset<16>(h_);
return 0;
}
int Rtcm::set_DF031(unsigned int antenna_setup_id)
{
DF031 = std::bitset<8>(antenna_setup_id);
return 0;
}
int Rtcm::set_DF071(const Gps_Ephemeris & gps_eph)
{
unsigned int iode = static_cast<unsigned int>(gps_eph.d_IODE_SF2);

20
src/core/system_parameters/rtcm.h
View File

@ -117,6 +117,16 @@ public:
*/
int read_MT1005(const std::string & message, unsigned int & ref_id, double & ecef_x, double & ecef_y, double & ecef_z, bool & gps, bool & glonass, bool & galileo);
/*!
* \brief Prints message type 1006 (Stationary Antenna Reference Point, with Height Information)
*/
std::string print_MT1006(unsigned int ref_id, double ecef_x, double ecef_y, double ecef_z, bool gps, bool glonass, bool galileo, bool non_physical, bool single_oscillator, unsigned int quarter_cycle_indicator, double height);
/*!
* \brief Prints message type 1008 (Antenna Descriptor & Serial Number)
*/
std::string print_MT1008(unsigned int ref_id, const std::string & antenna_descriptor, unsigned int antenna_setup_id, const std::string & antenna_serial_number);
/*!
* \brief Prints message type 1019 (GPS Ephemeris), should be broadcast in the event that
* the IODC does not match the IODE, and every 2 minutes.
@ -914,6 +924,16 @@ private:
std::bitset<38> DF027;
int set_DF027(double antenna_ECEF_Z_m);
std::bitset<16> DF028;
int set_DF028(double height);
std::bitset<8> DF029;
std::bitset<8> DF031;
int set_DF031(unsigned int antenna_setup_id);
std::bitset<8> DF032;
// Contents of GPS Satellite Ephemeris Data, Message Type 1019
std::bitset<8> DF071;
int set_DF071(const Gps_Ephemeris & gps_eph);