mirrors/gnss-sdr
1
0
Fork 0
mirror of https://github.com/gnss-sdr/gnss-sdr synced 2025-10-31 07:13:03 +00:00
Code Issues Releases Wiki Activity

Merge branch 'next' of https://github.com/gnss-sdr/gnss-sdr into tow_crossover

Browse Source
This commit is contained in:
Javier Arribas
2019-05-13 12:28:44 +02:00
parent 33636758f1 da5e21a5b1
commit 78311a6dd6
2 changed files with 134 additions and 135 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
src/algorithms/PVT/libs/serdes_monitor_pvt.h
View File

@@ -76,7 +76,7 @@ public:
monitor_.set_cov_zz(monitor.cov_zz); monitor_.set_cov_zz(monitor.cov_zz);
monitor_.set_cov_xy(monitor.cov_xy); monitor_.set_cov_xy(monitor.cov_xy);
monitor_.set_cov_yz(monitor.cov_yz); monitor_.set_cov_yz(monitor.cov_yz);
monitor_.set_cov_yz(monitor.cov_yz); monitor_.set_cov_zx(monitor.cov_zx);
monitor_.set_latitude(monitor.latitude); monitor_.set_latitude(monitor.latitude);
monitor_.set_longitude(monitor.longitude); monitor_.set_longitude(monitor.longitude);
monitor_.set_height(monitor.height); monitor_.set_height(monitor.height);

267
src/algorithms/signal_source/gnuradio_blocks/labsat23_source.cc
View File

