Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 1 | /* -*- c++ -*- */ |
| 2 | /* @file |
| 3 | * @author Piotr Krysik <ptrkrysik@gmail.com> |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 4 | * @author Vadim Yanitskiy <axilirator@gmail.com> |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 5 | * @section LICENSE |
| 6 | * |
| 7 | * Gr-gsm is free software; you can redistribute it and/or modify |
| 8 | * it under the terms of the GNU General Public License as published by |
| 9 | * the Free Software Foundation; either version 3, or (at your option) |
| 10 | * any later version. |
| 11 | * |
| 12 | * Gr-gsm is distributed in the hope that it will be useful, |
| 13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 15 | * GNU General Public License for more details. |
| 16 | * |
| 17 | * You should have received a copy of the GNU General Public License |
| 18 | * along with gr-gsm; see the file COPYING. If not, write to |
| 19 | * the Free Software Foundation, Inc., 51 Franklin Street, |
| 20 | * Boston, MA 02110-1301, USA. |
| 21 | * |
| 22 | */ |
| 23 | |
| 24 | #ifdef HAVE_CONFIG_H |
| 25 | #include "config.h" |
| 26 | #endif |
| 27 | |
| 28 | #include <gnuradio/io_signature.h> |
| 29 | #include <grgsm/gsmtap.h> |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 30 | |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 31 | #include "txtime_setter_impl.h" |
| 32 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 33 | #define UNKNOWN_FN 0xffffffff |
| 34 | #define MAX_EARLY_TIME_DIFF 10.0 |
| 35 | |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 36 | namespace gr { |
| 37 | namespace gsm { |
| 38 | |
| 39 | txtime_setter::sptr |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 40 | txtime_setter::make( |
| 41 | uint32_t init_fn, uint64_t init_time_secs, |
| 42 | double init_time_fracs, uint64_t time_hint_secs, |
| 43 | double time_hint_fracs, double timing_advance, |
| 44 | double delay_correction) |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 45 | { |
| 46 | return gnuradio::get_initial_sptr |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 47 | (new txtime_setter_impl(init_fn, init_time_secs, |
| 48 | init_time_fracs, time_hint_secs, time_hint_fracs, |
| 49 | timing_advance, delay_correction)); |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 50 | } |
| 51 | |
| 52 | /* |
| 53 | * The private constructor |
| 54 | */ |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 55 | txtime_setter_impl::txtime_setter_impl( |
| 56 | uint32_t init_fn, uint64_t init_time_secs, |
| 57 | double init_time_fracs, uint64_t time_hint_secs, |
| 58 | double time_hint_fracs, double timing_advance, |
| 59 | double delay_correction |
| 60 | ) : gr::block("txtime_setter", |
| 61 | gr::io_signature::make(0, 0, 0), |
| 62 | gr::io_signature::make(0, 0, 0)), |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 63 | d_time_hint(time_hint_secs,time_hint_fracs), |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 64 | d_time_ref(init_time_secs,init_time_fracs), |
| 65 | d_delay_correction(delay_correction), |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 66 | d_timing_advance(timing_advance), |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 67 | d_fn_ref(init_fn), |
| 68 | d_ts_ref(0) |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 69 | { |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 70 | // Register I/O ports |
| 71 | message_port_register_in(pmt::mp("fn_time")); |
| 72 | message_port_register_in(pmt::mp("bursts_in")); |
| 73 | message_port_register_out(pmt::mp("bursts_out")); |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 74 | |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 75 | // Bind message handlers |
| 76 | set_msg_handler(pmt::mp("fn_time"), |
| 77 | boost::bind(&txtime_setter_impl::process_fn_time_reference, |
| 78 | this, _1)); |
| 79 | set_msg_handler(pmt::mp("bursts_in"), |
| 80 | boost::bind(&txtime_setter_impl::process_txtime_of_burst, |
| 81 | this, _1)); |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 82 | } |
| 83 | |
| 84 | /* |
| 85 | * Our virtual destructor. |
| 86 | */ |
| 87 | txtime_setter_impl::~txtime_setter_impl() |
| 88 | { |
| 89 | } |
| 90 | |
| 91 | void txtime_setter_impl::process_fn_time_reference(pmt::pmt_t msg) |
| 92 | { |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 93 | pmt::pmt_t fn_time, time_hint; |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 94 | |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 95 | fn_time = pmt::dict_ref(msg, |
Vadim Yanitskiy | 0123232 | 2017-12-09 20:16:44 +0700 | [diff] [blame] | 96 | pmt::intern("fn_time"), pmt::PMT_NIL); |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 97 | time_hint = pmt::dict_ref(msg, |
Vadim Yanitskiy | 0123232 | 2017-12-09 20:16:44 +0700 | [diff] [blame] | 98 | pmt::intern("time_hint"), pmt::PMT_NIL); |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 99 | |
Vadim Yanitskiy | 0123232 | 2017-12-09 20:16:44 +0700 | [diff] [blame] | 100 | if (fn_time != pmt::PMT_NIL) { |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 101 | uint32_t fn_ref = static_cast<uint32_t> |
| 102 | (pmt::to_uint64(pmt::car(pmt::car(fn_time)))); |
| 103 | uint32_t ts = static_cast<uint32_t> |
| 104 | (pmt::to_uint64(pmt::cdr(pmt::car(fn_time)))); |
| 105 | uint64_t time_secs = pmt::to_uint64( |
| 106 | pmt::car(pmt::cdr(fn_time))); |
| 107 | double time_fracs = pmt::to_double( |
| 108 | pmt::cdr(pmt::cdr(fn_time))); |
| 109 | |
| 110 | set_fn_time_reference(fn_ref, ts, time_secs, time_fracs); |
Vadim Yanitskiy | 0123232 | 2017-12-09 20:16:44 +0700 | [diff] [blame] | 111 | } else if (time_hint != pmt::PMT_NIL) { |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 112 | set_time_hint(pmt::to_uint64(pmt::car(fn_time)), |
| 113 | pmt::to_double(pmt::cdr(fn_time))); |
| 114 | } |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 115 | } |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 116 | |
| 117 | void txtime_setter_impl::process_txtime_of_burst(pmt::pmt_t msg_in) |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 118 | { |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 119 | if (d_fn_ref != UNKNOWN_FN) |
| 120 | { |
| 121 | pmt::pmt_t blob = pmt::cdr(msg_in); |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 122 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 123 | // Extract GSMTAP header from message |
| 124 | gsmtap_hdr *header = (gsmtap_hdr *) pmt::blob_data(blob); |
| 125 | uint32_t frame_nr = be32toh(header->frame_number); |
| 126 | uint32_t ts_num = header->timeslot; |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 127 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 128 | time_format txtime = fn_time_delta_cpp(d_fn_ref, d_time_ref, |
| 129 | frame_nr, d_time_hint, ts_num, d_ts_ref); |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 130 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 131 | time_spec_t txtime_spec = time_spec_t(txtime.first, txtime.second); |
| 132 | txtime_spec -= d_delay_correction; |
| 133 | txtime_spec -= d_timing_advance; |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 134 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 135 | time_spec_t current_time_estimate = time_spec_t(d_time_hint.first, d_time_hint.second); |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 136 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 137 | if (txtime_spec <= current_time_estimate) { // Drop too late bursts |
| 138 | std::cout << "lB" << std::flush; |
| 139 | } else if (txtime_spec > current_time_estimate + MAX_EARLY_TIME_DIFF) { // Drop too early bursts |
| 140 | std::cout << "eB" << std::flush; //TODO: too early condition might happen when changing BTSes. |
| 141 | //Wrong fn_time is applied to new or old bursts in such situation. |
| 142 | //This solution is not perfect as MS might be blocked upto |
| 143 | //MAX_EARLY_TIME_DIFF seconds. |
| 144 | //Better solution would be to indentify fn_time and burst coming |
| 145 | //from given BTS (i.e. based on ARFCN) and dropping bursts for which |
| 146 | //the bts_id doesn't match with bts_id of fn_time. |
| 147 | } else { //process bursts that are in the right time-frame |
| 148 | pmt::pmt_t tags_dict = pmt::dict_add( |
| 149 | pmt::make_dict(), |
| 150 | pmt::intern("tx_time"), |
| 151 | pmt::make_tuple( |
| 152 | pmt::from_uint64(txtime_spec.get_full_secs()), |
| 153 | pmt::from_double(txtime_spec.get_frac_secs())) |
| 154 | ); |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 155 | |
Piotr Krysik | ccd9ed9 | 2017-11-30 12:48:01 +0100 | [diff] [blame] | 156 | tags_dict = pmt::dict_add(tags_dict, |
| 157 | pmt::intern("fn"), pmt::from_uint64(frame_nr)); |
| 158 | tags_dict = pmt::dict_add(tags_dict, |
| 159 | pmt::intern("ts"), pmt::from_uint64(ts_num)); |
| 160 | |
| 161 | // Send a message to the output |
| 162 | pmt::pmt_t msg_out = pmt::cons(tags_dict, pmt::cdr(msg_in)); |
| 163 | message_port_pub(pmt::mp("bursts_out"), msg_out); |
| 164 | } |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 165 | } |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 166 | } |
| 167 | |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 168 | void txtime_setter_impl::set_fn_time_reference( |
| 169 | uint32_t fn, uint32_t ts, uint64_t time_secs, |
| 170 | double time_fracs) |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 171 | { |
| 172 | d_fn_ref = fn; |
| 173 | d_ts_ref = ts; |
| 174 | d_time_ref = std::make_pair(time_secs, time_fracs); |
| 175 | set_time_hint(time_secs, time_fracs); |
| 176 | } |
| 177 | |
Vadim Yanitskiy | 2ce2942 | 2017-11-29 23:58:42 +0700 | [diff] [blame] | 178 | void txtime_setter_impl::set_time_hint( |
| 179 | uint64_t time_hint_secs, double time_hint_fracs) |
Piotr Krysik | 517464c | 2017-11-05 12:23:15 +0100 | [diff] [blame] | 180 | { |
| 181 | d_time_hint = std::make_pair(time_hint_secs, time_hint_fracs); |
| 182 | } |
| 183 | |
| 184 | void txtime_setter_impl::set_delay_correction(double delay_correction) |
| 185 | { |
| 186 | d_delay_correction = delay_correction; |
| 187 | } |
| 188 | |
| 189 | void txtime_setter_impl::set_timing_advance(double timing_advance) |
| 190 | { |
| 191 | d_timing_advance = timing_advance; |
| 192 | } |
| 193 | |
| 194 | } /* namespace gsm */ |
| 195 | } /* namespace gr */ |