Fixing up fft and constellation plot to better handle zooming.
[debian/gnuradio] / gr-utils / src / python / gr_plot_fft.py
1 #!/usr/bin/env python
2 #
3 # Copyright 2007,2008,2011 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 try:
24     import scipy
25     from scipy import fftpack
26 except ImportError:
27     print "Please install SciPy to run this script (http://www.scipy.org/)"
28     raise SystemExit, 1
29
30 try:
31     from pylab import *
32 except ImportError:
33     print "Please install Matplotlib to run this script (http://matplotlib.sourceforge.net/)"
34     raise SystemExit, 1
35
36 from optparse import OptionParser
37
38 class gr_plot_fft:
39     def __init__(self, datatype, filename, options):
40         self.hfile = open(filename, "r")
41         self.block_length = options.block
42         self.start = options.start
43         self.sample_rate = options.sample_rate
44
45         self.datatype = getattr(scipy, datatype)
46         self.sizeof_data = self.datatype().nbytes    # number of bytes per sample in file
47
48         self.axis_font_size = 16
49         self.label_font_size = 18
50         self.title_font_size = 20
51         self.text_size = 22
52
53         # Setup PLOT
54         self.fig = figure(1, figsize=(16, 12), facecolor='w')
55         rcParams['xtick.labelsize'] = self.axis_font_size
56         rcParams['ytick.labelsize'] = self.axis_font_size
57         
58         self.text_file     = figtext(0.10, 0.94, ("File: %s" % filename), weight="heavy", size=self.text_size)
59         self.text_file_pos = figtext(0.10, 0.88, "File Position: ", weight="heavy", size=self.text_size)
60         self.text_block    = figtext(0.35, 0.88, ("Block Size: %d" % self.block_length),
61                                      weight="heavy", size=self.text_size)
62         self.text_sr       = figtext(0.60, 0.88, ("Sample Rate: %.2f" % self.sample_rate),
63                                      weight="heavy", size=self.text_size)
64         self.make_plots()
65
66         self.button_left_axes = self.fig.add_axes([0.45, 0.01, 0.05, 0.05], frameon=True)
67         self.button_left = Button(self.button_left_axes, "<")
68         self.button_left_callback = self.button_left.on_clicked(self.button_left_click)
69
70         self.button_right_axes = self.fig.add_axes([0.50, 0.01, 0.05, 0.05], frameon=True)
71         self.button_right = Button(self.button_right_axes, ">")
72         self.button_right_callback = self.button_right.on_clicked(self.button_right_click)
73
74         self.xlim = self.sp_iq.get_xlim()
75
76         self.manager = get_current_fig_manager()
77         connect('draw_event', self.zoom)
78         connect('key_press_event', self.click)
79         show()
80         
81     def get_data(self):
82         self.position = self.hfile.tell()/self.sizeof_data
83         self.text_file_pos.set_text("File Position: %d" % (self.position))
84         try:
85             self.iq = scipy.fromfile(self.hfile, dtype=self.datatype, count=self.block_length)
86         except MemoryError:
87             print "End of File"
88         else:
89             self.iq_fft = self.dofft(self.iq)
90             
91             tstep = 1.0 / self.sample_rate
92             #self.time = scipy.array([tstep*(self.position + i) for i in xrange(len(self.iq))])
93             self.time = scipy.array([tstep*(i) for i in xrange(len(self.iq))])
94
95             self.freq = self.calc_freq(self.time, self.sample_rate)
96
97     def dofft(self, iq):
98         N = len(iq)
99         iq_fft = fftpack.fftshift(scipy.fft(iq))       # fft and shift axis
100         iq_fft = 20*scipy.log10(abs((iq_fft+1e-15)/N)) # convert to decibels, adjust power
101         # adding 1e-15 (-300 dB) to protect against value errors if an item in iq_fft is 0
102         return iq_fft
103
104     def calc_freq(self, time, sample_rate):
105         N = len(time)
106         Fs = 1.0 / (time.max() - time.min())
107         Fn = 0.5 * sample_rate
108         freq = scipy.array([-Fn + i*Fs for i in xrange(N)])
109         return freq
110         
111     def make_plots(self):
112         # if specified on the command-line, set file pointer
113         self.hfile.seek(self.sizeof_data*self.start, 1)
114
115         # Subplot for real and imaginary parts of signal
116         self.sp_iq = self.fig.add_subplot(2,2,1, position=[0.075, 0.2, 0.4, 0.6])
117         self.sp_iq.set_title(("I&Q"), fontsize=self.title_font_size, fontweight="bold")
118         self.sp_iq.set_xlabel("Time (s)", fontsize=self.label_font_size, fontweight="bold")
119         self.sp_iq.set_ylabel("Amplitude (V)", fontsize=self.label_font_size, fontweight="bold")
120
121         # Subplot for FFT plot
122         self.sp_fft = self.fig.add_subplot(2,2,2, position=[0.575, 0.2, 0.4, 0.6])
123         self.sp_fft.set_title(("FFT"), fontsize=self.title_font_size, fontweight="bold")
124         self.sp_fft.set_xlabel("Frequency (Hz)", fontsize=self.label_font_size, fontweight="bold")
125         self.sp_fft.set_ylabel("Power Spectrum (dBm)", fontsize=self.label_font_size, fontweight="bold")
126
127         self.get_data()
128         
129         self.plot_iq  = self.sp_iq.plot([], 'bo-') # make plot for reals
130         self.plot_iq += self.sp_iq.plot([], 'ro-') # make plot for imags
131         self.draw_time()                           # draw the plot
132
133         self.plot_fft = self.sp_fft.plot([], 'bo-')  # make plot for FFT
134         self.draw_fft()                              # draw the plot
135
136         draw()
137
138     def draw_time(self):
139         reals = self.iq.real
140         imags = self.iq.imag
141         self.plot_iq[0].set_data([self.time, reals])
142         self.plot_iq[1].set_data([self.time, imags])
143         self.sp_iq.set_xlim(self.time.min(), self.time.max())
144         self.sp_iq.set_ylim([1.5*min([reals.min(), imags.min()]),
145                              1.5*max([reals.max(), imags.max()])])
146
147     def draw_fft(self):
148         self.plot_fft[0].set_data([self.freq, self.iq_fft])
149         self.sp_fft.set_xlim(self.freq.min(), self.freq.max())
150         self.sp_fft.set_ylim([self.iq_fft.min()-10, self.iq_fft.max()+10])
151
152     def update_plots(self):
153         self.draw_time()
154         self.draw_fft()
155
156         self.xlim = self.sp_iq.get_xlim()
157         draw()
158         
159     def zoom(self, event):
160         newxlim = scipy.array(self.sp_iq.get_xlim())
161         curxlim = scipy.array(self.xlim)
162         if(newxlim[0] != curxlim[0] or newxlim[1] != curxlim[1]):
163             self.xlim = newxlim
164             #xmin = max(0, int(ceil(self.sample_rate*(self.xlim[0] - self.position))))
165             #xmax = min(int(ceil(self.sample_rate*(self.xlim[1] - self.position))), len(self.iq))
166             xmin = max(0, int(ceil(self.sample_rate*(self.xlim[0]))))
167             xmax = min(int(ceil(self.sample_rate*(self.xlim[1]))), len(self.iq))
168
169             iq = self.iq[xmin : xmax]
170             time = self.time[xmin : xmax]
171             
172             iq_fft = self.dofft(iq)
173             freq = self.calc_freq(time, self.sample_rate)
174             
175             self.plot_fft[0].set_data(freq, iq_fft)
176             self.sp_fft.axis([freq.min(), freq.max(),
177                               iq_fft.min()-10, iq_fft.max()+10])
178
179             draw()
180
181     def click(self, event):
182         forward_valid_keys = [" ", "down", "right"]
183         backward_valid_keys = ["up", "left"]
184
185         if(find(event.key, forward_valid_keys)):
186             self.step_forward()
187             
188         elif(find(event.key, backward_valid_keys)):
189             self.step_backward()
190
191     def button_left_click(self, event):
192         self.step_backward()
193
194     def button_right_click(self, event):
195         self.step_forward()
196
197     def step_forward(self):
198         self.get_data()
199         self.update_plots()
200
201     def step_backward(self):
202         # Step back in file position
203         if(self.hfile.tell() >= 2*self.sizeof_data*self.block_length ):
204             self.hfile.seek(-2*self.sizeof_data*self.block_length, 1)
205         else:
206             self.hfile.seek(-self.hfile.tell(),1)
207         self.get_data()
208         self.update_plots()
209         
210 def find(item_in, list_search):
211     try:
212         return list_search.index(item_in) != None
213     except ValueError:
214         return False
215
216 def setup_options():
217     usage="%prog: [options] input_filename"
218     description = "Takes a GNU Radio complex binary file and displays the I&Q data versus time as well as the frequency domain (FFT) plot. The y-axis values are plotted assuming volts as the amplitude of the I&Q streams and converted into dBm in the frequency domain (the 1/N power adjustment out of the FFT is performed internally). The script plots a certain block of data at a time, specified on the command line as -B or --block. This value defaults to 1000. The start position in the file can be set by specifying -s or --start and defaults to 0 (the start of the file). By default, the system assumes a sample rate of 1, so in time, each sample is plotted versus the sample number. To set a true time and frequency axis, set the sample rate (-R or --sample-rate) to the sample rate used when capturing the samples."
219
220     parser = OptionParser(conflict_handler="resolve", usage=usage, description=description)
221     parser.add_option("-d", "--data-type", type="string", default="complex64",
222                       help="Specify the data type (complex64, float32, (u)int32, (u)int16, (u)int8) [default=%default]")
223     parser.add_option("-B", "--block", type="int", default=1000,
224                       help="Specify the block size [default=%default]")
225     parser.add_option("-s", "--start", type="int", default=0,
226                       help="Specify where to start in the file [default=%default]")
227     parser.add_option("-R", "--sample-rate", type="float", default=1.0,
228                       help="Set the sampler rate of the data [default=%default]")
229     return parser
230
231 def main():
232     parser = setup_options()
233     (options, args) = parser.parse_args ()
234     if len(args) != 1:
235         parser.print_help()
236         raise SystemExit, 1
237     filename = args[0]
238
239     dc = gr_plot_fft(options.data_type, filename, options)
240
241 if __name__ == "__main__":
242     try:
243         main()
244     except KeyboardInterrupt:
245         pass
246     
247
248