git.gag.com Git - debian/gnuradio/blob - gnuradio-examples/python/usrp/usrp_wfm_rcv_pll.py

   1 #!/usr/bin/env python
   2
   3 from gnuradio import gr, gru, eng_notation, optfir
   4 from gnuradio import audio
   5 from gnuradio import usrp
   6 from gnuradio import blks
   7 from gnuradio.eng_option import eng_option
   8 from gnuradio.wxgui import slider, powermate
   9 from gnuradio.wxgui import stdgui, fftsink, form, scopesink
  10 from optparse import OptionParser
  11 import usrp_dbid
  12 import sys
  13 import math
  14 import wx
  15
  16 def pick_subdevice(u):
  17     """
  18     The user didn't specify a subdevice on the command line.
  19     Try for one of these, in order: TV_RX, BASIC_RX, whatever is on side A.
  20
  21     @return a subdev_spec
  22     """
  23     return usrp.pick_subdev(u, (usrp_dbid.TV_RX,
  24                                 usrp_dbid.TV_RX_REV_2,
  25                                 usrp_dbid.BASIC_RX))
  26
  27 class wfm_rx_graph (stdgui.gui_flow_graph):
  28     def __init__(self,frame,panel,vbox,argv):
  29         stdgui.gui_flow_graph.__init__ (self,frame,panel,vbox,argv)
  30
  31         parser=OptionParser(option_class=eng_option)
  32         parser.add_option("-R", "--rx-subdev-spec", type="subdev", default=None,
  33                           help="select USRP Rx side A or B (default=A)")
  34         parser.add_option("-f", "--freq", type="eng_float", default=100.1e6,
  35                           help="set frequency to FREQ", metavar="FREQ")
  36         parser.add_option("-g", "--gain", type="eng_float", default=65,
  37                           help="set gain in dB (default is midpoint)")
  38         parser.add_option("-s", "--squelch", type="eng_float", default=0,
  39                           help="set squelch level (default is 0)")
  40         parser.add_option("-V", "--volume", type="eng_float", default=None,
  41                           help="set volume (default is midpoint)")
  42         parser.add_option("-O", "--audio-output", type="string", default="",
  43                           help="pcm device name.  E.g., hw:0,0 or surround51 or /dev/dsp")
  44
  45
  46         (options, args) = parser.parse_args()
  47         if len(args) != 0:
  48             parser.print_help()
  49             sys.exit(1)
  50
  51         self.frame = frame
  52         self.panel = panel
  53
  54         self.vol = 0
  55         self.state = "FREQ"
  56         self.freq = 0
  57
  58         # build graph
  59
  60         self.u = usrp.source_c()                    # usrp is data source
  61
  62         adc_rate = self.u.adc_rate()                # 64 MS/s
  63         usrp_decim = 200
  64         self.u.set_decim_rate(usrp_decim)
  65         usrp_rate = adc_rate / usrp_decim           # 320 kS/s
  66         chanfilt_decim = 1
  67         demod_rate = usrp_rate / chanfilt_decim
  68         audio_decimation = 10
  69         audio_rate = demod_rate / audio_decimation  # 32 kHz
  70
  71         if options.rx_subdev_spec is None:
  72             options.rx_subdev_spec = pick_subdevice(self.u)
  73
  74         self.u.set_mux(usrp.determine_rx_mux_value(self.u, options.rx_subdev_spec))
  75         self.subdev = usrp.selected_subdev(self.u, options.rx_subdev_spec)
  76
  77
  78         chan_filt_coeffs = optfir.low_pass (1,           # gain
  79                                             usrp_rate,   # sampling rate
  80                                             80e3,        # passband cutoff
  81                                             115e3,       # stopband cutoff
  82                                             0.1,         # passband ripple
  83                                             60)          # stopband attenuation
  84         #print len(chan_filt_coeffs)
  85         chan_filt = gr.fir_filter_ccf (chanfilt_decim, chan_filt_coeffs)
  86
  87
  88         #self.guts = blks.wfm_rcv (self, demod_rate, audio_decimation)
  89         self.guts = blks.wfm_rcv_pll (self, demod_rate, audio_decimation)
  90
  91         # FIXME rework {add,multiply}_const_* to handle multiple streams
  92         self.volume_control_l = gr.multiply_const_ff(self.vol)
  93         self.volume_control_r = gr.multiply_const_ff(self.vol)
  94
  95         # sound card as final sink
  96         audio_sink = audio.sink (int (audio_rate),
  97                                  options.audio_output,
  98                                  False)   # ok_to_block
  99
 100         # now wire it all together
 101         self.connect (self.u, chan_filt, self.guts)
 102         self.connect ((self.guts, 0), self.volume_control_l, (audio_sink, 0))
 103         self.connect ((self.guts, 1), self.volume_control_r, (audio_sink, 1))
 104         try:
 105           self.guts.stereo_carrier_pll_recovery.squelch_enable(True)
 106         except:
 107           print "FYI: This implementation of the stereo_carrier_pll_recovery has no squelch implementation yet"
 108
 109
 110         self._build_gui(vbox, usrp_rate, demod_rate, audio_rate)
 111
 112         if options.gain is None:
 113             # if no gain was specified, use the mid-point in dB
 114             g = self.subdev.gain_range()
 115             options.gain = float(g[0]+g[1])/2
 116
 117         if options.volume is None:
 118             g = self.volume_range()
 119             options.volume = float(g[0]+g[1])/2
 120
 121         if abs(options.freq) < 1e6:
 122             options.freq *= 1e6
 123
 124         # set initial values
 125
 126         self.set_gain(options.gain)
 127         self.set_vol(options.volume)
 128         try:
 129           self.guts.stereo_carrier_pll_recovery.set_lock_threshold(options.squelch)
 130         except:
 131           print "FYI: This implementation of the stereo_carrier_pll_recovery has no squelch implementation yet"
 132
 133         if not(self.set_freq(options.freq)):
 134             self._set_status_msg("Failed to set initial frequency")
 135
 136
 137     def _set_status_msg(self, msg, which=0):
 138         self.frame.GetStatusBar().SetStatusText(msg, which)
 139
 140
 141     def _build_gui(self, vbox, usrp_rate, demod_rate, audio_rate):
 142
 143         def _form_set_freq(kv):
 144             return self.set_freq(kv['freq'])
 145
 146
 147         if 1:
 148             self.src_fft = fftsink.fft_sink_c (self, self.panel, title="Data from USRP",
 149                                                fft_size=512, sample_rate=usrp_rate)
 150             self.connect (self.u, self.src_fft)
 151             vbox.Add (self.src_fft.win, 4, wx.EXPAND)
 152
 153         if 1:
 154             post_fm_demod_fft = fftsink.fft_sink_f (self, self.panel, title="Post FM Demod",
 155                                                   fft_size=512, sample_rate=demod_rate,
 156                                                   y_per_div=10, ref_level=0)
 157             self.connect (self.guts.fm_demod, post_fm_demod_fft)
 158             vbox.Add (post_fm_demod_fft.win, 4, wx.EXPAND)
 159
 160         if 0:
 161             post_stereo_carrier_generator_fft = fftsink.fft_sink_c (self, self.panel, title="Post Stereo_carrier_generator",
 162                                                   fft_size=512, sample_rate=audio_rate,
 163                                                   y_per_div=10, ref_level=0)
 164             self.connect (self.guts.stereo_carrier_generator, post_stereo_carrier_generator_fft)
 165             vbox.Add (post_stereo_carrier_generator_fft.win, 4, wx.EXPAND)
 166
 167         if 0:
 168             post_deemphasis_left = fftsink.fft_sink_f (self, self.panel, title="Post_Deemphasis_Left",
 169                                                   fft_size=512, sample_rate=audio_rate,
 170                                                   y_per_div=10, ref_level=0)
 171             self.connect (self.guts.deemph_Left, post_deemphasis_left)
 172             vbox.Add (post_deemphasis_left.win, 4, wx.EXPAND)
 173
 174         if 0:
 175             post_deemphasis_right = fftsink.fft_sink_f (self, self.panel, title="Post_Deemphasis_Right",
 176                                                   fft_size=512, sample_rate=audio_rate,
 177                                                   y_per_div=10, ref_level=-20)
 178             self.connect (self.guts.deemph_Left, post_deemphasis_right)
 179             vbox.Add (post_deemphasis_right.win, 4, wx.EXPAND)
 180
 181
 182         if 0:
 183             LmR_fft = fftsink.fft_sink_f (self, self.panel, title="LmR",
 184                                                 fft_size=512, sample_rate=audio_rate,
 185                                                 y_per_div=10, ref_level=-20)
 186             self.connect (self.guts.LmR_real,LmR_fft)
 187             vbox.Add (LmR_fft.win, 4, wx.EXPAND)
 188
 189         if 0:
 190             self.scope = scopesink.scope_sink_f(self, self.panel, sample_rate=demod_rate)
 191             self.connect (self.guts.fm_demod_a,self.scope)
 192             vbox.Add (self.scope.win,4,wx.EXPAND)
 193
 194         # control area form at bottom
 195         self.myform = myform = form.form()
 196
 197         hbox = wx.BoxSizer(wx.HORIZONTAL)
 198         hbox.Add((5,0), 0)
 199         myform['freq'] = form.float_field(
 200             parent=self.panel, sizer=hbox, label="Freq", weight=1,
 201             callback=myform.check_input_and_call(_form_set_freq, self._set_status_msg))
 202
 203         hbox.Add((5,0), 0)
 204         myform['freq_slider'] = \
 205             form.quantized_slider_field(parent=self.panel, sizer=hbox, weight=3,
 206                                         range=(87.9e6, 108.1e6, 0.1e6),
 207                                         callback=self.set_freq)
 208         hbox.Add((5,0), 0)
 209         vbox.Add(hbox, 0, wx.EXPAND)
 210
 211         hbox = wx.BoxSizer(wx.HORIZONTAL)
 212         hbox.Add((5,0), 0)
 213
 214         myform['volume'] = \
 215             form.quantized_slider_field(parent=self.panel, sizer=hbox, label="Volume",
 216                                         weight=3, range=self.volume_range(),
 217                                         callback=self.set_vol)
 218         hbox.Add((5,0), 1)
 219
 220         myform['gain'] = \
 221             form.quantized_slider_field(parent=self.panel, sizer=hbox, label="Gain",
 222                                         weight=3, range=self.subdev.gain_range(),
 223                                         callback=self.set_gain)
 224         hbox.Add((5,0), 0)
 225
 226         myform['sqlch_thrsh'] = \
 227             form.quantized_slider_field(parent=self.panel, sizer=hbox, label="Stereo Squelch Threshold",
 228                                         weight=3, range=(0.0,1.0,0.01),
 229                                         callback=self.set_squelch)
 230         hbox.Add((5,0), 0)
 231         vbox.Add(hbox, 0, wx.EXPAND)
 232
 233         try:
 234             self.knob = powermate.powermate(self.frame)
 235             self.rot = 0
 236             powermate.EVT_POWERMATE_ROTATE (self.frame, self.on_rotate)
 237             powermate.EVT_POWERMATE_BUTTON (self.frame, self.on_button)
 238         except:
 239             print "FYI: No Powermate or Contour Knob found"
 240
 241
 242     def on_rotate (self, event):
 243         self.rot += event.delta
 244         if (self.state == "FREQ"):
 245             if self.rot >= 3:
 246                 self.set_freq(self.freq + .1e6)
 247                 self.rot -= 3
 248             elif self.rot <=-3:
 249                 self.set_freq(self.freq - .1e6)
 250                 self.rot += 3
 251         else:
 252             step = self.volume_range()[2]
 253             if self.rot >= 3:
 254                 self.set_vol(self.vol + step)
 255                 self.rot -= 3
 256             elif self.rot <=-3:
 257                 self.set_vol(self.vol - step)
 258                 self.rot += 3
 259
 260     def on_button (self, event):
 261         if event.value == 0:        # button up
 262             return
 263         self.rot = 0
 264         if self.state == "FREQ":
 265             self.state = "VOL"
 266         else:
 267             self.state = "FREQ"
 268         self.update_status_bar ()
 269
 270
 271     def set_vol (self, vol):
 272         g = self.volume_range()
 273         self.vol = max(g[0], min(g[1], vol))
 274         self.volume_control_l.set_k(10**(self.vol/10))
 275         self.volume_control_r.set_k(10**(self.vol/10))
 276         self.myform['volume'].set_value(self.vol)
 277         self.update_status_bar ()
 278
 279     def set_squelch(self,squelch_threshold):
 280         try:
 281           self.guts.stereo_carrier_pll_recovery.set_lock_threshold(squelch_threshold);
 282         except:
 283           print "FYI: This implementation of the stereo_carrier_pll_recovery has no squelch implementation yet"
 284
 285     def set_freq(self, target_freq):
 286         """
 287         Set the center frequency we're interested in.
 288
 289         @param target_freq: frequency in Hz
 290         @rypte: bool
 291
 292         Tuning is a two step process.  First we ask the front-end to
 293         tune as close to the desired frequency as it can.  Then we use
 294         the result of that operation and our target_frequency to
 295         determine the value for the digital down converter.
 296         """
 297         r = usrp.tune(self.u, 0, self.subdev, target_freq)
 298
 299         if r:
 300             self.freq = target_freq
 301             self.myform['freq'].set_value(target_freq)         # update displayed value
 302             self.myform['freq_slider'].set_value(target_freq)  # update displayed value
 303             self.update_status_bar()
 304             self._set_status_msg("OK", 0)
 305             return True
 306
 307         self._set_status_msg("Failed", 0)
 308         return False
 309
 310     def set_gain(self, gain):
 311         self.myform['gain'].set_value(gain)     # update displayed value
 312         self.subdev.set_gain(gain)
 313
 314     def update_status_bar (self):
 315         msg = "Volume:%r  Setting:%s" % (self.vol, self.state)
 316         self._set_status_msg(msg, 1)
 317         self.src_fft.set_baseband_freq(self.freq)
 318
 319     def volume_range(self):
 320         return (-20.0, 0.0, 0.5)
 321
 322
 323 if __name__ == '__main__':
 324     app = stdgui.stdapp (wfm_rx_graph, "USRP WFM RX")
 325     app.MainLoop ()