piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 1 | #!/usr/bin/env python |
| 2 | ################################################## |
| 3 | # Gnuradio Python Flow Graph |
| 4 | # Title: Clock offset corrector |
| 5 | # Author: Piotr Krysik |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 6 | # Generated: Wed Nov 19 08:38:40 2014 |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 7 | ################################################## |
| 8 | |
| 9 | from gnuradio import blocks |
| 10 | from gnuradio import filter |
| 11 | from gnuradio import gr |
| 12 | from gnuradio.filter import firdes |
Piotr Krysik | e3b652d | 2016-01-02 09:14:27 +0100 | [diff] [blame] | 13 | from distutils.version import LooseVersion as version |
ptrkrysik | 3be74a7 | 2014-12-13 10:11:00 +0100 | [diff] [blame] | 14 | import grgsm |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 15 | import math |
| 16 | |
Piotr Krysik | 8715da0 | 2016-01-06 22:21:09 +0100 | [diff] [blame] | 17 | class clock_offset_corrector(grgsm.hier_block): |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 18 | |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 19 | def __init__(self, fc=936.6e6, ppm=0, samp_rate_in=1625000.0/6.0*4.0): |
Piotr Krysik | 8715da0 | 2016-01-06 22:21:09 +0100 | [diff] [blame] | 20 | grgsm.hier_block.__init__( |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 21 | self, "Clock offset corrector", |
| 22 | gr.io_signature(1, 1, gr.sizeof_gr_complex*1), |
| 23 | gr.io_signature(1, 1, gr.sizeof_gr_complex*1), |
| 24 | ) |
Piotr Krysik | 8715da0 | 2016-01-06 22:21:09 +0100 | [diff] [blame] | 25 | self.message_port_register_hier_in("ppm_in") |
| 26 | |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 27 | ################################################## |
| 28 | # Parameters |
| 29 | ################################################## |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 30 | self.fc = fc |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 31 | self.ppm = ppm |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 32 | self.samp_rate_in = samp_rate_in |
| 33 | |
| 34 | ################################################## |
| 35 | # Variables |
| 36 | ################################################## |
| 37 | self.samp_rate_out = samp_rate_out = samp_rate_in |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 38 | |
| 39 | ################################################## |
| 40 | # Blocks |
| 41 | ################################################## |
ptrkrysik | 3be74a7 | 2014-12-13 10:11:00 +0100 | [diff] [blame] | 42 | self.gsm_controlled_rotator_cc_0 = grgsm.controlled_rotator_cc(0,samp_rate_out) |
| 43 | self.gsm_controlled_const_source_f_0 = grgsm.controlled_const_source_f(ppm) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 44 | self.fractional_resampler_xx_0 = filter.fractional_resampler_cc(0, samp_rate_in/samp_rate_out) |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 45 | self.blocks_multiply_const_vxx_0_0 = blocks.multiply_const_vff((1.0e-6*samp_rate_in/samp_rate_out, )) |
| 46 | self.blocks_multiply_const_vxx_0 = blocks.multiply_const_vff((fc/samp_rate_out*(2*math.pi)/1e6, )) |
| 47 | self.blocks_add_const_vxx_0 = blocks.add_const_vff((samp_rate_in/samp_rate_out, )) |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 48 | |
| 49 | ################################################## |
| 50 | # Connections |
| 51 | ################################################## |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 52 | self.connect((self, 0), (self.fractional_resampler_xx_0, 0)) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 53 | self.connect((self.fractional_resampler_xx_0, 0), (self.gsm_controlled_rotator_cc_0, 0)) |
| 54 | self.connect((self.blocks_add_const_vxx_0, 0), (self.fractional_resampler_xx_0, 1)) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 55 | self.connect((self.blocks_multiply_const_vxx_0_0, 0), (self.blocks_add_const_vxx_0, 0)) |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 56 | self.connect((self.blocks_multiply_const_vxx_0, 0), (self.gsm_controlled_rotator_cc_0, 1)) |
| 57 | self.connect((self.gsm_controlled_rotator_cc_0, 0), (self, 0)) |
| 58 | self.connect((self.gsm_controlled_const_source_f_0, 0), (self.blocks_multiply_const_vxx_0_0, 0)) |
| 59 | self.connect((self.gsm_controlled_const_source_f_0, 0), (self.blocks_multiply_const_vxx_0, 0)) |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 60 | |
| 61 | ################################################## |
| 62 | # Asynch Message Connections |
| 63 | ################################################## |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 64 | self.msg_connect(self, "ppm_in", self.gsm_controlled_const_source_f_0, "constant_msg") |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 65 | |
| 66 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 67 | def get_fc(self): |
| 68 | return self.fc |
| 69 | |
| 70 | def set_fc(self, fc): |
| 71 | self.fc = fc |
| 72 | self.blocks_multiply_const_vxx_0.set_k((self.fc/self.samp_rate_out*(2*math.pi)/1e6, )) |
| 73 | |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 74 | def get_ppm(self): |
| 75 | return self.ppm |
| 76 | |
| 77 | def set_ppm(self, ppm): |
| 78 | self.ppm = ppm |
| 79 | self.gsm_controlled_const_source_f_0.set_constant(self.ppm) |
| 80 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 81 | def get_samp_rate_in(self): |
| 82 | return self.samp_rate_in |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 83 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 84 | def set_samp_rate_in(self, samp_rate_in): |
| 85 | self.samp_rate_in = samp_rate_in |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 86 | self.set_samp_rate_out(self.samp_rate_in) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 87 | self.fractional_resampler_xx_0.set_resamp_ratio(self.samp_rate_in/self.samp_rate_out) |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 88 | self.blocks_multiply_const_vxx_0_0.set_k((1.0e-6*self.samp_rate_in/self.samp_rate_out, )) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 89 | self.blocks_add_const_vxx_0.set_k((self.samp_rate_in/self.samp_rate_out, )) |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 90 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 91 | def get_samp_rate_out(self): |
| 92 | return self.samp_rate_out |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 93 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 94 | def set_samp_rate_out(self, samp_rate_out): |
| 95 | self.samp_rate_out = samp_rate_out |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 96 | self.blocks_multiply_const_vxx_0.set_k((self.fc/self.samp_rate_out*(2*math.pi)/1e6, )) |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 97 | self.fractional_resampler_xx_0.set_resamp_ratio(self.samp_rate_in/self.samp_rate_out) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 98 | self.blocks_multiply_const_vxx_0_0.set_k((1.0e-6*self.samp_rate_in/self.samp_rate_out, )) |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 99 | self.gsm_controlled_rotator_cc_0.set_samp_rate(self.samp_rate_out) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 100 | self.blocks_add_const_vxx_0.set_k((self.samp_rate_in/self.samp_rate_out, )) |
| 101 | |