mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2024-11-17 07:14:55 +00:00
Code Issues Releases Wiki Activity

writing code for crc computation in GLONASS processing

Browse Source
This commit is contained in:
Damian Miralles 2017-07-06 23:02:50 -07:00 committed by Damian Miralles
parent c24710c585
commit 6c8a29d3d4
2 changed files with 119 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

9
src/core/system_parameters/GLONASS_L1_CA.h
View File

@ -107,6 +107,15 @@ const int GLONASS_GNAV_FRAME_SECONDS = 30; //!< Subframe duration [seconds]
const int GLONASS_GNAV_FRAME_MS = 30000; //!< Subframe duration [seconds]
const int GLONASS_GNAV_STRING_BITS = 115; //!< Number of bits per string in the GNAV message (85 data bits + 30 time mark bits) [bits]
const std::vector<int> GLONASS_GNAV_CRC_I_INDEX {9, 10, 12, 13, 15, 17, 19, 20, 22, 24, 26, 28, 30, 32, 34, 35, 37, 39, 41, 43, 45, 47, 49, 51, 53, 55, 57, 59, 61, 63, 65, 66, 68, 70, 72, 74, 76, 78, 80, 82, 84};
const std::vector<int> GLONASS_GNAV_CRC_J_INDEX {9, 11, 12, 14, 15, 18, 19, 21, 22, 25, 26, 29, 30, 33, 34, 36, 37, 40, 41, 44, 45, 48, 49, 52, 53, 56, 57, 60, 61, 64, 65, 67, 68, 71, 72, 75, 76, 79, 80, 83, 84};
const std::vector<int> GLONASS_GNAV_CRC_K_INDEX {10, 11, 12, 16, 17, 18, 19, 23, 24, 25, 26, 31, 32, 33, 34 38, 39, 40, 41, 46, 47, 48, 49, 54, 55, 56, 57, 62, 63, 64, 65, 69, 70, 71, 72, 77, 78, 79, 80, 85};
const std::vector<int> GLONASS_GNAV_CRC_L_INDEX {9, 11, 12, 14, 15, 18, 19, 21, 22, 25, 26, 29, 30, 33, 34, 36, 37, 40, 41, 44, 45, 48, 49, 52, 53, 56, 57, 60, 61, 64, 65, 67, 68, 71, 72, 75, 76, 79, 80, 83, 84};
const std::vector<int> GLONASS_GNAV_CRC_M_INDEX {20, 21, 22, 23, 24, 25, 26, 27, 28, 29, 30, 31, 32, 33, 34, 50, 51, 52, 53, 54, 55, 56, 57, 58, 59, 60, 61, 62, 63, 64, 65, 81, 82, 83, 84, 85};
const std::vector<int> GLONASS_GNAV_CRC_N_INDEX {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};
const std::vector<int> GLONASS_GNAV_CRC_P_INDEX {66, 67, 68, 69, 70, 71, 72, 73, 74, 75, 76, 77, 78, 79, 80, 81, 82, 83, 84, 85};
const std::vector<int> GLONASS_GNAV_CRC_Q_INDEX {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};
// GLONASS GNAV NAVIGATION MESSAGE STRUCTURE
// NAVIGATION MESSAGE FIELDS POSITIONS (from IS-GPS-200E Appendix II)

111
src/core/system_parameters/glonass_gnav_navigation_message.cc
View File

