rfnoc: Port FFT controller

rfnoc used noc-script for FFT controller implementation. Because
erfnoc does not support noc-script yet, the implementation is done
as a rfnoc controller.

2 files changed, 115 insertions, 0 deletions

diff --git a/host/lib/rfnoc/CMakeLists.txt b/host/lib/rfnoc/CMakeLists.txt
index ae531275f..e685cef26 100644
--- a/host/lib/rfnoc/CMakeLists.txt
+++ b/host/lib/rfnoc/CMakeLists.txt
@@ -43,6 +43,7 @@ LIBUHD_APPEND_SOURCES(
     ${CMAKE_CURRENT_SOURCE_DIR}/ddc_block_control.cpp
     ${CMAKE_CURRENT_SOURCE_DIR}/duc_block_control.cpp
     ${CMAKE_CURRENT_SOURCE_DIR}/dmafifo_block_control.cpp
+    ${CMAKE_CURRENT_SOURCE_DIR}/fft_block_control.cpp
     ${CMAKE_CURRENT_SOURCE_DIR}/null_block_control.cpp
     ${CMAKE_CURRENT_SOURCE_DIR}/radio_control_impl.cpp
 )
diff --git a/host/lib/rfnoc/fft_block_control.cpp b/host/lib/rfnoc/fft_block_control.cpp
new file mode 100644
index 000000000..266eb3e7f
--- /dev/null
+++ b/host/lib/rfnoc/fft_block_control.cpp
@@ -0,0 +1,114 @@
+//
+// Copyright 2019 Ettus Research, a National Instruments Brand
+//
+// SPDX-License-Identifier: GPL-3.0-or-later
+//
+
+#include <uhd/exception.hpp>
+#include <uhd/rfnoc/defaults.hpp>
+#include <uhd/rfnoc/fft_block_control.hpp>
+#include <uhd/rfnoc/registry.hpp>
+
+#include <string>
+
+using namespace uhd::rfnoc;
+
+namespace {
+
+constexpr int DEFAULT_SIZE            = 256;
+const fft_shift DEFAULT_SHIFT         = fft_shift::NORMAL;
+const fft_direction DEFAULT_DIRECTION = fft_direction::FORWARD;
+const fft_magnitude DEFAULT_MAGNITUDE = fft_magnitude::COMPLEX;
+constexpr int DEFAULT_FFT_SCALING     = 1706;
+
+const uhd::rfnoc::io_type_t DEFAULT_TYPE = uhd::rfnoc::IO_TYPE_SC16;
+
+} // namespace
+
+
+const uint32_t fft_block_control::RB_FFT_RESET        = 0;
+const uint32_t fft_block_control::RB_MAGNITUDE_OUT    = 8;
+const uint32_t fft_block_control::RB_FFT_SIZE_LOG2    = 16;
+const uint32_t fft_block_control::RB_FFT_DIRECTION    = 24;
+const uint32_t fft_block_control::RB_FFT_SCALING      = 32;
+const uint32_t fft_block_control::RB_FFT_SHIFT_CONFIG = 40;
+
+const uint32_t fft_block_control::SR_FFT_RESET        = 131 * 8;
+const uint32_t fft_block_control::SR_FFT_SIZE_LOG2    = 132 * 8;
+const uint32_t fft_block_control::SR_MAGNITUDE_OUT    = 133 * 8;
+const uint32_t fft_block_control::SR_FFT_DIRECTION    = 134 * 8;
+const uint32_t fft_block_control::SR_FFT_SCALING      = 135 * 8;
+const uint32_t fft_block_control::SR_FFT_SHIFT_CONFIG = 136 * 8;
+
+class fft_block_control_impl : public fft_block_control
+{
+public:
+    RFNOC_BLOCK_CONSTRUCTOR(fft_block_control)
+    {
+        set_prop_forwarding_policy(forwarding_policy_t::ONE_TO_ONE);
+        set_action_forwarding_policy(forwarding_policy_t::ONE_TO_ONE);
+    }
+
+    void reset()
+    {
+        regs().poke32(SR_FFT_RESET, uint32_t(1));
+        regs().poke32(SR_FFT_RESET, uint32_t(0));
+    }
+
+
+private:
+
+    /**************************************************************************
+     * Initialization
+     *************************************************************************/
+    void _register_props()
+    {
+        // register block specific properties
+        register_property(&_size, [this]() {
+            this->regs().poke32(SR_FFT_SIZE_LOG2, uint32_t(this->_size.get()));
+        });
+        register_property(&_magnitude, [this]() {
+            this->regs().poke32(SR_MAGNITUDE_OUT, uint32_t(this->_magnitude.get()));
+        });
+        register_property(&_direction, [this]() {
+            this->regs().poke32(SR_MAGNITUDE_OUT, uint32_t(this->_direction.get()));
+        });
+        register_property(&_scaling, [this]() {
+            this->regs().poke32(SR_MAGNITUDE_OUT, uint32_t(this->_scaling.get()));
+        });
+        register_property(&_shift, [this]() {
+            this->regs().poke32(SR_MAGNITUDE_OUT, uint32_t(this->_shift.get()));
+        });
+
+        //register edge properties
+        register_property(&_type_in);
+        register_property(&_type_out);
+
+        //add resolvers for type (keeps it constant)
+        add_property_resolver({&_type_in}, {&_type_in}, [& type_in = _type_in]() {
+            type_in.set(IO_TYPE_SC16);
+        });
+        add_property_resolver({&_type_out}, {&_type_out}, [& type_out = _type_out]() {
+            type_out.set(IO_TYPE_SC16);
+        });
+
+    }
+
+    property_t<int> _size{PROP_KEY_FFT_LEN, DEFAULT_SIZE, {res_source_info::USER}};
+    property_t<int> _magnitude = property_t<int>{
+        PROP_KEY_MAGNITUDE, static_cast<int>(DEFAULT_MAGNITUDE), {res_source_info::USER}};
+    property_t<int> _direction = property_t<int>{
+        PROP_KEY_DIRECTION, static_cast<int>(DEFAULT_DIRECTION), {res_source_info::USER}};
+    property_t<int> _scaling = property_t<int>{
+        PROP_KEY_FFT_SCALING, DEFAULT_FFT_SCALING, {res_source_info::USER}};
+    property_t<int> _shift = property_t<int>{
+        PROP_KEY_FFT_SHIFT, static_cast<int>(DEFAULT_SHIFT), {res_source_info::USER}};
+
+    property_t<std::string> _type_in = property_t<std::string>{
+        PROP_KEY_TYPE, IO_TYPE_SC16, {res_source_info::INPUT_EDGE}};
+    property_t<std::string> _type_out = property_t<std::string>{
+        PROP_KEY_TYPE, IO_TYPE_SC16, {res_source_info::OUTPUT_EDGE}};
+};
+
+UHD_RFNOC_BLOCK_REGISTER_DIRECT(
+    fft_block_control, 0xFF700000, "FFT", CLOCK_KEY_GRAPH, "bus_clk")