Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 1 | #!/usr/bin/env python2 |
| 2 | # -*- coding: utf-8 -*- |
| 3 | ################################################## |
| 4 | # GNU Radio Python Flow Graph |
| 5 | # Title: Trx radio interface |
| 6 | # Author: (C) Piotr Krysik 2017 |
| 7 | # Description: Alpha version of trx radio interface |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 8 | # Generated: Fri Dec 1 10:49:25 2017 |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 9 | ################################################## |
| 10 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 11 | from change_sign_of_dict_elements import change_sign_of_dict_elements |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 12 | from gnuradio import blocks |
| 13 | from gnuradio import digital |
| 14 | from gnuradio import eng_notation |
| 15 | from gnuradio import filter |
| 16 | from gnuradio import gr |
| 17 | from gnuradio import uhd |
| 18 | from gnuradio.eng_option import eng_option |
| 19 | from gnuradio.filter import firdes |
| 20 | from grgsm import gsm_gmsk_mod |
| 21 | from optparse import OptionParser |
| 22 | import grgsm |
| 23 | import math |
| 24 | import time |
| 25 | |
| 26 | |
| 27 | class radio_if_grc(gr.top_block): |
| 28 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 29 | def __init__(self, delay_correction=285.616e-6, osr=4, ppm=-0.799427, rx_freq=935e6+36*0.2e6, rx_gain=40, samp_rate=13e6/12.0, timing_advance=0, trx_base_port="5710", trx_remote_addr="127.0.0.1", tx_freq=935e6+36*0.2e6-45e6, tx_gain=40, uplink_shift=-(6.0/1625000*(156.25)*3)): |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 30 | gr.top_block.__init__(self, "Trx radio interface") |
| 31 | |
| 32 | ################################################## |
| 33 | # Parameters |
| 34 | ################################################## |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 35 | self.delay_correction = delay_correction |
Piotr Krysik | 294138d | 2017-11-30 13:06:31 +0100 | [diff] [blame] | 36 | self.osr = osr |
| 37 | self.ppm = ppm |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 38 | self.rx_freq = rx_freq |
| 39 | self.rx_gain = rx_gain |
| 40 | self.samp_rate = samp_rate |
| 41 | self.timing_advance = timing_advance |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 42 | self.trx_base_port = trx_base_port |
| 43 | self.trx_remote_addr = trx_remote_addr |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 44 | self.tx_freq = tx_freq |
| 45 | self.tx_gain = tx_gain |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 46 | self.uplink_shift = uplink_shift |
| 47 | |
| 48 | ################################################## |
| 49 | # Blocks |
| 50 | ################################################## |
| 51 | self.uhd_usrp_source_0 = uhd.usrp_source( |
| 52 | ",".join(("", "")), |
| 53 | uhd.stream_args( |
| 54 | cpu_format="fc32", |
| 55 | channels=range(1), |
| 56 | ), |
| 57 | ) |
| 58 | self.uhd_usrp_source_0.set_clock_rate(26e6, uhd.ALL_MBOARDS) |
| 59 | self.uhd_usrp_source_0.set_samp_rate(samp_rate) |
| 60 | self.uhd_usrp_source_0.set_center_freq(rx_freq, 0) |
| 61 | self.uhd_usrp_source_0.set_gain(rx_gain, 0) |
| 62 | self.uhd_usrp_source_0.set_antenna("RX2", 0) |
| 63 | self.uhd_usrp_sink_0 = uhd.usrp_sink( |
| 64 | ",".join(("", "")), |
| 65 | uhd.stream_args( |
| 66 | cpu_format="fc32", |
| 67 | channels=range(1), |
| 68 | ), |
| 69 | "packet_len", |
| 70 | ) |
| 71 | self.uhd_usrp_sink_0.set_clock_rate(26e6, uhd.ALL_MBOARDS) |
| 72 | self.uhd_usrp_sink_0.set_subdev_spec("A:B", 0) |
| 73 | self.uhd_usrp_sink_0.set_samp_rate(samp_rate) |
| 74 | self.uhd_usrp_sink_0.set_center_freq(tx_freq, 0) |
| 75 | self.uhd_usrp_sink_0.set_gain(tx_gain, 0) |
| 76 | self.uhd_usrp_sink_0.set_antenna("TX/RX", 0) |
Piotr Krysik | 294138d | 2017-11-30 13:06:31 +0100 | [diff] [blame] | 77 | self.ts_filter = grgsm.burst_timeslot_filter(0) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 78 | self.low_pass_filter_0_0 = filter.fir_filter_ccf(1, firdes.low_pass( |
| 79 | 1, samp_rate, 125e3, 5e3, firdes.WIN_HAMMING, 6.76)) |
| 80 | self.gsm_txtime_setter_0 = grgsm.txtime_setter(None if (None is not None) else 0xffffffff, 0, 0, 0, 0, timing_advance, delay_correction+uplink_shift) |
| 81 | self.gsm_trx_burst_if_0 = grgsm.trx_burst_if(trx_remote_addr, trx_base_port) |
| 82 | self.gsm_receiver_0 = grgsm.receiver(4, ([0]), ([4]), False) |
| 83 | self.gsm_preprocess_tx_burst_0 = grgsm.preprocess_tx_burst() |
| 84 | self.gsm_msg_to_tag_0_0 = grgsm.msg_to_tag() |
| 85 | self.gsm_msg_to_tag_0 = grgsm.msg_to_tag() |
| 86 | self.gsm_gmsk_mod_0 = gsm_gmsk_mod( |
| 87 | BT=0.3, |
| 88 | pulse_duration=4, |
| 89 | sps=osr, |
| 90 | ) |
| 91 | self.gsm_controlled_rotator_cc_0_0 = grgsm.controlled_rotator_cc(-ppm/1.0e6*2*math.pi*tx_freq/samp_rate) |
| 92 | self.gsm_controlled_rotator_cc_0 = grgsm.controlled_rotator_cc(ppm/1.0e6*2*math.pi*rx_freq/samp_rate) |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 93 | self.gsm_clock_offset_control_0 = grgsm.clock_offset_control(rx_freq, samp_rate, osr) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 94 | self.gsm_burst_type_filter_0 = grgsm.burst_type_filter(([3])) |
| 95 | self.gsm_burst_to_fn_time_0 = grgsm.burst_to_fn_time() |
| 96 | self.digital_burst_shaper_xx_0 = digital.burst_shaper_cc((firdes.window(firdes.WIN_HANN, 16, 0)), 0, 20, False, "packet_len") |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 97 | self.change_sign_of_dict_elements = change_sign_of_dict_elements() |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 98 | self.blocks_pdu_to_tagged_stream_0_0 = blocks.pdu_to_tagged_stream(blocks.byte_t, "packet_len") |
| 99 | |
| 100 | ################################################## |
| 101 | # Connections |
| 102 | ################################################## |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 103 | self.msg_connect((self.change_sign_of_dict_elements, 'dict_out'), (self.gsm_msg_to_tag_0_0, 'msg')) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 104 | self.msg_connect((self.gsm_burst_to_fn_time_0, 'fn_time_out'), (self.gsm_txtime_setter_0, 'fn_time')) |
| 105 | self.msg_connect((self.gsm_burst_type_filter_0, 'bursts_out'), (self.gsm_burst_to_fn_time_0, 'bursts_in')) |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 106 | self.msg_connect((self.gsm_clock_offset_control_0, 'ctrl'), (self.change_sign_of_dict_elements, 'dict_in')) |
| 107 | self.msg_connect((self.gsm_clock_offset_control_0, 'ctrl'), (self.gsm_msg_to_tag_0, 'msg')) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 108 | self.msg_connect((self.gsm_preprocess_tx_burst_0, 'bursts_out'), (self.blocks_pdu_to_tagged_stream_0_0, 'pdus')) |
| 109 | self.msg_connect((self.gsm_receiver_0, 'C0'), (self.gsm_burst_type_filter_0, 'bursts_in')) |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 110 | self.msg_connect((self.gsm_receiver_0, 'measurements'), (self.gsm_clock_offset_control_0, 'measurements')) |
Piotr Krysik | 294138d | 2017-11-30 13:06:31 +0100 | [diff] [blame] | 111 | self.msg_connect((self.gsm_receiver_0, 'C0'), (self.ts_filter, 'in')) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 112 | self.msg_connect((self.gsm_trx_burst_if_0, 'bursts'), (self.gsm_txtime_setter_0, 'bursts_in')) |
| 113 | self.msg_connect((self.gsm_txtime_setter_0, 'bursts_out'), (self.gsm_preprocess_tx_burst_0, 'bursts_in')) |
Piotr Krysik | 294138d | 2017-11-30 13:06:31 +0100 | [diff] [blame] | 114 | self.msg_connect((self.ts_filter, 'out'), (self.gsm_trx_burst_if_0, 'bursts')) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 115 | self.connect((self.blocks_pdu_to_tagged_stream_0_0, 0), (self.gsm_gmsk_mod_0, 0)) |
| 116 | self.connect((self.digital_burst_shaper_xx_0, 0), (self.gsm_msg_to_tag_0_0, 0)) |
| 117 | self.connect((self.gsm_controlled_rotator_cc_0, 0), (self.low_pass_filter_0_0, 0)) |
| 118 | self.connect((self.gsm_controlled_rotator_cc_0_0, 0), (self.uhd_usrp_sink_0, 0)) |
| 119 | self.connect((self.gsm_gmsk_mod_0, 0), (self.digital_burst_shaper_xx_0, 0)) |
| 120 | self.connect((self.gsm_msg_to_tag_0, 0), (self.gsm_controlled_rotator_cc_0, 0)) |
| 121 | self.connect((self.gsm_msg_to_tag_0_0, 0), (self.gsm_controlled_rotator_cc_0_0, 0)) |
| 122 | self.connect((self.low_pass_filter_0_0, 0), (self.gsm_receiver_0, 0)) |
| 123 | self.connect((self.uhd_usrp_source_0, 0), (self.gsm_msg_to_tag_0, 0)) |
| 124 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 125 | def get_delay_correction(self): |
| 126 | return self.delay_correction |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 127 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 128 | def set_delay_correction(self, delay_correction): |
| 129 | self.delay_correction = delay_correction |
| 130 | self.gsm_txtime_setter_0.set_delay_correction(self.delay_correction+self.uplink_shift) |
| 131 | |
| 132 | def get_osr(self): |
| 133 | return self.osr |
| 134 | |
| 135 | def set_osr(self, osr): |
| 136 | self.osr = osr |
| 137 | self.gsm_gmsk_mod_0.set_sps(self.osr) |
| 138 | |
| 139 | def get_ppm(self): |
| 140 | return self.ppm |
| 141 | |
| 142 | def set_ppm(self, ppm): |
| 143 | self.ppm = ppm |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 144 | self.gsm_controlled_rotator_cc_0.set_phase_inc(self.ppm/1.0e6*2*math.pi*self.rx_freq/self.samp_rate) |
| 145 | self.gsm_controlled_rotator_cc_0_0.set_phase_inc(-self.ppm/1.0e6*2*math.pi*self.tx_freq/self.samp_rate) |
| 146 | |
| 147 | def get_rx_freq(self): |
| 148 | return self.rx_freq |
| 149 | |
| 150 | def set_rx_freq(self, rx_freq): |
| 151 | self.rx_freq = rx_freq |
| 152 | self.gsm_controlled_rotator_cc_0.set_phase_inc(self.ppm/1.0e6*2*math.pi*self.rx_freq/self.samp_rate) |
| 153 | self.uhd_usrp_source_0.set_center_freq(self.rx_freq, 0) |
| 154 | |
| 155 | def get_rx_gain(self): |
| 156 | return self.rx_gain |
| 157 | |
| 158 | def set_rx_gain(self, rx_gain): |
| 159 | self.rx_gain = rx_gain |
| 160 | self.uhd_usrp_source_0.set_gain(self.rx_gain, 0) |
| 161 | |
| 162 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 163 | def get_samp_rate(self): |
| 164 | return self.samp_rate |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 165 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 166 | def set_samp_rate(self, samp_rate): |
| 167 | self.samp_rate = samp_rate |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 168 | self.gsm_controlled_rotator_cc_0.set_phase_inc(self.ppm/1.0e6*2*math.pi*self.rx_freq/self.samp_rate) |
| 169 | self.gsm_controlled_rotator_cc_0_0.set_phase_inc(-self.ppm/1.0e6*2*math.pi*self.tx_freq/self.samp_rate) |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 170 | self.low_pass_filter_0_0.set_taps(firdes.low_pass(1, self.samp_rate, 125e3, 5e3, firdes.WIN_HAMMING, 6.76)) |
| 171 | self.uhd_usrp_sink_0.set_samp_rate(self.samp_rate) |
| 172 | self.uhd_usrp_source_0.set_samp_rate(self.samp_rate) |
| 173 | |
| 174 | def get_timing_advance(self): |
| 175 | return self.timing_advance |
| 176 | |
| 177 | def set_timing_advance(self, timing_advance): |
| 178 | self.timing_advance = timing_advance |
| 179 | self.gsm_txtime_setter_0.set_timing_advance(self.timing_advance) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 180 | |
| 181 | def get_trx_base_port(self): |
| 182 | return self.trx_base_port |
| 183 | |
| 184 | def set_trx_base_port(self, trx_base_port): |
| 185 | self.trx_base_port = trx_base_port |
| 186 | |
| 187 | def get_trx_remote_addr(self): |
| 188 | return self.trx_remote_addr |
| 189 | |
| 190 | def set_trx_remote_addr(self, trx_remote_addr): |
| 191 | self.trx_remote_addr = trx_remote_addr |
| 192 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 193 | def get_tx_freq(self): |
| 194 | return self.tx_freq |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 195 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 196 | def set_tx_freq(self, tx_freq): |
| 197 | self.tx_freq = tx_freq |
| 198 | self.gsm_controlled_rotator_cc_0_0.set_phase_inc(-self.ppm/1.0e6*2*math.pi*self.tx_freq/self.samp_rate) |
| 199 | self.uhd_usrp_sink_0.set_center_freq(self.tx_freq, 0) |
| 200 | |
| 201 | def get_tx_gain(self): |
| 202 | return self.tx_gain |
| 203 | |
| 204 | def set_tx_gain(self, tx_gain): |
| 205 | self.tx_gain = tx_gain |
| 206 | self.uhd_usrp_sink_0.set_gain(self.tx_gain, 0) |
| 207 | |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 208 | |
| 209 | def get_uplink_shift(self): |
| 210 | return self.uplink_shift |
| 211 | |
| 212 | def set_uplink_shift(self, uplink_shift): |
| 213 | self.uplink_shift = uplink_shift |
| 214 | self.gsm_txtime_setter_0.set_delay_correction(self.delay_correction+self.uplink_shift) |
| 215 | |
| 216 | |
| 217 | def argument_parser(): |
| 218 | parser = OptionParser(option_class=eng_option, usage="%prog: [options]") |
| 219 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 220 | "", "--delay-correction", dest="delay_correction", type="eng_float", default=eng_notation.num_to_str(285.616e-6), |
| 221 | help="Set delay_correction [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 222 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 223 | "", "--osr", dest="osr", type="intx", default=4, |
| 224 | help="Set OSR [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 225 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 226 | "", "--ppm", dest="ppm", type="eng_float", default=eng_notation.num_to_str(-0.799427), |
| 227 | help="Set Clock offset correction [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 228 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 229 | "-d", "--rx-freq", dest="rx_freq", type="eng_float", default=eng_notation.num_to_str(935e6+36*0.2e6), |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 230 | help="Set rx_freq [default=%default]") |
| 231 | parser.add_option( |
| 232 | "-g", "--rx-gain", dest="rx_gain", type="eng_float", default=eng_notation.num_to_str(40), |
| 233 | help="Set rx_gain [default=%default]") |
| 234 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 235 | "", "--samp-rate", dest="samp_rate", type="eng_float", default=eng_notation.num_to_str(13e6/12.0), |
| 236 | help="Set samp_rate [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 237 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 238 | "", "--timing-advance", dest="timing_advance", type="eng_float", default=eng_notation.num_to_str(0), |
| 239 | help="Set timing_advance [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 240 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 241 | "", "--trx-base-port", dest="trx_base_port", type="string", default="5710", |
| 242 | help="Set 5710 [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 243 | parser.add_option( |
| 244 | "", "--trx-remote-addr", dest="trx_remote_addr", type="string", default="127.0.0.1", |
| 245 | help="Set 127.0.0.1 [default=%default]") |
| 246 | parser.add_option( |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 247 | "-u", "--tx-freq", dest="tx_freq", type="eng_float", default=eng_notation.num_to_str(935e6+36*0.2e6-45e6), |
| 248 | help="Set tx_freq [default=%default]") |
| 249 | parser.add_option( |
| 250 | "-r", "--tx-gain", dest="tx_gain", type="eng_float", default=eng_notation.num_to_str(40), |
| 251 | help="Set tx_gain [default=%default]") |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 252 | parser.add_option( |
| 253 | "", "--uplink-shift", dest="uplink_shift", type="eng_float", default=eng_notation.num_to_str(-(6.0/1625000*(156.25)*3)), |
| 254 | help="Set uplink_shift [default=%default]") |
| 255 | return parser |
| 256 | |
| 257 | |
| 258 | def main(top_block_cls=radio_if_grc, options=None): |
| 259 | if options is None: |
| 260 | options, _ = argument_parser().parse_args() |
| 261 | |
Piotr Krysik | c362245 | 2017-12-01 12:02:55 +0100 | [diff] [blame] | 262 | tb = top_block_cls(delay_correction=options.delay_correction, osr=options.osr, ppm=options.ppm, rx_freq=options.rx_freq, rx_gain=options.rx_gain, samp_rate=options.samp_rate, timing_advance=options.timing_advance, trx_base_port=options.trx_base_port, trx_remote_addr=options.trx_remote_addr, tx_freq=options.tx_freq, tx_gain=options.tx_gain, uplink_shift=options.uplink_shift) |
Piotr Krysik | d2f162f | 2017-11-30 12:50:00 +0100 | [diff] [blame] | 263 | tb.start() |
| 264 | tb.wait() |
| 265 | |
| 266 | |
| 267 | if __name__ == '__main__': |
| 268 | main() |