1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
|
#!/usr/bin/env python
#
# Copyright 2015 <+YOU OR YOUR COMPANY+>.
#
# This is free software; you can redistribute it and/or modify
# it under the terms of the GNU General Public License as published by
# the Free Software Foundation; either version 3, or (at your option)
# any later version.
#
# This software is distributed in the hope that it will be useful,
# but WITHOUT ANY WARRANTY; without even the implied warranty of
# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
# GNU General Public License for more details.
#
# You should have received a copy of the GNU General Public License
# along with this software; see the file COPYING. If not, write to
# the Free Software Foundation, Inc., 51 Franklin Street,
# Boston, MA 02110-1301, USA.
#
import sys
import time
import numpy
from gnuradio import gr
import sciscipy
class Response(gr.sync_block):
"""
docstring for block add_python
"""
def __init__(self,order,itype,tstart,tstop,tstep):
sys.setrecursionlimit(2000)
a = []
self.b = [0.0,0.0,0.0,0.0,0.0,0.0]
[float(i) for i in self.b]
self.c = [0,0,0,0,0,0]
[float(i) for i in self.c]
self.i = 0
self.order=int(order)+1
self.itype = itype
self.tstart = tstart
self.tstop = tstop
self.tstep = tstep
gr.sync_block.__init__(self,
name="Response",
in_sig=[numpy.float32,numpy.float32],
out_sig=[numpy.float32])
def find_resp(self,b,c):
if (self.itype == 11):
typo = "'imp'"
elif (self.itype == 12):
typo = "'step'"
else:
typo = "t"
string1 = "s=%s; h=syslin('c',"
string2 = str(b[4])+"*s^4+"+str(b[3])+"*s^3+"+str(b[2])+"*s^2+"+str(b[1])+"*s+"+str(b[0])+","
string3 = str(c[4])+"*s^4+"+str(c[3])+"*s^3+"+str(c[2])+"*s^2+"+str(c[1])+"*s+"+str(c[0])+");"
string4 = "t="+str(self.tstart)+":"+str(self.tstep)+":"+str(self.tstop)+";"
string5 = "deff('u=input(t)','u=50');"
string6 = "r=tf2ss(h); a=csim("+typo+",t,r);"
string = string1+string2+string3+string4+string5+string6
sciscipy.eval(string)
self.a = sciscipy.read("a")
def work(self, input_items, output_items):
#sys.setrecursionlimit(1500)
k = self.order
for i in range(0,k):
self.b[i] = input_items[0][i]
for n,i in enumerate(self.b):
if i == 'nan':
self.b[n] = 0
print "I am value of b\n",self.b
for j in range(0,k):
self.c[j] = input_items[1][j]
for m,i in enumerate (self.c):
if n == 'nan':
self.c[m] = 0
print "I am vlaue of c\n", self.c
self.find_resp(self.b,self.c)
out = output_items[0]
self.i+=1
if self.i >= len(self.a):
self.i = 0
out[:] = numpy.float32(self.a[self.i])
return len(output_items[0])
|
