2022-02-17 20:22:12 +01:00
|
|
|
/*
|
|
|
|
*
|
|
|
|
* Copyright 2022 Camille "DrasLorus" Monière.
|
|
|
|
*
|
|
|
|
* This file is part of CORDIC_Rotate_APFX.
|
|
|
|
*
|
|
|
|
* This program is free software: you can redistribute it and/or modify it under the terms of the GNU
|
|
|
|
* Lesser General Public License as published by the Free Software Foundation, either version 3 of
|
|
|
|
* the License, or (at your option) any later version.
|
|
|
|
*
|
|
|
|
* This program 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
|
|
|
|
* Lesser General Public License for more details.
|
|
|
|
*
|
|
|
|
* You should have received a copy of the GNU Lesser General Public License along with this program.
|
|
|
|
* If not, see <https://www.gnu.org/licenses/>.
|
|
|
|
*
|
|
|
|
*/
|
|
|
|
|
2022-02-07 18:58:38 +01:00
|
|
|
#ifndef C_CORDIC_ROTATE_HPP
|
|
|
|
#define C_CORDIC_ROTATE_HPP
|
|
|
|
|
2022-02-04 19:27:11 +01:00
|
|
|
#include <climits>
|
|
|
|
#include <cmath>
|
|
|
|
#include <cstdint>
|
|
|
|
#include <cstdlib>
|
|
|
|
|
|
|
|
#include <complex>
|
|
|
|
|
|
|
|
#include <ap_fixed.h>
|
|
|
|
#include <ap_int.h>
|
|
|
|
|
|
|
|
template <uint8_t N_STAGES,
|
|
|
|
class T,
|
|
|
|
uint8_t ATAN_I>
|
|
|
|
struct CAtanLUT {
|
2022-02-11 19:17:11 +01:00
|
|
|
static constexpr double atanDbl[28] {
|
|
|
|
0.78539816339745, 0.46364760900081, 0.24497866312686, 0.12435499454676,
|
|
|
|
0.06241880999596, 0.03123983343027, 0.01562372862048, 0.00781234106010,
|
|
|
|
0.00390623013197, 0.00195312251648, 0.00097656218956, 0.00048828121119,
|
|
|
|
0.00024414062015, 0.00012207031189, 0.00006103515617, 0.00003051757812,
|
|
|
|
0.00001525878906, 0.00000762939453, 0.00000381469727, 0.00000190734863,
|
|
|
|
0.00000095367432, 0.00000047683716, 0.00000023841858, 0.00000011920929,
|
|
|
|
0.00000005960464, 0.00000002980232, 0.00000001490116, 0.00000000745058};
|
|
|
|
|
2022-02-04 19:27:11 +01:00
|
|
|
static_assert(N_STAGES < 28, "Not enough arctan available.");
|
|
|
|
static_assert(N_STAGES <= ATAN_I, "ATAN_I can't be less than N_STAGES.");
|
2022-02-17 20:22:12 +01:00
|
|
|
static_assert(std::is_integral<T>(), "Must be a standard C++ integer type.");
|
2022-02-04 19:27:11 +01:00
|
|
|
constexpr CAtanLUT() : table() {
|
|
|
|
for (uint8_t i = 0; i < N_STAGES; ++i) {
|
|
|
|
const double scaled = atanDbl[i] * static_cast<double>(1 << ATAN_I) + 0.5;
|
|
|
|
table[i] = static_cast<T>(scaled);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
T table[N_STAGES];
|
|
|
|
};
|
|
|
|
|
|
|
|
template <uint8_t N_STAGES,
|
|
|
|
uint8_t TH_W,
|
|
|
|
uint8_t TH_I,
|
|
|
|
uint8_t IN_W,
|
|
|
|
uint8_t IN_I,
|
|
|
|
uint8_t OUT_W,
|
|
|
|
uint8_t OUT_I,
|
|
|
|
uint8_t ATAN_I>
|
2022-02-18 21:33:59 +01:00
|
|
|
class CCordicRotateSmart {
|
2022-02-04 19:27:11 +01:00
|
|
|
public:
|
2022-02-11 20:17:10 +01:00
|
|
|
static constexpr const CAtanLUT<N_STAGES, uint64_t, ATAN_I> & atanLUT = CAtanLUT<N_STAGES, uint64_t, ATAN_I>();
|
|
|
|
|
2022-02-04 19:27:11 +01:00
|
|
|
static void process(
|
|
|
|
const ap_fixed<TH_W, TH_I> & fx_angle,
|
|
|
|
const ap_fixed<IN_W, IN_I> & fx_re_in,
|
|
|
|
const ap_fixed<IN_W, IN_I> & fx_im_in,
|
|
|
|
ap_fixed<OUT_W, OUT_I> & fx_re_out,
|
|
|
|
ap_fixed<OUT_W, OUT_I> & fx_im_out);
|
|
|
|
|
2022-02-18 21:33:59 +01:00
|
|
|
CCordicRotateSmart() {}
|
|
|
|
virtual ~CCordicRotateSmart() {};
|
2022-02-04 19:27:11 +01:00
|
|
|
};
|
|
|
|
|
2022-02-07 18:58:38 +01:00
|
|
|
#endif
|