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 |
ptrkrysik | 3be74a7 | 2014-12-13 10:11:00 +0100 | [diff] [blame] | 13 | import grgsm |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 14 | import math |
| 15 | |
| 16 | class clock_offset_corrector(gr.hier_block2): |
| 17 | |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 18 | def __init__(self, fc=936.6e6, ppm=0, samp_rate_in=1625000.0/6.0*4.0): |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 19 | gr.hier_block2.__init__( |
| 20 | self, "Clock offset corrector", |
| 21 | gr.io_signature(1, 1, gr.sizeof_gr_complex*1), |
| 22 | gr.io_signature(1, 1, gr.sizeof_gr_complex*1), |
| 23 | ) |
| 24 | |
| 25 | ################################################## |
| 26 | # Parameters |
| 27 | ################################################## |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 28 | self.fc = fc |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 29 | self.ppm = ppm |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 30 | self.samp_rate_in = samp_rate_in |
| 31 | |
| 32 | ################################################## |
| 33 | # Variables |
| 34 | ################################################## |
| 35 | self.samp_rate_out = samp_rate_out = samp_rate_in |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 36 | |
| 37 | ################################################## |
| 38 | # Blocks |
| 39 | ################################################## |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 40 | self.ppm_in = None;self.message_port_register_hier_out("ppm_in") |
ptrkrysik | 3be74a7 | 2014-12-13 10:11:00 +0100 | [diff] [blame] | 41 | self.gsm_controlled_rotator_cc_0 = grgsm.controlled_rotator_cc(0,samp_rate_out) |
| 42 | self.gsm_controlled_const_source_f_0 = grgsm.controlled_const_source_f(ppm) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 43 | 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] | 44 | self.blocks_multiply_const_vxx_0_0 = blocks.multiply_const_vff((1.0e-6*samp_rate_in/samp_rate_out, )) |
| 45 | self.blocks_multiply_const_vxx_0 = blocks.multiply_const_vff((fc/samp_rate_out*(2*math.pi)/1e6, )) |
| 46 | 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] | 47 | |
| 48 | ################################################## |
| 49 | # Connections |
| 50 | ################################################## |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 51 | self.connect((self, 0), (self.fractional_resampler_xx_0, 0)) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 52 | self.connect((self.fractional_resampler_xx_0, 0), (self.gsm_controlled_rotator_cc_0, 0)) |
| 53 | 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] | 54 | 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] | 55 | self.connect((self.blocks_multiply_const_vxx_0, 0), (self.gsm_controlled_rotator_cc_0, 1)) |
| 56 | self.connect((self.gsm_controlled_rotator_cc_0, 0), (self, 0)) |
| 57 | self.connect((self.gsm_controlled_const_source_f_0, 0), (self.blocks_multiply_const_vxx_0_0, 0)) |
| 58 | 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] | 59 | |
| 60 | ################################################## |
| 61 | # Asynch Message Connections |
| 62 | ################################################## |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 63 | 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] | 64 | |
| 65 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 66 | def get_fc(self): |
| 67 | return self.fc |
| 68 | |
| 69 | def set_fc(self, fc): |
| 70 | self.fc = fc |
| 71 | self.blocks_multiply_const_vxx_0.set_k((self.fc/self.samp_rate_out*(2*math.pi)/1e6, )) |
| 72 | |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 73 | def get_ppm(self): |
| 74 | return self.ppm |
| 75 | |
| 76 | def set_ppm(self, ppm): |
| 77 | self.ppm = ppm |
| 78 | self.gsm_controlled_const_source_f_0.set_constant(self.ppm) |
| 79 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 80 | def get_samp_rate_in(self): |
| 81 | return self.samp_rate_in |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 82 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 83 | def set_samp_rate_in(self, samp_rate_in): |
| 84 | self.samp_rate_in = samp_rate_in |
ptrkrysik | 381253a | 2014-11-19 11:30:53 +0100 | [diff] [blame] | 85 | self.set_samp_rate_out(self.samp_rate_in) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 86 | 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] | 87 | 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] | 88 | 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] | 89 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 90 | def get_samp_rate_out(self): |
| 91 | return self.samp_rate_out |
piotr | 4089c1a | 2014-08-06 14:10:56 +0200 | [diff] [blame] | 92 | |
Piotr K | 66bb3cd | 2014-08-13 19:04:57 +0200 | [diff] [blame] | 93 | def set_samp_rate_out(self, samp_rate_out): |
| 94 | self.samp_rate_out = samp_rate_out |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 95 | 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] | 96 | 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] | 97 | 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] | 98 | self.gsm_controlled_rotator_cc_0.set_samp_rate(self.samp_rate_out) |
ptrkrysik | e518bbf | 2014-11-06 14:50:59 +0100 | [diff] [blame] | 99 | self.blocks_add_const_vxx_0.set_k((self.samp_rate_in/self.samp_rate_out, )) |
| 100 | |