switch source package format to 3.0 quilt
[debian/gnuradio] / gnuradio-examples / python / usrp / usrp_wfm_rcv2_nogui.py
1 #!/usr/bin/env python
2 #
3 # Copyright 2005,2006,2007 Free Software Foundation, Inc.
4
5 # This file is part of GNU Radio
6
7 # GNU Radio 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 # GNU Radio 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 GNU Radio; 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 from gnuradio import gr, gru, eng_notation, optfir
24 from gnuradio import audio
25 from gnuradio import usrp
26 from gnuradio import blks2
27 from gnuradio.eng_option import eng_option
28 from optparse import OptionParser
29 from usrpm import usrp_dbid
30 import sys
31 import math
32
33 def calc_dxc_freq(target_freq, baseband_freq, fs):
34    dxc_temp = (target_freq - baseband_freq) % fs
35
36    if dxc_temp < fs/2.0:
37        dxc_freq = - dxc_temp
38        inverted = False
39    else:
40        dxc_freq = fs - dxc_temp
41        inverted = True
42
43    return (dxc_freq, inverted)
44
45 def pick_subdevice(u):
46     """
47     The user didn't specify a subdevice on the command line.
48     Try for one of these, in order: TV_RX, BASIC_RX, whatever is on side A.
49
50     @return a subdev_spec
51     """
52     return usrp.pick_subdev(u, (usrp_dbid.TV_RX,
53                                 usrp_dbid.TV_RX_REV_2,
54                                 usrp_dbid.TV_RX_REV_3,
55                                 usrp_dbid.TV_RX_MIMO,
56                                 usrp_dbid.TV_RX_REV_2_MIMO,
57                                 usrp_dbid.TV_RX_REV_3_MIMO,
58                                 usrp_dbid.BASIC_RX))
59
60
61 class wfm_rx_block (gr.top_block):
62
63     def __init__(self):
64         gr.top_block.__init__(self)
65
66         parser=OptionParser(option_class=eng_option)
67         parser.add_option("-R", "--rx-subdev-spec", type="subdev", default=None,
68                           help="select USRP Rx side A or B (default=A)")
69         parser.add_option("", "--f1", type="eng_float", default=100.7e6,
70                           help="set 1st station frequency to FREQ", metavar="FREQ")
71         parser.add_option("", "--f2", type="eng_float", default=102.5e6,
72                           help="set 2nd station freq to FREQ", metavar="FREQ")
73         parser.add_option("-g", "--gain", type="eng_float", default=40,
74                           help="set gain in dB (default is midpoint)")
75         parser.add_option("-O", "--audio-output", type="string", default="",
76                           help="pcm device name.  E.g., hw:0,0 or surround51 or /dev/dsp")
77
78         (options, args) = parser.parse_args()
79         if len(args) != 0:
80             parser.print_help()
81             sys.exit(1)
82         
83         if abs(options.f1) < 1e6:
84             options.f1 *= 1e6
85
86         if abs(options.f2) < 1e6:
87             options.f2 *= 1e6
88
89         if abs(options.f1 - options.f2) > 5.5e6:
90             print "Sorry, two stations must be within 5.5MHz of each other"
91             raise SystemExit
92
93         f = (options.f1, options.f2)
94         
95         self.vol = .1
96         self.state = "FREQ"
97
98         # build graph
99         
100         self.u = usrp.source_c(0, nchan=2)          # usrp is data source
101
102         adc_rate = self.u.adc_rate()                # 64 MS/s
103         usrp_decim = 200
104         self.u.set_decim_rate(usrp_decim)
105         usrp_rate = adc_rate / usrp_decim           # 320 kS/s
106         chanfilt_decim = 1
107         demod_rate = usrp_rate / chanfilt_decim
108         audio_decimation = 10
109         audio_rate = demod_rate / audio_decimation  # 32 kHz
110
111
112         if options.rx_subdev_spec is None:
113             options.rx_subdev_spec = pick_subdevice(self.u)
114
115         mv = usrp.determine_rx_mux_value(self.u, options.rx_subdev_spec)
116         mv |= (mv << 8) & 0xff00   # both DDC inputs setup same way
117         self.u.set_mux(mv)
118         self.subdev = usrp.selected_subdev(self.u, options.rx_subdev_spec)
119         print "Using RX d'board %s" % (self.subdev.side_and_name(),)
120
121
122         # deinterleave two channels from FPGA
123         di = gr.deinterleave(gr.sizeof_gr_complex)
124         
125         # wire up the head of the chain
126         self.connect(self.u, di)
127         
128         # sound card as final sink
129         audio_sink = audio.sink(int(audio_rate), options.audio_output)
130
131         # taps for channel filter
132         chan_filt_coeffs = optfir.low_pass (1,           # gain
133                                             usrp_rate,   # sampling rate
134                                             80e3,        # passband cutoff
135                                             115e3,       # stopband cutoff
136                                             0.1,         # passband ripple
137                                             60)          # stopband attenuation
138         #print len(chan_filt_coeffs)
139
140         mid_freq = (f[0] + f[1]) / 2
141         # set front end PLL to middle frequency
142         tune_result = self.subdev.set_freq(mid_freq)
143
144         for n in range(2):
145             chan_filt = gr.fir_filter_ccf (chanfilt_decim, chan_filt_coeffs)
146             guts = blks2.wfm_rcv (demod_rate, audio_decimation)
147             volume_control = gr.multiply_const_ff(self.vol)
148             self.connect((di, n), chan_filt)
149             self.connect(chan_filt, guts, volume_control)
150             self.connect(volume_control, (audio_sink, n))
151             dxc_freq, inverted = calc_dxc_freq(f[n], tune_result.baseband_freq,
152                                                self.u.converter_rate())
153             self.u.set_rx_freq(n, dxc_freq)
154         
155
156         if options.gain is None:
157             # if no gain was specified, use the mid-point in dB
158             g = self.subdev.gain_range()
159             options.gain = float(g[0]+g[1])/2
160
161
162         # set initial values
163         self.set_gain(options.gain)
164
165
166     def set_vol (self, vol):
167         self.vol = vol
168         self.volume_control.set_k(self.vol)
169
170
171     def set_gain(self, gain):
172         self.subdev.set_gain(gain)
173
174     def __del__(self):
175         # Avoid weak-reference error
176         del self.subdev
177     
178 if __name__ == '__main__':
179     tb = wfm_rx_block()
180     try:
181         tb.run()
182     except KeyboardInterrupt:
183         pass