mirror of
https://github.com/gnss-sdr/gnss-sdr
synced 2024-06-25 06:23:18 +00:00
Merge branch 'next' of https://github.com/gnss-sdr/gnss-sdr into glonass
This commit is contained in:
Carles Fernandez
commit
0545905fef
|
|
@ -29,8 +29,8 @@
|
|||
*/
|
||||
|
||||
|
||||
#ifndef GN3S_SIGNAL_SOURCE_H_
|
||||
#define GN3S_SIGNAL_SOURCE_H_
|
||||
#ifndef GNSS_SDR_GN3S_SIGNAL_SOURCE_H_
|
||||
#define GNSS_SDR_GN3S_SIGNAL_SOURCE_H_
|
||||
|
||||
#include <string>
|
||||
#include <gnuradio/hier_block2.h>
|
||||
|
|
@ -90,4 +90,4 @@ private:
|
|||
boost::shared_ptr<gr::msg_queue> queue_;
|
||||
};
|
||||
|
||||
#endif /*GN3S_SIGNAL_SOURCE_H_*/
|
||||
#endif /*GNSS_SDR_GN3S_SIGNAL_SOURCE_H_*/
|
||||
|
|
|
|||
|
|
@ -29,9 +29,6 @@
|
|||
*/
|
||||
|
||||
#include "labsat_signal_source.h"
|
||||
#include <gnuradio/blocks/file_sink.h>
|
||||
#include <gnuradio/msg_queue.h>
|
||||
#include <gflags/gflags.h>
|
||||
#include <glog/logging.h>
|
||||
#include "labsat23_source.h"
|
||||
#include "configuration_interface.h"
|
||||
|
|
@ -49,7 +46,7 @@ LabsatSignalSource::LabsatSignalSource(ConfigurationInterface* configuration,
|
|||
dump_ = configuration->property(role + ".dump", false);
|
||||
dump_filename_ = configuration->property(role + ".dump_filename", default_dump_file);
|
||||
|
||||
int channel_selector=configuration->property(role + ".selected_channel", 1);
|
||||
int channel_selector = configuration->property(role + ".selected_channel", 1);
|
||||
std::string default_filename = "./example_capture.LS3";
|
||||
|
||||
samples_ = configuration->property(role + ".samples", 0);
|
||||
|
|
@ -61,10 +58,10 @@ LabsatSignalSource::LabsatSignalSource(ConfigurationInterface* configuration,
|
|||
labsat23_source_ = labsat23_make_source(filename_.c_str(),channel_selector);
|
||||
DLOG(INFO) << "Item size " << item_size_;
|
||||
DLOG(INFO) << "labsat23_source_(" << labsat23_source_->unique_id() << ")";
|
||||
}else
|
||||
}
|
||||
else
|
||||
{
|
||||
LOG(WARNING) << item_type_
|
||||
<< " unrecognized item type for LabSat source";
|
||||
LOG(WARNING) << item_type_ << " unrecognized item type for LabSat source";
|
||||
item_size_ = sizeof(short);
|
||||
}
|
||||
if (dump_)
|
||||
|
|
|
|||
|
|
@ -29,8 +29,8 @@
|
|||
*/
|
||||
|
||||
|
||||
#ifndef LABSAT_SIGNAL_SOURCE_H_
|
||||
#define LABSAT_SIGNAL_SOURCE_H_
|
||||
#ifndef GNSS_SDR_LABSAT_SIGNAL_SOURCE_H_
|
||||
#define GNSS_SDR_LABSAT_SIGNAL_SOURCE_H_
|
||||
|
||||
#include <string>
|
||||
#include <gnuradio/hier_block2.h>
|
||||
|
|
@ -42,7 +42,7 @@
|
|||
class ConfigurationInterface;
|
||||
|
||||
/*!
|
||||
* \brief This class reads samples from a GN3S USB dongle, a RF front-end signal sampler
|
||||
* \brief This class reads samples stored by a LabSat 2 or LabSat 3 device
|
||||
*/
|
||||
class LabsatSignalSource: public GNSSBlockInterface
|
||||
{
|
||||
|
|
@ -59,7 +59,7 @@ public:
|
|||
}
|
||||
|
||||
/*!
|
||||
* \brief Returns "LabsatSignalSource".
|
||||
* \brief Returns "Labsat_Signal_Source".
|
||||
*/
|
||||
inline std::string implementation() override
|
||||
{
|
||||
|
|
@ -91,4 +91,4 @@ private:
|
|||
boost::shared_ptr<gr::msg_queue> queue_;
|
||||
};
|
||||
|
||||
#endif /*LABSAT_SIGNAL_SOURCE_H_*/
|
||||
#endif /*GNSS_SDR_LABSAT_SIGNAL_SOURCE_H_*/
|
||||
|
|
|
|||
|
|
@ -36,439 +36,462 @@
|
|||
#include <gnuradio/io_signature.h>
|
||||
#include <sstream>
|
||||
|
||||
|
||||
labsat23_source_sptr labsat23_make_source(const char *signal_file_basename, int channel_selector)
|
||||
{
|
||||
return labsat23_source_sptr(new labsat23_source(signal_file_basename, channel_selector));
|
||||
}
|
||||
|
||||
|
||||
std::string labsat23_source::generate_filename()
|
||||
{
|
||||
std::ostringstream ss;
|
||||
ss << std::setw(4) << std::setfill('0') << d_current_file_number;
|
||||
return d_signal_file_basename + "_" + ss.str()+".LS3";
|
||||
|
||||
}
|
||||
|
||||
|
||||
labsat23_source::labsat23_source(const char *signal_file_basename, int channel_selector) : gr::block("labsat23_source",
|
||||
gr::io_signature::make(0, 0, 0),
|
||||
gr::io_signature::make(1, 1, sizeof(gr_complex)))
|
||||
gr::io_signature::make(0, 0, 0),
|
||||
gr::io_signature::make(1, 1, sizeof(gr_complex)))
|
||||
{
|
||||
if (channel_selector<1 or channel_selector>2)
|
||||
{
|
||||
std::cout<<"Labsat source config error: channel selection out of bounds, check gnss-sdr config file"<<std::endl;
|
||||
exit(1);
|
||||
}
|
||||
d_channel_selector_config=channel_selector;
|
||||
d_header_parsed=false;
|
||||
d_bits_per_sample=0;
|
||||
d_current_file_number=0;
|
||||
d_labsat_version=0;
|
||||
d_signal_file_basename=std::string(signal_file_basename);
|
||||
if (channel_selector < 1 or channel_selector > 2)
|
||||
{
|
||||
std::cout << "Labsat source config error: channel selection out of bounds, check gnss-sdr config file" << std::endl;
|
||||
exit(1);
|
||||
}
|
||||
d_channel_selector_config = channel_selector;
|
||||
d_header_parsed = false;
|
||||
d_bits_per_sample = 0;
|
||||
d_current_file_number = 0;
|
||||
d_labsat_version = 0;
|
||||
d_ref_clock = 0;
|
||||
d_channel_selector = 0;
|
||||
d_signal_file_basename = std::string(signal_file_basename);
|
||||
|
||||
std::string signal_file;
|
||||
this->set_output_multiple(8);
|
||||
signal_file=generate_filename();
|
||||
signal_file = generate_filename();
|
||||
binary_input_file = new std::ifstream (signal_file.c_str(), std::ios::in|std::ios::binary);
|
||||
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
std::cout<<"Labsat file source is reading samples from "<<signal_file<<std::endl;
|
||||
}else{
|
||||
std::cout<<"Labsat file "<<signal_file<<" could not be opened!"<<std::endl;
|
||||
delete binary_input_file;
|
||||
exit(1);
|
||||
}
|
||||
|
||||
{
|
||||
std::cout << "Labsat file source is reading samples from " << signal_file << std::endl;
|
||||
}
|
||||
else
|
||||
{
|
||||
std::cout << "Labsat file " << signal_file << " could not be opened!" << std::endl;
|
||||
delete binary_input_file;
|
||||
exit(1);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
labsat23_source::~labsat23_source()
|
||||
{
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
binary_input_file->close();
|
||||
}
|
||||
{
|
||||
binary_input_file->close();
|
||||
}
|
||||
delete binary_input_file;
|
||||
}
|
||||
|
||||
|
||||
int labsat23_source::getBit(uint8_t byte, int position)
|
||||
{
|
||||
return (byte >> position) & 0x01;
|
||||
}
|
||||
|
||||
|
||||
void labsat23_source::decode_samples_one_channel(int16_t input_short, gr_complex* out, int type)
|
||||
{
|
||||
std::bitset<16> bs(input_short);
|
||||
switch(type)
|
||||
{
|
||||
case 2:
|
||||
//two bits per sample, 8 samples per int16
|
||||
for (int i=0;i<8;i++)
|
||||
case 2:
|
||||
//two bits per sample, 8 samples per int16
|
||||
for (int i = 0; i < 8; i++)
|
||||
{
|
||||
out[i]=gr_complex(static_cast<float>(bs[15-(2*i)]),
|
||||
static_cast<float>(bs[14-(2*i)]));
|
||||
out[i]=out[i]*gr_complex(2,0)-gr_complex(1,1);
|
||||
out[i] = gr_complex(static_cast<float>(bs[15-(2*i)]),
|
||||
static_cast<float>(bs[14-(2*i)]));
|
||||
out[i] = out[i]*gr_complex(2,0)-gr_complex(1,1);
|
||||
}
|
||||
break;
|
||||
case 4:
|
||||
//four bits per sample, 4 samples per int16
|
||||
for (int i=0;i<4;i++)
|
||||
break;
|
||||
case 4:
|
||||
//four bits per sample, 4 samples per int16
|
||||
for (int i = 0; i < 4; i++)
|
||||
{
|
||||
out[i]=gr_complex(0.0,0.0);
|
||||
out[i] = gr_complex(0.0,0.0);
|
||||
//In-Phase
|
||||
if (bs[15-4*i])
|
||||
{
|
||||
if (bs[13-4*i]) //11
|
||||
{
|
||||
out[i]+=gr_complex(-1,0);
|
||||
if (bs[13-4*i]) //11
|
||||
{
|
||||
out[i] += gr_complex(-1,0);
|
||||
}
|
||||
else //10
|
||||
{
|
||||
out[i] += gr_complex(-2,0);
|
||||
}
|
||||
}
|
||||
else //10
|
||||
else
|
||||
{
|
||||
out[i]+=gr_complex(-2,0);
|
||||
if (bs[13-4*i]) //01
|
||||
{
|
||||
out[i] += gr_complex(1,0);
|
||||
}
|
||||
}
|
||||
}
|
||||
else{
|
||||
if (bs[13-4*i]) //01
|
||||
{
|
||||
out[i]+=gr_complex(1,0);
|
||||
}
|
||||
}
|
||||
|
||||
//Quadrature
|
||||
if (bs[14-4*i])
|
||||
{
|
||||
if (bs[12-4*i]) //11
|
||||
{
|
||||
out[i]+=gr_complex(0,-1);
|
||||
if (bs[12-4*i]) //11
|
||||
{
|
||||
out[i] += gr_complex(0,-1);
|
||||
}
|
||||
else //10
|
||||
{
|
||||
out[i] += gr_complex(0,-2);
|
||||
}
|
||||
}
|
||||
else //10
|
||||
else
|
||||
{
|
||||
out[i]+=gr_complex(0,-2);
|
||||
if (bs[12-4*i]) //01
|
||||
{
|
||||
out[i] += gr_complex(0,1);
|
||||
}
|
||||
}
|
||||
}
|
||||
else{
|
||||
if (bs[12-4*i]) //01
|
||||
{
|
||||
out[i]+=gr_complex(0,1);
|
||||
}
|
||||
}
|
||||
out[i]+=gr_complex(0.5,0.5);
|
||||
out[i] += gr_complex(0.5,0.5);
|
||||
}
|
||||
break;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int labsat23_source::general_work(int noutput_items,
|
||||
__attribute__((unused)) gr_vector_int &ninput_items,
|
||||
__attribute__((unused)) gr_vector_const_void_star &input_items,
|
||||
gr_vector_void_star &output_items)
|
||||
{
|
||||
|
||||
int labsat23_source::general_work(int noutput_items,
|
||||
__attribute__((unused)) gr_vector_int &ninput_items,
|
||||
__attribute__((unused)) gr_vector_const_void_star &input_items,
|
||||
gr_vector_void_star &output_items)
|
||||
{
|
||||
gr_complex *out = reinterpret_cast<gr_complex *>(output_items[0]);
|
||||
|
||||
if (d_header_parsed==false)
|
||||
{
|
||||
|
||||
if (binary_input_file->eof()==false)
|
||||
if (d_header_parsed == false)
|
||||
{
|
||||
char memblock[1024];
|
||||
binary_input_file->read(memblock,1024);
|
||||
//parse Labsat header
|
||||
//check preamble
|
||||
int byte_counter=0;
|
||||
bool preamble_ok=true;
|
||||
for (int i=0;i<8;i++)
|
||||
{
|
||||
if (memblock[byte_counter]!=0x00) preamble_ok=false;
|
||||
//std::cout<<"H["<<i<<"]:"<<(int)memblock[byte_counter]<<std::endl;
|
||||
byte_counter++;
|
||||
}
|
||||
|
||||
if (preamble_ok==false)
|
||||
{
|
||||
std::cout<<"Labsat source do not detect the preamble in the selected file"<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
// check Labsat version
|
||||
if (memblock[byte_counter]==0x4C and memblock[byte_counter+1]==0x53 and memblock[byte_counter+2]==0x32)
|
||||
{
|
||||
d_labsat_version=2;
|
||||
std::cout<<"Labsat file version 2 detected"<<std::endl;
|
||||
}
|
||||
|
||||
if (memblock[byte_counter]==0x4C and memblock[byte_counter+1]==0x53 and memblock[byte_counter+2]==0x33)
|
||||
{
|
||||
d_labsat_version=3;
|
||||
std::cout<<"Labsat file version 3 detected"<<std::endl;
|
||||
}
|
||||
|
||||
if (d_labsat_version==0)
|
||||
{
|
||||
std::cout<<"Labsat source do not detect the labsat version in file header"<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
byte_counter+=3;
|
||||
|
||||
int sub_version=(int)memblock[byte_counter];
|
||||
|
||||
std::cout<<"Labsat file sub version "<<sub_version<<std::endl;
|
||||
|
||||
byte_counter++;
|
||||
|
||||
int header_bytes=0;
|
||||
header_bytes += memblock[byte_counter] | (memblock[byte_counter+1]<<8) | (memblock[byte_counter+2]<<16) | (memblock[byte_counter+3]<<24);
|
||||
|
||||
byte_counter+=4;
|
||||
//std::cout<<"header_bytes="<<header_bytes<<std::endl;
|
||||
|
||||
// read first section
|
||||
// section ID (little-endian)
|
||||
uint8_t section_id=(int)memblock[byte_counter]+(int)memblock[byte_counter+1]*256;
|
||||
//std::cout<<"Section ID: "<<(int)section_id<<std::endl;
|
||||
byte_counter+=2;
|
||||
|
||||
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);
|
||||
//std::cout<<"section_lenght_bytes="<<(int)section_lenght_bytes<<std::endl;
|
||||
|
||||
byte_counter+=4;
|
||||
if (section_id==2)
|
||||
{
|
||||
d_ref_clock=(uint8_t)memblock[byte_counter];
|
||||
switch(d_ref_clock)
|
||||
if (binary_input_file->eof() == false)
|
||||
{
|
||||
case 0:
|
||||
std::cout<<"Labsat reference clock: internal OXCO"<<std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout<<"Labsat reference clock: internal TXCO"<<std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout<<"Labsat reference clock: external 10 MHz"<<std::endl;
|
||||
break;
|
||||
case 3:
|
||||
std::cout<<"Labsat reference clock: external 16.386 MHz"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Labsat Unknown reference clock ID "<<(int)d_ref_clock<<std::endl;
|
||||
char memblock[1024];
|
||||
binary_input_file->read(memblock, 1024);
|
||||
//parse Labsat header
|
||||
//check preamble
|
||||
int byte_counter = 0;
|
||||
bool preamble_ok = true;
|
||||
for (int i = 0; i < 8; i++)
|
||||
{
|
||||
if (memblock[byte_counter] != 0x00) preamble_ok = false;
|
||||
//std::cout << "H[" << i << "]:" << (int)memblock[byte_counter] << std::endl;
|
||||
byte_counter++;
|
||||
}
|
||||
|
||||
if (preamble_ok == false)
|
||||
{
|
||||
std::cout << "Labsat source do not detect the preamble in the selected file" << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
// check Labsat version
|
||||
if (memblock[byte_counter] == 0x4C and memblock[byte_counter+1] == 0x53 and memblock[byte_counter+2] == 0x32)
|
||||
{
|
||||
d_labsat_version = 2;
|
||||
std::cout << "Labsat file version 2 detected" << std::endl;
|
||||
}
|
||||
|
||||
if (memblock[byte_counter] == 0x4C and memblock[byte_counter+1] == 0x53 and memblock[byte_counter+2] == 0x33)
|
||||
{
|
||||
d_labsat_version = 3;
|
||||
std::cout << "Labsat file version 3 detected" << std::endl;
|
||||
}
|
||||
|
||||
if (d_labsat_version == 0)
|
||||
{
|
||||
std::cout << "Labsat source do not detect the labsat version in file header" << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
byte_counter += 3;
|
||||
|
||||
int sub_version = static_cast<int>(memblock[byte_counter]);
|
||||
|
||||
std::cout << "Labsat file sub version " << sub_version << std::endl;
|
||||
|
||||
byte_counter++;
|
||||
|
||||
int header_bytes = 0;
|
||||
header_bytes += memblock[byte_counter] | (memblock[byte_counter+1] << 8) | (memblock[byte_counter+2] << 16) | (memblock[byte_counter+3] << 24);
|
||||
|
||||
byte_counter += 4;
|
||||
//std::cout << "header_bytes=" << header_bytes << std::endl;
|
||||
|
||||
// read first section
|
||||
// section ID (little-endian)
|
||||
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;
|
||||
|
||||
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);
|
||||
//std::cout << "section_lenght_bytes=" << (int)section_lenght_bytes << std::endl;
|
||||
|
||||
byte_counter += 4;
|
||||
if (section_id == 2)
|
||||
{
|
||||
d_ref_clock = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(d_ref_clock)
|
||||
{
|
||||
case 0:
|
||||
std::cout << "Labsat reference clock: internal OXCO" << std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout << "Labsat reference clock: internal TXCO" << std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout << "Labsat reference clock: external 10 MHz" << std::endl;
|
||||
break;
|
||||
case 3:
|
||||
std::cout << "Labsat reference clock: external 16.386 MHz" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Labsat Unknown reference clock ID " << static_cast<int>(d_ref_clock) << std::endl;
|
||||
}
|
||||
byte_counter++;
|
||||
d_bits_per_sample = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(d_bits_per_sample)
|
||||
{
|
||||
case 2:
|
||||
std::cout << "Labsat is using 2 bits per sample" << std::endl;
|
||||
break;
|
||||
case 4:
|
||||
std::cout << "Labsat is using 4 bits per sample" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Labsat Unknown bits per sample ID " << static_cast<int>(d_bits_per_sample) << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
byte_counter++;
|
||||
d_channel_selector = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(d_channel_selector)
|
||||
{
|
||||
case 0:
|
||||
std::cout << "Available channels: Channel A + B, 1 bit quantisation" << std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout << "Available channels: Channel A, 1 bit quantisation" << std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout << "Available channels: Channel B, 1 bit quantisation" << std::endl;
|
||||
break;
|
||||
case 3:
|
||||
std::cout << "Available channels: Channel A, 2 bit quantisation" << std::endl;
|
||||
break;
|
||||
case 4:
|
||||
std::cout << "Available channels: Channel B, 2 bit quantisation" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Unknown channel selection ID " << static_cast<int>(d_channel_selector) << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
//check if the selected channel in config file match the file encoding
|
||||
if (d_channel_selector_config == 2 and d_channel_selector != 0)
|
||||
{
|
||||
std::cout << "Labsat source channel config inconsistency: channel 2 is selected but the file has only one channel" << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
//todo: Add support for dual channel files
|
||||
if (d_channel_selector == 0)
|
||||
{
|
||||
std::cout << "ERROR: Labsat file contains more than one channel and it is not currently supported by Labsat signal source." << std::endl;
|
||||
return -1;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t quantization = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(quantization)
|
||||
{
|
||||
case 1:
|
||||
std::cout << "1 bit per sample" << std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout << "2 bit per sample" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Unknown quantization ID " << static_cast<int>(quantization) << std::endl;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t channel_a_constellation = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(channel_a_constellation)
|
||||
{
|
||||
case 0:
|
||||
std::cout << "Labsat Channel A is GPS" << std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout << "Labsat Channel A is GLONASS" << std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout << "Labsat Channel A is BDS" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Unknown channel A constellation ID " << static_cast<int>(channel_a_constellation) << std::endl;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t channel_b_constellation = static_cast<uint8_t>(memblock[byte_counter]);
|
||||
switch(channel_b_constellation)
|
||||
{
|
||||
case 0:
|
||||
std::cout << "Labsat Channel B is GPS" << std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout << "Labsat Channel B is GLONASS" << std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout << "Labsat Channel B is BDS" << std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout << "Unknown channel B constellation ID " << static_cast<int>(channel_b_constellation) << std::endl;
|
||||
}
|
||||
|
||||
//end of header
|
||||
d_header_parsed = true;
|
||||
//seek file to the first signal sample
|
||||
binary_input_file->clear();
|
||||
binary_input_file->seekg(header_bytes, binary_input_file->beg);
|
||||
return 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
std::cout << "Labsat file header error: section 2 is not available." << std::endl;
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
byte_counter++;
|
||||
d_bits_per_sample=(uint8_t)memblock[byte_counter];
|
||||
switch(d_bits_per_sample)
|
||||
else
|
||||
{
|
||||
case 2:
|
||||
std::cout<<"Labsat is using 2 bits per sample"<<std::endl;
|
||||
break;
|
||||
case 4:
|
||||
std::cout<<"Labsat is using 4 bits per sample"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Labsat Unknown bits per sample ID "<<(int)d_bits_per_sample<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
byte_counter++;
|
||||
d_channel_selector=(uint8_t)memblock[byte_counter];
|
||||
switch(d_channel_selector)
|
||||
{
|
||||
case 0:
|
||||
std::cout<<"Available channels: Channel A + B, 1 bit quantisation"<<std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout<<"Available channels: Channel A, 1 bit quantisation"<<std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout<<"Available channels: Channel B, 1 bit quantisation"<<std::endl;
|
||||
break;
|
||||
case 3:
|
||||
std::cout<<"Available channels: Channel A, 2 bit quantisation"<<std::endl;
|
||||
break;
|
||||
case 4:
|
||||
std::cout<<"Available channels: Channel B, 2 bit quantisation"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Unknown channel selection ID "<<(int)d_channel_selector<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
//check if the selected channel in config file match the file encoding
|
||||
if (d_channel_selector_config==2 and d_channel_selector!=0)
|
||||
{
|
||||
std::cout<<"Labsat source channel config inconsistency: channel 2 is selected but the file has only one channel"<<std::endl;
|
||||
std::cout << "Labsat file read error: file is empty." << std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
//todo: Add support for dual channel files
|
||||
if (d_channel_selector==0)
|
||||
{
|
||||
std::cout<<"ERROR: Labsat file contains more than one channel and it is not currently supported by Labsat signal source."<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t quantization=(uint8_t)memblock[byte_counter];
|
||||
switch(quantization)
|
||||
{
|
||||
case 1:
|
||||
std::cout<<"1 bit per sample"<<std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout<<"2 bit per sample"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Unknown quantization ID "<<(int)quantization<<std::endl;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t channel_a_constellation=(uint8_t)memblock[byte_counter];
|
||||
switch(channel_a_constellation)
|
||||
{
|
||||
case 0:
|
||||
std::cout<<"Labsat Channel A is GPS"<<std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout<<"Labsat Channel A is GLONASS"<<std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout<<"Labsat Channel A is BDS"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Unknown channel A constellation ID "<<(int)channel_a_constellation<<std::endl;
|
||||
}
|
||||
byte_counter++;
|
||||
uint8_t channel_b_constellation=(uint8_t)memblock[byte_counter];
|
||||
switch(channel_b_constellation)
|
||||
{
|
||||
case 0:
|
||||
std::cout<<"Labsat Channel B is GPS"<<std::endl;
|
||||
break;
|
||||
case 1:
|
||||
std::cout<<"Labsat Channel B is GLONASS"<<std::endl;
|
||||
break;
|
||||
case 2:
|
||||
std::cout<<"Labsat Channel B is BDS"<<std::endl;
|
||||
break;
|
||||
default:
|
||||
std::cout<<"Unknown channel B constellation ID "<<(int)channel_b_constellation<<std::endl;
|
||||
}
|
||||
|
||||
//end of header
|
||||
d_header_parsed=true;
|
||||
//seek file to the first signal sample
|
||||
binary_input_file->clear();
|
||||
binary_input_file->seekg(header_bytes, binary_input_file->beg);
|
||||
return 0;
|
||||
}else{
|
||||
std::cout<<"Labsat file header error: section 2 is not available."<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
|
||||
}else{
|
||||
std::cout<<"Labsat file read error: file is empty."<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
}else{
|
||||
//ready to start reading samples
|
||||
switch(d_bits_per_sample)
|
||||
else
|
||||
{
|
||||
case 2:
|
||||
//ready to start reading samples
|
||||
switch(d_bits_per_sample)
|
||||
{
|
||||
switch(d_channel_selector)
|
||||
case 2:
|
||||
{
|
||||
switch(d_channel_selector)
|
||||
{
|
||||
case 0:
|
||||
// dual channel 2 bits per complex sample
|
||||
break;
|
||||
default:
|
||||
//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;
|
||||
if (n_int16_to_read>0)
|
||||
{
|
||||
int16_t memblock[n_int16_to_read];
|
||||
binary_input_file->read((char*)memblock,n_int16_to_read*2);
|
||||
n_int16_to_read=binary_input_file->gcount()/2; //from bytes to int16
|
||||
if (n_int16_to_read>0)
|
||||
int n_int16_to_read = noutput_items / 8;
|
||||
if (n_int16_to_read > 0)
|
||||
{
|
||||
int output_pointer=0;
|
||||
for (int i=0;i<n_int16_to_read;i++)
|
||||
{
|
||||
decode_samples_one_channel(memblock[i],&out[output_pointer], d_bits_per_sample);
|
||||
output_pointer+=8;
|
||||
}
|
||||
return output_pointer;
|
||||
}else{
|
||||
//trigger the read of the next file in the sequence
|
||||
std::cout<<"End of current file, reading the next Labsat file in sequence: "<<generate_filename()<<std::endl;
|
||||
int16_t memblock[n_int16_to_read];
|
||||
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
|
||||
if (n_int16_to_read > 0)
|
||||
{
|
||||
int output_pointer = 0;
|
||||
for (int i = 0; i < n_int16_to_read; i++)
|
||||
{
|
||||
decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample);
|
||||
output_pointer += 8;
|
||||
}
|
||||
return output_pointer;
|
||||
}
|
||||
else
|
||||
{
|
||||
//trigger the read of the next file in the sequence
|
||||
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->open(generate_filename().c_str(), std::ios::in|std::ios::binary);
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
std::cout<<"Labsat file source is reading samples from "<<generate_filename()<<std::endl;
|
||||
}else{
|
||||
std::cout<<"Last file reached, LabSat source stop"<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
d_current_file_number++;
|
||||
binary_input_file->close();
|
||||
binary_input_file->open(generate_filename().c_str(), std::ios::in|std::ios::binary);
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl;
|
||||
}
|
||||
else
|
||||
{
|
||||
std::cout << "Last file reached, LabSat source stop" << std::endl;
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
}else{
|
||||
return 0;
|
||||
}
|
||||
};
|
||||
break;
|
||||
}
|
||||
else
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
};
|
||||
break;
|
||||
}
|
||||
case 4:
|
||||
{
|
||||
switch(d_channel_selector)
|
||||
{
|
||||
switch(d_channel_selector)
|
||||
{
|
||||
case 0:
|
||||
// dual channel
|
||||
break;
|
||||
default:
|
||||
//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;
|
||||
if (n_int16_to_read>0)
|
||||
{
|
||||
int16_t memblock[n_int16_to_read];
|
||||
binary_input_file->read((char*)memblock,n_int16_to_read*2);
|
||||
n_int16_to_read=binary_input_file->gcount()/2; //from bytes to int16
|
||||
if (n_int16_to_read>0)
|
||||
int n_int16_to_read = noutput_items / 4;
|
||||
if (n_int16_to_read > 0)
|
||||
{
|
||||
int output_pointer=0;
|
||||
for (int i=0;i<n_int16_to_read;i++)
|
||||
{
|
||||
decode_samples_one_channel(memblock[i],&out[output_pointer], d_bits_per_sample);
|
||||
output_pointer+=4;
|
||||
}
|
||||
return output_pointer;
|
||||
}else{
|
||||
//trigger the read of the next file in the sequence
|
||||
std::cout<<"End of current file, reading the next Labsat file in sequence: "<<generate_filename()<<std::endl;
|
||||
int16_t memblock[n_int16_to_read];
|
||||
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
|
||||
if (n_int16_to_read > 0)
|
||||
{
|
||||
int output_pointer = 0;
|
||||
for (int i = 0; i < n_int16_to_read; i++)
|
||||
{
|
||||
decode_samples_one_channel(memblock[i], &out[output_pointer], d_bits_per_sample);
|
||||
output_pointer += 4;
|
||||
}
|
||||
return output_pointer;
|
||||
}
|
||||
else
|
||||
{
|
||||
//trigger the read of the next file in the sequence
|
||||
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->open(generate_filename().c_str(), std::ios::in|std::ios::binary);
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
std::cout<<"Labsat file source is reading samples from "<<generate_filename()<<std::endl;
|
||||
}else{
|
||||
std::cout<<"Last file reached, LabSat source stop"<<std::endl;
|
||||
return -1;
|
||||
}
|
||||
d_current_file_number++;
|
||||
binary_input_file->close();
|
||||
binary_input_file->open(generate_filename().c_str(), std::ios::in|std::ios::binary);
|
||||
if (binary_input_file->is_open())
|
||||
{
|
||||
std::cout << "Labsat file source is reading samples from " << generate_filename() << std::endl;
|
||||
}
|
||||
else
|
||||
{
|
||||
std::cout << "Last file reached, LabSat source stop" << std::endl;
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
}else{
|
||||
return 0;
|
||||
}
|
||||
else
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
break;
|
||||
}
|
||||
default:
|
||||
{
|
||||
return -1;
|
||||
{
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
std::cout<<"Warning!!"<<std::endl;
|
||||
std::cout << "Warning!!" << std::endl;
|
||||
return 0;
|
||||
}
|
||||
|
|
|
|||
|
|
@ -28,8 +28,8 @@
|
|||
* -------------------------------------------------------------------------
|
||||
*/
|
||||
|
||||
#ifndef LABSAT23_SOURCE_H
|
||||
#define LABSAT23_SOURCE_H
|
||||
#ifndef GNSS_SDR_LABSAT23_SOURCE_H
|
||||
#define GNSS_SDR_LABSAT23_SOURCE_H
|
||||
|
||||
#include <gnuradio/block.h>
|
||||
#include <string>
|
||||
|
|
|
|||
Loading…
Reference in New Issue
Block a user