@@ -198,6 +198,8 @@ void labsat23_source::decode_samples_one_channel(int16_t input_short, gr_complex
//out[i] += gr_complex(0.5, 0.5); //out[i] += gr_complex(0.5, 0.5);
} }
break; break;
default:
break;
} }
} }
@@ -225,7 +227,6 @@ int labsat23_source::general_work(int noutput_items,
{ {
preamble_ok = false; preamble_ok = false;
} }
//std::cout << "H[" << i << "]:" << (int)memblock[byte_counter] << std::endl;
byte_counter++; byte_counter++;
} }
@@ -266,17 +267,14 @@ int labsat23_source::general_work(int noutput_items,
header_bytes += memblock[byte_counter] | (memblock[byte_counter + 1] << 8) | (memblock[byte_counter + 2] << 16) | (memblock[byte_counter + 3] << 24); header_bytes += memblock[byte_counter] | (memblock[byte_counter + 1] << 8) | (memblock[byte_counter + 2] << 16) | (memblock[byte_counter + 3] << 24);
byte_counter += 4; byte_counter += 4;
//std::cout << "header_bytes=" << header_bytes << std::endl;
// read first section // read first section
// section ID (little-endian) // section ID (little-endian)
uint8_t section_id = static_cast<int>(memblock[byte_counter]) + static_cast<int>(memblock[byte_counter + 1]) * 256; uint8_t section_id = static_cast<int>(memblock[byte_counter]) + static_cast<int>(memblock[byte_counter + 1]) * 256;
//std::cout << "Section ID: " << (int)section_id << std::endl;
byte_counter += 2; byte_counter += 2;
//uint8_t section_lenght_bytes = 0; //uint8_t section_lenght_bytes = 0;
//section_lenght_bytes += memblock[byte_counter] | (memblock[byte_counter + 1] << 8) | (memblock[byte_counter + 2] << 16) | (memblock[byte_counter + 3] << 24); //section_lenght_bytes += memblock[byte_counter] | (memblock[byte_counter + 1] << 8) | (memblock[byte_counter + 2] << 16) | (memblock[byte_counter + 3] << 24);
//std::cout << "section_lenght_bytes=" << (int)section_lenght_bytes << std::endl;
byte_counter += 4; byte_counter += 4;
if (section_id == 2) if (section_id == 2)
@@ -285,10 +283,10 @@ int labsat23_source::general_work(int noutput_items,
switch (d_ref_clock) switch (d_ref_clock)
{ {
case 0: case 0:
std::cout << "Labsat reference clock: internal OXCO" << std::endl; std::cout << "Labsat reference clock: internal OCXO" << std::endl;
break; break;
case 1: case 1:
std::cout << "Labsat reference clock: internal TXCO" << std::endl; std::cout << "Labsat reference clock: internal TCXO" << std::endl;
break; break;
case 2: case 2:
std::cout << "Labsat reference clock: external 10 MHz" << std::endl; std::cout << "Labsat reference clock: external 10 MHz" << std::endl;
@@ -319,19 +317,19 @@ int labsat23_source::general_work(int noutput_items,
switch (d_channel_selector) switch (d_channel_selector)
{ {
case 0: case 0:
std::cout << "Available channels: Channel A + B, 1 bit quantisation" << std::endl; std::cout << "Available channels: Channel A + B, 1 bit quantisation (I & Q)" << std::endl;
break; break;
case 1: case 1:
std::cout << "Available channels: Channel A, 1 bit quantisation" << std::endl; std::cout << "Available channels: Channel A, 1 bit quantisation (I & Q)" << std::endl;
break; break;
case 2: case 2:
std::cout << "Available channels: Channel B, 1 bit quantisation" << std::endl; std::cout << "Available channels: Channel B, 1 bit quantisation (I & Q)" << std::endl;
break; break;
case 3: case 3:
std::cout << "Available channels: Channel A, 2 bit quantisation" << std::endl; std::cout << "Available channels: Channel A, 2 bit quantisation (I & Q)" << std::endl;
break; break;
case 4: case 4:
std::cout << "Available channels: Channel B, 2 bit quantisation" << std::endl; std::cout << "Available channels: Channel B, 2 bit quantisation (I & Q)" << std::endl;
break; break;
default: default:
std::cout << "Unknown channel selection ID " << static_cast<int>(d_channel_selector) << std::endl; std::cout << "Unknown channel selection ID " << static_cast<int>(d_channel_selector) << std::endl;
@@ -355,6 +353,8 @@ int labsat23_source::general_work(int noutput_items,
auto quantization = static_cast<uint8_t>(memblock[byte_counter]); auto quantization = static_cast<uint8_t>(memblock[byte_counter]);
switch (quantization) switch (quantization)
{ {
case 0:
break;
case 1: case 1:
std::cout << "1 bit per sample" << std::endl; std::cout << "1 bit per sample" << std::endl;
break; break;
@@ -393,6 +393,9 @@ int labsat23_source::general_work(int noutput_items,
case 2: case 2:
std::cout << "Labsat Channel B is BDS" << std::endl; std::cout << "Labsat Channel B is BDS" << std::endl;
break; break;
case 255:
// No channel B
break;
default: default:
std::cout << "Unknown channel B constellation ID " << static_cast<int>(channel_b_constellation) << std::endl; std::cout << "Unknown channel B constellation ID " << static_cast<int>(channel_b_constellation) << std::endl;
} }
@@ -415,133 +418,129 @@ int labsat23_source::general_work(int noutput_items,
switch (d_bits_per_sample) switch (d_bits_per_sample)
{ {
case 2: case 2:
{ switch (d_channel_selector)
switch (d_channel_selector) {
{ case 0:
case 0: // dual channel 2 bits per complex sample
// dual channel 2 bits per complex sample //todo: implement dual channel reader
//todo: implement dual channel reader break;
break; default:
default: // single channel 2 bits per complex sample (1 bit I + 1 bit Q, 8 samples per int16)
// single channel 2 bits per complex sample (1 bit I + 1 bit Q, 8 samples per int16) int n_int16_to_read = noutput_items / 8;
int n_int16_to_read = noutput_items / 8; if (n_int16_to_read > 0)
if (n_int16_to_read > 0) {
{ int16_t memblock[n_int16_to_read];
int16_t memblock[n_int16_to_read]; binary_input_file->read(reinterpret_cast<char *>(memblock), n_int16_to_read * 2);
binary_input_file->read(reinterpret_cast<char *>(memblock), n_int16_to_read * 2); n_int16_to_read = binary_input_file->gcount() / 2; //from bytes to int16
n_int16_to_read = binary_input_file->gcount() / 2; //from bytes to int16 if (n_int16_to_read > 0)
if (n_int16_to_read > 0) {
{ int output_pointer = 0;
int output_pointer = 0; for (int i = 0; i < n_int16_to_read; i++)
for (int i = 0; i < n_int16_to_read; i++) {
{ decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample);
decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample); output_pointer += 8;
output_pointer += 8; }
} return output_pointer;
return output_pointer; }
}
// trigger the read of the next file in the sequence // trigger the read of the next file in the sequence
if (d_labsat_version == 3) d_current_file_number++;
{ if (d_labsat_version == 3)
std::cout << "End of current file, reading the next Labsat file in sequence: " << generate_filename() << std::endl; {
} std::cout << "End of current file, reading the next Labsat file in sequence: " << generate_filename() << std::endl;
d_current_file_number++; }
binary_input_file->close(); binary_input_file->close();
binary_input_file->open(generate_filename().c_str(), std::ios::in | std::ios::binary); binary_input_file->open(generate_filename().c_str(), std::ios::in | std::ios::binary);
if (binary_input_file->is_open()) if (binary_input_file->is_open())
{ {
std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl; std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl;
} return 0;
else }
{ else
if (d_labsat_version == 3) {
{ if (d_labsat_version == 3)
std::cout << "Last file reached, LabSat source stop" << std::endl; {
} std::cout << "Last file reached, LabSat source stop" << std::endl;
else }
{ else
std::cout << "End of file reached, LabSat source stop" << std::endl; {
} std::cout << "End of file reached, LabSat source stop" << std::endl;
auto *cmf = new ControlMessageFactory(); }
d_queue->handle(cmf->GetQueueMessage(200, 0)); auto *cmf = new ControlMessageFactory();
delete cmf; d_queue->handle(cmf->GetQueueMessage(200, 0));
return -1; delete cmf;
} return -1;
} }
else }
{ else
return 0; {
} return 0;
}; }
break; }
} break;
case 4: case 4:
{ switch (d_channel_selector)
switch (d_channel_selector) {
{ case 0:
case 0: // dual channel
// dual channel //todo: implement dual channel reader
//todo: implement dual channel reader break;
break; default:
default: // single channel 4 bits per complex sample (2 bit I + 2 bit Q, 4 samples per int16)
// single channel 4 bits per complex sample (2 bit I + 2 bit Q, 4 samples per int16) int n_int16_to_read = noutput_items / 4;
int n_int16_to_read = noutput_items / 4; if (n_int16_to_read > 0)
if (n_int16_to_read > 0) {
{ int16_t memblock[n_int16_to_read];
int16_t memblock[n_int16_to_read]; binary_input_file->read(reinterpret_cast<char *>(memblock), n_int16_to_read * 2);
binary_input_file->read(reinterpret_cast<char *>(memblock), n_int16_to_read * 2); n_int16_to_read = binary_input_file->gcount() / 2; // from bytes to int16
n_int16_to_read = binary_input_file->gcount() / 2; //from bytes to int16 if (n_int16_to_read > 0)
if (n_int16_to_read > 0) {
{ int output_pointer = 0;
int output_pointer = 0; for (int i = 0; i < n_int16_to_read; i++)
for (int i = 0; i < n_int16_to_read; i++) {
{ decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample);
decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample); output_pointer += 4;
output_pointer += 4; }
} return output_pointer;
return output_pointer; }
}
// trigger the read of the next file in the sequence // trigger the read of the next file in the sequence
if (d_labsat_version == 3) d_current_file_number++;
{ if (d_labsat_version == 3)
std::cout << "End of current file, reading the next Labsat file in sequence: " << generate_filename() << std::endl; {
} std::cout << "End of current file, reading the next Labsat file in sequence: " << generate_filename() << std::endl;
d_current_file_number++; }
binary_input_file->close(); binary_input_file->close();
binary_input_file->open(generate_filename().c_str(), std::ios::in | std::ios::binary); binary_input_file->open(generate_filename().c_str(), std::ios::in | std::ios::binary);
if (binary_input_file->is_open()) if (binary_input_file->is_open())
{ {
std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl; std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl;
} return 0;
else }
{ else
if (d_labsat_version == 3) {
{ if (d_labsat_version == 3)
std::cout << "Last file reached, LabSat source stop" << std::endl; {
} std::cout << "Last file reached, LabSat source stop" << std::endl;
else }
{ else
std::cout << "End of file reached, LabSat source stop" << std::endl; {
} std::cout << "End of file reached, LabSat source stop" << std::endl;
auto *cmf = new ControlMessageFactory(); }
d_queue->handle(cmf->GetQueueMessage(200, 0)); auto *cmf = new ControlMessageFactory();
delete cmf; d_queue->handle(cmf->GetQueueMessage(200, 0));
return -1; delete cmf;
} return -1;
} }
else }
{ else
return 0; {
} return 0;
} }
break; }
} break;
default: default:
{ return -1;
return -1;
}
} }
std::cout << "Warning!!" << std::endl; std::cout << "Warning!!" << std::endl;