@ -145,6 +145,81 @@ Glonass_Gnav_Navigation_Message::Glonass_Gnav_Navigation_Message()
reset();
}
bool Glonass_Gnav_Navigation_Message::_CRC_test(std::bitset<GLONASS_GNAV_STRING_BITS> data_bits, std::bitset<GLONASS_GNAV_STRING_BITS> hamming_code_bits )
{
int sum;
//!< Compute C1 term
sum = 0;
for(int i = 0; i < GLONASS_GNAV_CRC_I_INDEX.size; i++)
{
sum += data_bits[GLONASS_GNAV_CRC_I_INDEX[i]]
}
C1 = hamming_code_bits[0]^fmod(sum,2);
//!< Compute C2 term
sum = 0;
for(int j = 0; j < GLONASS_GNAV_CRC_J_INDEX.size; j++)
{
sum += data_bits[GLONASS_GNAV_CRC_J_INDEX[j]]
}
C2 = hamming_code_bits[1]^fmod(sum,2);
//!< Compute C3 term
sum = 0;
for(int k = 0; k < GLONASS_GNAV_CRC_K_INDEX.size; k++)
{
sum += data_bits[GLONASS_GNAV_CRC_K_INDEX[k]]
}
C3 = hamming_code_bits[2]^fmod(sum,2);
//!< Compute C4 term
sum = 0;
for(int l = 0; l < GLONASS_GNAV_CRC_L_INDEX.size; l++)
{
sum += data_bits[GLONASS_GNAV_CRC_L_INDEX[l]]
}
C4 = hamming_code_bits[3]^fmod(sum,2);
//!< Compute C5 term
sum = 0;
for(int m = 0; m < GLONASS_GNAV_CRC_M_INDEX.size; m++)
{
sum += data_bits[GLONASS_GNAV_CRC_M_INDEX[m]]
}
C5 = hamming_code_bits[4]^fmod(sum,2);
//!< Compute C6 term
sum = 0;
for(int n = 0; n < GLONASS_GNAV_CRC_N_INDEX.size; n++)
{
sum += data_bits[GLONASS_GNAV_CRC_N_INDEX[n]]
}
C6 = hamming_code_bits[5]^fmod(sum,2);
//!< Compute C7 term
sum = 0;
for(int p = 0; p < GLONASS_GNAV_CRC_P_INDEX.size; p++)
{
sum += data_bits[GLONASS_GNAV_CRC_P_INDEX[p]]
}
C7 = hamming_code_bits[6]^fmod(sum,2);
//!< Compute C8 term
sum = 0;
for(int q = 0; q < GLONASS_GNAV_CRC_Q_INDEX.size; q++)
{
sum += data_bits[GLONASS_GNAV_CRC_Q_INDEX[q]]
}
C8 = hamming_code_bits[7]^fmod(sum,2);
if isempty(find(C,1)) || (length(find(C(1,1:7))) == 1 && C(1,8) == 1)
status = 1;
else
status = 0;
end
}
bool Glonass_Gnav_Navigation_Message::read_navigation_bool(std::bitset<GLONASS_GNAV_STRING_BITS> bits, const std::vector<std::pair<int,int>> parameter)
{
@ -240,12 +315,46 @@ signed long int Glonass_Gnav_Navigation_Message::read_navigation_signed(std::bit
return value;
}
int Glonass_Gnav_Navigation_Message::string_decoder(char * frame_string, int frame_ID)
unsigned int Glonass_Gnav_Navigation_Message::get_frame_number(unsigned int satellite_slot_number)
{
unsigned int frame_ID = 0;
if(satellite_slot_number >= 1 and satellite_slot_number <= 5 )
{
frame_ID = 1;
}
else if(satellite_slot_number >= 6 and satellite_slot_number <= 10 )
{
frame_ID = 2;
}
else if(satellite_slot_number >= 11 and satellite_slot_number <= 15 )
{
frame_ID = 3;
}
else if(satellite_slot_number >= 16 and satellite_slot_number <= 20 )
{
frame_ID = 4;
}
else if(satellite_slot_number >= 21 and satellite_slot_number <= 24 )
{
frame_ID = 5;
}
else
{
//TODO Find print statement and make it an error
frame_ID = 0;
}
}
int Glonass_Gnav_Navigation_Message::string_decoder(char * frame_string)
{
int string_ID = 0;
int frame_ID = 0;
// UNPACK BYTES TO BITS AND REMOVE THE CRC REDUNDANCE
std::bitset<GLONASS_GNAV_STRING_BITS> string_bits(std::string(frame_string));
std::bitset<GLONASS_GNAV_STRING_BITS> data_bits(std::string(frame_string), 0, 77);
std::bitset<GLONASS_GNAV_STRING_BITS> hamming_code_bits(std::string(frame_string), 77, 8);
string_ID = static_cast<int>(read_navigation_unsigned(string_bits, STRING_ID));