forked from DrSutherland/fyp-faster-gps
-
Notifications
You must be signed in to change notification settings - Fork 0
/
sfft_cross_correlation.py
59 lines (44 loc) · 1.49 KB
/
sfft_cross_correlation.py
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
import matplotlib.pyplot as plt
import numpy as np
import ca_code
import fourier_transforms
from parameters import Parameters
import sfft, sfft_inverse
import sfft_aliasing
__author__ = 'jyl111'
def main():
code_1 = ca_code.generate(prn=1) | np.roll(ca_code.generate(prn=2), 100)
code_2 = ca_code.generate(prn=1)
# code_2 = np.roll(code_2, 100)
# fftshift(ifft(fft(a,corrLength).*conj(fft(b,corrLength))))
q = 2
code_1 = sfft_aliasing.execute(code_1, q)
code_2 = sfft_aliasing.execute(code_2, q)
code_1_fft = fourier_transforms.fft(code_1)
code_2_fft = fourier_transforms.fft(code_2)
multiplied = code_1_fft * np.conj(code_2_fft)
print multiplied.size
params = Parameters(
n=multiplied.size/2,
k=1,
B_k_location=2,
B_k_estimation=2,
estimation_loops=8,
location_loops=5,
loop_threshold=4,
tolerance_location=1e-8,
tolerance_estimation=1e-8
)
result = sfft_inverse.execute(params=params, x=multiplied)
result = fourier_transforms.fftshift(result)
result_actual = fourier_transforms.ifft(multiplied)
result_actual = fourier_transforms.fftshift(result_actual)
print 'sfft size', result.size
print 'original size', result_actual.size
fig = plt.figure()
ax = fig.gca()
ax.plot(np.linspace(-1, 1, result.size), np.abs(result))
ax.plot(np.linspace(-1, 1, result_actual.size), np.abs(result_actual))
plt.show()
if __name__ == '__main__':
main()