#!/usr/bin/env python
#
# Copyright 2008 Free Software Foundation, Inc.
# 
# This file is part of GNU Radio
# 
# GNU Radio 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.
# 
# GNU Radio 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 program; if not, write to the Free Software Foundation, Inc.,
# 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
#

from gnuradio import gr, gr_unittest
import gcell
import sys
import random

primes = (2,3,5,7,11,13,17,19,23,29,31,37,41,43,47,53,
          59,61,67,71,73,79,83,89,97,101,103,107,109,113,127,131,
          137,139,149,151,157,163,167,173,179,181,191,193,197,199,211,223,
          227,229,233,239,241,251,257,263,269,271,277,281,283,293,307,311)


class test_fft_filter(gr_unittest.TestCase):

    def setUp(self):
        ph = gcell.program_handle_from_filename("../../gcell/lib/spu/gcell_all")
        opts = gcell.jm_options(ph, 1)
        self.mgr = gcell.job_manager(opts)
        gcell.set_singleton(self.mgr)

    def tearDown(self):
	pass

    def assert_fft_ok2(self, expected_result, result_data):
        expected_result = expected_result[:len(result_data)]
        self.assertComplexTuplesAlmostEqual2 (expected_result, result_data,
                                              abs_eps=1e-9, rel_eps=4e-4)

    def assert_fft_float_ok2(self, expected_result, result_data, abs_eps=1e-9, rel_eps=4e-4):
        expected_result = expected_result[:len(result_data)]
        self.assertFloatTuplesAlmostEqual2 (expected_result, result_data,
                                            abs_eps, rel_eps)

    def test_001(self):
	tb = gr.top_block()
        fft_size = 32
        src_data = tuple([complex(primes[2*i], primes[2*i+1]) for i in range(fft_size)])

        expected_result = ((4377+4516j),
                           (-1706.1268310546875+1638.4256591796875j),
                           (-915.2083740234375+660.69427490234375j),
                           (-660.370361328125+381.59600830078125j),
                           (-499.96044921875+238.41630554199219j),
                           (-462.26748657226562+152.88948059082031j),
                           (-377.98440551757812+77.5928955078125j),
                           (-346.85821533203125+47.152004241943359j),
                           (-295+20j),
                           (-286.33609008789062-22.257017135620117j),
                           (-271.52999877929688-33.081821441650391j),
                           (-224.6358642578125-67.019538879394531j),
                           (-244.24473571777344-91.524826049804688j),
                           (-203.09068298339844-108.54627227783203j),
                           (-198.45195007324219-115.90768432617188j),
                           (-182.97744750976562-128.12318420410156j),
                           (-167-180j),
                           (-130.33688354492188-173.83778381347656j),
                           (-141.19784545898438-190.28807067871094j),
                           (-111.09677124023438-214.48896789550781j),
                           (-70.039543151855469-242.41630554199219j),
                           (-68.960540771484375-228.30015563964844j),
                           (-53.049201965332031-291.47097778320312j),
                           (-28.695289611816406-317.64553833007812j),
                           (57-300j),
                           (45.301143646240234-335.69509887695312j),
                           (91.936195373535156-373.32437133789062j),
                           (172.09465026855469-439.275146484375j),
                           (242.24473571777344-504.47515869140625j),
                           (387.81732177734375-666.6788330078125j),
                           (689.48553466796875-918.2142333984375j),
                           (1646.539306640625-1694.1956787109375j))

        src = gr.vector_source_c(src_data)
        s2v = gr.stream_to_vector(gr.sizeof_gr_complex, fft_size)
        fft = gcell.fft_vcc(fft_size, True, [], False)
        v2s = gr.vector_to_stream(gr.sizeof_gr_complex, fft_size)
        dst = gr.vector_sink_c()
        tb.connect(src, s2v, fft, v2s, dst)
        tb.run()
        result_data = dst.data()
        #print 'expected:', expected_result
        #print 'results: ', result_data
        #self.assertComplexTuplesAlmostEqual (expected_result, result_data, 5)
        self.assert_fft_ok2(expected_result, result_data)

    def test_002(self):
	tb = gr.top_block()
        fft_size = 32

        tmp_data = ((4377+4516j),
                    (-1706.1268310546875+1638.4256591796875j),
                    (-915.2083740234375+660.69427490234375j),
                    (-660.370361328125+381.59600830078125j),
                    (-499.96044921875+238.41630554199219j),
                    (-462.26748657226562+152.88948059082031j),
                    (-377.98440551757812+77.5928955078125j),
                    (-346.85821533203125+47.152004241943359j),
                    (-295+20j),
                    (-286.33609008789062-22.257017135620117j),
                    (-271.52999877929688-33.081821441650391j),
                    (-224.6358642578125-67.019538879394531j),
                    (-244.24473571777344-91.524826049804688j),
                    (-203.09068298339844-108.54627227783203j),
                    (-198.45195007324219-115.90768432617188j),
                    (-182.97744750976562-128.12318420410156j),
                    (-167-180j),
                    (-130.33688354492188-173.83778381347656j),
                    (-141.19784545898438-190.28807067871094j),
                    (-111.09677124023438-214.48896789550781j),
                    (-70.039543151855469-242.41630554199219j),
                    (-68.960540771484375-228.30015563964844j),
                    (-53.049201965332031-291.47097778320312j),
                    (-28.695289611816406-317.64553833007812j),
                    (57-300j),
                    (45.301143646240234-335.69509887695312j),
                    (91.936195373535156-373.32437133789062j),
                    (172.09465026855469-439.275146484375j),
                    (242.24473571777344-504.47515869140625j),
                    (387.81732177734375-666.6788330078125j),
                    (689.48553466796875-918.2142333984375j),
                    (1646.539306640625-1694.1956787109375j))

        src_data = tuple([x/fft_size for x in tmp_data])

        expected_result = tuple([complex(primes[2*i], primes[2*i+1]) for i in range(fft_size)])

        src = gr.vector_source_c(src_data)
        s2v = gr.stream_to_vector(gr.sizeof_gr_complex, fft_size)
        fft = gcell.fft_vcc(fft_size, False, [], False)
        v2s = gr.vector_to_stream(gr.sizeof_gr_complex, fft_size)
        dst = gr.vector_sink_c()
        tb.connect(src, s2v, fft, v2s, dst)
        tb.run()
        result_data = dst.data()
        #print 'expected:', expected_result
        #print 'results: ', result_data
        #self.assertComplexTuplesAlmostEqual (expected_result, result_data, 5)
        self.assert_fft_ok2(expected_result, result_data)


if __name__ == '__main__':
    gr_unittest.main ()