mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-09-28 07:08:24 +00:00
Code Issues Releases Wiki Activity

Read Mask block in the MT1 body

Browse Source
This commit is contained in:
Carles Fernandez 2021-09-16 18:02:47 +02:00
parent 2265cc4301
commit 5b4218a37e
No known key found for this signature in database
GPG Key ID: 4C583C52B0C3877D
1 changed files with 58 additions and 60 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

118
src/core/libs/galileo_e6_has_msg_receiver.cc
View File

@ -314,74 +314,69 @@ void galileo_e6_has_msg_receiver::read_MT1_body(const std::string& message_body)
{ {
// ICD v1.2 Table 7: MT1 Message Body. // ICD v1.2 Table 7: MT1 Message Body.
auto message = std::string(message_body); auto message = std::string(message_body);
// int Nsat = 0; int Nsat = 0;
if (d_HAS_data.header.mask_flag) if (d_HAS_data.header.mask_flag)
{ {
DLOG(INFO) << "TOH: " << static_cast<float>(d_HAS_data.header.toh);
// read mask // read mask
d_HAS_data.Nsys = read_has_message_body_uint8(message.substr(0, HAS_MSG_NSYS_LENGTH)); d_HAS_data.Nsys = read_has_message_body_uint8(message.substr(0, HAS_MSG_NSYS_LENGTH));
DLOG(INFO) << "Nsys " << static_cast<float>(d_HAS_data.Nsys); DLOG(INFO) << "Nsys " << static_cast<float>(d_HAS_data.Nsys);
message = std::string(message.begin() + HAS_MSG_NSYS_LENGTH, message.end()); if (d_HAS_data.Nsys != 0)
d_HAS_data.gnss_id_mask.reserve(d_HAS_data.Nsys);
d_HAS_data.cell_mask.reserve(d_HAS_data.Nsys);
d_HAS_data.cell_mask_availability_flag.reserve(d_HAS_data.Nsys);
d_HAS_data.nav_message.reserve(d_HAS_data.Nsys);
for (uint8_t i = 0; i < d_HAS_data.Nsys; i++)
{ {
// d_HAS_data.gnss_id_mask[i] = read_has_message_body_uint8(message.substr(0, HAS_MSG_ID_MASK_LENGTH)); message = std::string(message.begin() + HAS_MSG_NSYS_LENGTH, message.end());
// // DLOG(ERROR) << "GNSS ID" << static_cast<float>(i) << ": " << static_cast<float>(d_HAS_data.gnss_id_mask[i]); d_HAS_data.gnss_id_mask.reserve(d_HAS_data.Nsys);
// message = std::string(message.begin() + HAS_MSG_ID_MASK_LENGTH, message.end()); d_HAS_data.cell_mask = {d_HAS_data.Nsys, std::vector<std::vector<bool>>(40, std::vector<bool>(16, 0))};
// std::string msg = message.substr(0, HAS_MSG_SATELLITE_MASK_LENGTH); d_HAS_data.cell_mask_availability_flag.reserve(d_HAS_data.Nsys);
// d_HAS_data.satellite_mask[i] = read_has_message_body_uint64(msg); d_HAS_data.nav_message.reserve(d_HAS_data.Nsys);
// int ones_in_satellite_mask = 0; d_HAS_data.satellite_mask.reserve(d_HAS_data.Nsys);
// for (char c : msg) d_HAS_data.signal_mask.reserve(d_HAS_data.Nsys);
// {
// if (c == '1') for (uint8_t i = 0; i < d_HAS_data.Nsys; i++)
// { {
// ones_in_satellite_mask++; d_HAS_data.gnss_id_mask[i] = read_has_message_body_uint8(message.substr(0, HAS_MSG_ID_MASK_LENGTH));
// } DLOG(INFO) << "GNSS ID" << static_cast<float>(i) << ": " << static_cast<float>(d_HAS_data.gnss_id_mask[i]);
// } message = std::string(message.begin() + HAS_MSG_ID_MASK_LENGTH, message.end());
// Nsat += ones_in_satellite_mask;
// message = std::string(message.begin() + HAS_MSG_SATELLITE_MASK_LENGTH, message.end()); std::string msg = message.substr(0, HAS_MSG_SATELLITE_MASK_LENGTH);
// d_HAS_data.satellite_mask[i] = read_has_message_body_uint64(msg);
// msg = message.substr(0, HAS_MSG_SIGNAL_MASK_LENGTH); int ones_in_satellite_mask = std::count(msg.begin(), msg.end(), '1');
// d_HAS_data.signal_mask[i] = read_has_message_body_uint16(msg); Nsat += ones_in_satellite_mask;
// int ones_in_signal_mask = 0; message = std::string(message.begin() + HAS_MSG_SATELLITE_MASK_LENGTH, message.end());
// for (char c : msg)
// { msg = message.substr(0, HAS_MSG_SIGNAL_MASK_LENGTH);
// if (c == '1') d_HAS_data.signal_mask[i] = read_has_message_body_uint16(msg);
// { int ones_in_signal_mask = std::count(msg.begin(), msg.end(), '1');
// ones_in_signal_mask++; message = std::string(message.begin() + HAS_MSG_SIGNAL_MASK_LENGTH, message.end());
// }
// } if (message.substr(0, 1) == "1")
// message = std::string(message.begin() + HAS_MSG_SIGNAL_MASK_LENGTH, message.end()); {
// d_HAS_data.cell_mask_availability_flag[i] = true;
// if (message.substr(0, 1) == "1") }
// { else
// d_HAS_data.cell_mask_availability_flag[i] = true; {
// } d_HAS_data.cell_mask_availability_flag[i] = false;
// else }
// { message = std::string(message.begin() + 1, message.end());
// d_HAS_data.cell_mask_availability_flag[i] = false;
// } int size_cell = ones_in_satellite_mask * ones_in_signal_mask;
// message = std::string(message.begin() + 1, message.end()); int pos = 0;
// int size_cell = ones_in_satellite_mask * ones_in_signal_mask; for (int s = 0; s < ones_in_satellite_mask; s++)
// {
// d_HAS_data.cell_mask[i].reserve(ones_in_satellite_mask); for (int sig = 0; sig < ones_in_signal_mask; sig++)
// for (int s = 0; s < ones_in_satellite_mask; s++) {
// { d_HAS_data.cell_mask[i][s][sig] = (message[pos] == '1' ? true : false);
// d_HAS_data.cell_mask[i][s].reserve(ones_in_signal_mask); pos++;
// for (int sig = 0; sig < ones_in_signal_mask; sig++) }
// { }
// d_HAS_data.cell_mask[i][s][sig] = (message[sig] == '1' ? true : false); message = std::string(message.begin() + size_cell, message.end());
// }
// } d_HAS_data.nav_message[i] = read_has_message_body_uint8(message.substr(0, HAS_MSG_NAV_MESSAGE_LENGTH));
// message = std::string(message.begin() + size_cell, message.end()); message = std::string(message.begin() + HAS_MSG_NAV_MESSAGE_LENGTH, message.end());
// }
// d_HAS_data.nav_message[i] = read_has_message_body_uint8(message.substr(0, HAS_MSG_NAV_MESSAGE_LENGTH));
// message = std::string(message.begin() + HAS_MSG_NAV_MESSAGE_LENGTH, message.end());
} }
} }
// if (d_HAS_data.header.orbit_correction_flag)
// if (d_HAS_data.header.orbit_correction_flag && (Nsat != 0))
// { // {
// // read orbit corrections // // read orbit corrections
// d_HAS_data.validity_interval_index_orbit_corrections = read_has_message_body_uint8(message.substr(0, HAS_MSG_VALIDITY_INDEX_LENGTH)); // d_HAS_data.validity_interval_index_orbit_corrections = read_has_message_body_uint8(message.substr(0, HAS_MSG_VALIDITY_INDEX_LENGTH));
@ -412,6 +407,7 @@ void galileo_e6_has_msg_receiver::read_MT1_body(const std::string& message_body)
// message = std::string(message.begin() + HAS_MSG_DELTA_CROSS_TRACK_LENGTH, message.end()); // message = std::string(message.begin() + HAS_MSG_DELTA_CROSS_TRACK_LENGTH, message.end());
// } // }
// } // }
//
// if (d_HAS_data.header.clock_fullset_flag) // if (d_HAS_data.header.clock_fullset_flag)
// { // {
// // read clock full-set corrections // // read clock full-set corrections
@ -437,6 +433,7 @@ void galileo_e6_has_msg_receiver::read_MT1_body(const std::string& message_body)
// message = std::string(message.begin() + HAS_MSG_DELTA_CLOCK_C0_LENGTH, message.end()); // message = std::string(message.begin() + HAS_MSG_DELTA_CLOCK_C0_LENGTH, message.end());
// } // }
// } // }
//
// if (d_HAS_data.header.clock_subset_flag) // if (d_HAS_data.header.clock_subset_flag)
// { // {
// // read clock subset corrections // // read clock subset corrections
@ -489,6 +486,7 @@ void galileo_e6_has_msg_receiver::read_MT1_body(const std::string& message_body)
// message = std::string(message.begin() + HAS_MSG_DELTA_CLOCK_C0_SUBSET_LENGTH, message.end()); // message = std::string(message.begin() + HAS_MSG_DELTA_CLOCK_C0_SUBSET_LENGTH, message.end());
// } // }
// } // }
//
// if (d_HAS_data.header.code_bias_flag) // if (d_HAS_data.header.code_bias_flag)
// { // {
// // read code bias // // read code bias