diff options
author | Piotr Krysik <ptrkrysik@users.noreply.github.com> | 2015-07-22 19:05:35 +0200 |
---|---|---|
committer | Piotr Krysik <ptrkrysik@users.noreply.github.com> | 2015-07-22 19:05:35 +0200 |
commit | 590d96c8874faae2ef7babd09fd5f081c5e5da8c (patch) | |
tree | f16bd55bea781fdae0d8ffdb5a7b7f823cba769b /lib/misc_utils | |
parent | c7cbbe9ccb5592440da6cf344d85ac49207e12b4 (diff) | |
parent | 3373d8f80c75f7a127d6b148ae429cb9e205c926 (diff) |
Merge pull request #93 from romankh/a53-decryption-issue-85
A53 decryption
Diffstat (limited to 'lib/misc_utils')
-rw-r--r-- | lib/misc_utils/burst_sink_qa_impl.cc | 110 | ||||
-rw-r--r-- | lib/misc_utils/burst_sink_qa_impl.h | 51 | ||||
-rw-r--r-- | lib/misc_utils/burst_source_qa_impl.cc | 161 | ||||
-rw-r--r-- | lib/misc_utils/burst_source_qa_impl.h | 61 |
4 files changed, 383 insertions, 0 deletions
diff --git a/lib/misc_utils/burst_sink_qa_impl.cc b/lib/misc_utils/burst_sink_qa_impl.cc new file mode 100644 index 0000000..aa9df9d --- /dev/null +++ b/lib/misc_utils/burst_sink_qa_impl.cc @@ -0,0 +1,110 @@ +/* -*- c++ -*- */ +/* @file + * @author Roman Khassraf <rkhassraf@gmail.com> + * @section LICENSE + * + * Gr-gsm is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 3, or (at your option) + * any later version. + * + * Gr-gsm is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with gr-gsm; see the file COPYING. If not, write to + * the Free Software Foundation, Inc., 51 Franklin Street, + * Boston, MA 02110-1301, USA. + * + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <gnuradio/io_signature.h> +#include "burst_sink_qa_impl.h" +#include <stdio.h> +#include <sstream> +#include <grgsm/gsmtap.h> + +namespace gr { + namespace gsm { + + burst_sink_qa::sptr + burst_sink_qa::make() + { + return gnuradio::get_initial_sptr + (new burst_sink_qa_impl()); + } + + /* + * The private constructor + */ + burst_sink_qa_impl::burst_sink_qa_impl() + : gr::block("burst_sink_qa", + gr::io_signature::make(0, 0, 0), + gr::io_signature::make(0, 0, 0)) + { + message_port_register_in(pmt::mp("in")); + set_msg_handler(pmt::mp("in"), boost::bind(&burst_sink_qa_impl::process_burst, this, _1)); + } + + /* + * Our virtual destructor. + */ + burst_sink_qa_impl::~burst_sink_qa_impl() + { +// for (int i=0; i<d_burst_data.size(); i++) +// { +// std::cout << d_framenumbers[i] << " " << d_timeslots[i] << " " << d_burst_data[i] << std::endl; +// } + } + + void burst_sink_qa_impl::process_burst(pmt::pmt_t msg) + { + pmt::pmt_t header_plus_burst = pmt::cdr(msg); + + gsmtap_hdr * header = (gsmtap_hdr *)pmt::blob_data(header_plus_burst); + int8_t * burst = (int8_t *)(pmt::blob_data(header_plus_burst))+sizeof(gsmtap_hdr); + size_t burst_len=pmt::blob_length(header_plus_burst)-sizeof(gsmtap_hdr); + uint32_t frame_nr = be32toh(header->frame_number); + + std::stringstream burst_str; + for(int i=0; i<burst_len; i++) + { + if (static_cast<int>(burst[i]) == 0) + { + burst_str << "0"; + } + else + { + burst_str << "1"; + } + } + + d_framenumbers.push_back(frame_nr); + d_timeslots.push_back(header->timeslot); + d_burst_data.push_back(burst_str.str()); + } + + std::vector<int> burst_sink_qa_impl::get_framenumbers() + { + return d_framenumbers; + } + + std::vector<int> burst_sink_qa_impl::get_timeslots() + { + return d_timeslots; + } + + std::vector<std::string> burst_sink_qa_impl::get_burst_data() + { + return d_burst_data; + } + + } /* namespace gsm */ +} /* namespace gr */ + diff --git a/lib/misc_utils/burst_sink_qa_impl.h b/lib/misc_utils/burst_sink_qa_impl.h new file mode 100644 index 0000000..412a0a1 --- /dev/null +++ b/lib/misc_utils/burst_sink_qa_impl.h @@ -0,0 +1,51 @@ +/* -*- c++ -*- */ +/* @file + * @author Roman Khassraf <rkhassraf@gmail.com> + * @section LICENSE + * + * Gr-gsm is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 3, or (at your option) + * any later version. + * + * Gr-gsm is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with gr-gsm; see the file COPYING. If not, write to + * the Free Software Foundation, Inc., 51 Franklin Street, + * Boston, MA 02110-1301, USA. + * + */ + +#ifndef INCLUDED_GSM_BURST_SINK_QA_IMPL_H +#define INCLUDED_GSM_BURST_SINK_QA_IMPL_H + +#include <grgsm/misc_utils/burst_sink_qa.h> +#include <fstream> + +namespace gr { + namespace gsm { + + class burst_sink_qa_impl : public burst_sink_qa + { + private: + std::vector<int> d_framenumbers; + std::vector<int> d_timeslots; + std::vector<std::string> d_burst_data; + public: + burst_sink_qa_impl(); + ~burst_sink_qa_impl(); + void process_burst(pmt::pmt_t msg); + virtual std::vector<int> get_framenumbers(); + virtual std::vector<int> get_timeslots(); + virtual std::vector<std::string> get_burst_data(); + }; + + } // namespace gsm +} // namespace gr + +#endif /* INCLUDED_GSM_BURST_SINK_QA_IMPL_H */ + diff --git a/lib/misc_utils/burst_source_qa_impl.cc b/lib/misc_utils/burst_source_qa_impl.cc new file mode 100644 index 0000000..e7438f7 --- /dev/null +++ b/lib/misc_utils/burst_source_qa_impl.cc @@ -0,0 +1,161 @@ +/* -*- c++ -*- */ +/* @file + * @author Roman Khassraf <rkhassraf@gmail.com> + * @section LICENSE + * + * Gr-gsm is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 3, or (at your option) + * any later version. + * + * Gr-gsm is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with gr-gsm; see the file COPYING. If not, write to + * the Free Software Foundation, Inc., 51 Franklin Street, + * Boston, MA 02110-1301, USA. + * + */ + +#ifdef HAVE_CONFIG_H +#include "config.h" +#endif + +#include <gnuradio/io_signature.h> +#include "burst_source_qa_impl.h" +#include "stdio.h" +#include <grgsm/gsmtap.h> +#include <grgsm/endian.h> + +#define PMT_SIZE 174 + +namespace gr { + namespace gsm { + + burst_source_qa::sptr + burst_source_qa::make(const std::vector<int> &framenumbers, + const std::vector<int> ×lots, + const std::vector<std::string> &burst_data) + { + return gnuradio::get_initial_sptr + (new burst_source_qa_impl(framenumbers, timeslots, burst_data)); + } + + /* + * The private constructor + */ + burst_source_qa_impl::burst_source_qa_impl(const std::vector<int> &framenumbers, + const std::vector<int> ×lots, + const std::vector<std::string> &burst_data) + : gr::block("burst_source_qa", + gr::io_signature::make(0, 0, 0), + gr::io_signature::make(0, 0, 0)), + d_finished(false) + { + message_port_register_out(pmt::mp("out")); + set_framenumbers(framenumbers); + set_timeslots(timeslots); + set_burst_data(burst_data); + } + + /* + * Our virtual destructor. + */ + burst_source_qa_impl::~burst_source_qa_impl() + { + if (d_finished == false){ + d_finished = true; + } + } + + void burst_source_qa_impl::set_framenumbers(const std::vector<int> &framenumbers) + { + d_framenumbers = framenumbers; + } + + void burst_source_qa_impl::set_timeslots(const std::vector<int> ×lots) + { + d_timeslots = timeslots; + } + + void burst_source_qa_impl::set_burst_data(const std::vector<std::string> &burst_data) + { + d_burst_data = burst_data; + } + + bool burst_source_qa_impl::start() + { + d_finished = false; + d_thread = boost::shared_ptr<gr::thread::thread> + (new gr::thread::thread(boost::bind(&burst_source_qa_impl::run, this))); + return block::start(); + } + + bool burst_source_qa_impl::stop() + { + d_finished = true; + d_thread->interrupt(); + d_thread->join(); + return block::stop(); + } + + bool burst_source_qa_impl::finished() + { + return d_finished; + } + + void burst_source_qa_impl::run() + { + char *unserialized = (char*)malloc(sizeof(char) * PMT_SIZE); + + for (int i=0; i<d_burst_data.size(); i++) + { + if (d_burst_data[i].length() == BURST_SIZE && + d_timeslots[i] >= 0 && d_timeslots[i] <= 7 && + d_framenumbers[i] >= 0 && d_framenumbers[i] <= (26 * 51 * 2048 - 1)) + { + boost::scoped_ptr<gsmtap_hdr> tap_header(new gsmtap_hdr()); + + tap_header->version = GSMTAP_VERSION; + tap_header->hdr_len = sizeof(gsmtap_hdr)/4; + tap_header->type = GSMTAP_TYPE_UM_BURST; + tap_header->timeslot = d_timeslots[i]; + tap_header->frame_number = htobe32(d_framenumbers[i]); + tap_header->sub_type = GSMTAP_BURST_NORMAL; + tap_header->arfcn = 0; + tap_header->signal_dbm = 0; + tap_header->snr_db = 0; + + uint8_t burst[BURST_SIZE]; + + for (int j=0; j<BURST_SIZE; j++) + { + if (d_burst_data[i][j] == '0') + { + burst[j] = 0; + } + else + { + burst[j] = 1; + } + } + + int8_t header_plus_burst[sizeof(gsmtap_hdr) + BURST_SIZE]; + memcpy(header_plus_burst, tap_header.get(), sizeof(gsmtap_hdr)); + memcpy(header_plus_burst + sizeof(gsmtap_hdr), burst, BURST_SIZE); + + pmt::pmt_t blob_header_plus_burst = pmt::make_blob(header_plus_burst, sizeof(gsmtap_hdr) + BURST_SIZE); + pmt::pmt_t msg = pmt::cons(pmt::PMT_NIL, blob_header_plus_burst); + + message_port_pub(pmt::mp("out"), msg); + } + } + post(pmt::mp("system"), pmt::cons(pmt::mp("done"), pmt::from_long(1))); + } + } /* namespace gsm */ +} /* namespace gr */ + + diff --git a/lib/misc_utils/burst_source_qa_impl.h b/lib/misc_utils/burst_source_qa_impl.h new file mode 100644 index 0000000..cb62571 --- /dev/null +++ b/lib/misc_utils/burst_source_qa_impl.h @@ -0,0 +1,61 @@ +/* -*- c++ -*- */ +/* @file + * @author Roman Khassraf <rkhassraf@gmail.com> + * @section LICENSE + * + * Gr-gsm is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 3, or (at your option) + * any later version. + * + * Gr-gsm is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with gr-gsm; see the file COPYING. If not, write to + * the Free Software Foundation, Inc., 51 Franklin Street, + * Boston, MA 02110-1301, USA. + * + */ + +#ifndef INCLUDED_GSM_BURST_SOURCE_QA_IMPL_H +#define INCLUDED_GSM_BURST_SOURCE_QA_IMPL_H + +#define BURST_SIZE 148 + +#include <grgsm/misc_utils/burst_source_qa.h> +#include <fstream> + + +namespace gr { + namespace gsm { + + class burst_source_qa_impl : public burst_source_qa + { + private: + boost::shared_ptr<gr::thread::thread> d_thread; + std::vector<int> d_framenumbers; + std::vector<int> d_timeslots; + std::vector<std::string> d_burst_data; + bool d_finished; + void run(); + public: + burst_source_qa_impl(const std::vector<int> &framenumbers, + const std::vector<int> ×lots, + const std::vector<std::string> &burst_data); + ~burst_source_qa_impl(); + virtual void set_framenumbers(const std::vector<int> &framenumbers); + virtual void set_timeslots(const std::vector<int> ×lots); + virtual void set_burst_data(const std::vector<std::string> &burst_data); + bool start(); + bool stop(); + bool finished(); + }; + } // namespace gsm +} // namespace gr + +#endif /* INCLUDED_GSM_BURST_SOURCE_QA_IMPL_H */ + + |