cordic test: sqrt

diff --git a/source/main.cpp b/source/main.cpp
index dd98980d27a3d16ba908e43a564a1e589e75c8c6..5afed63c73891706bb524c2232e145df77cb97e3 100644 (file)
--- a/source/main.cpp
+++ b/source/main.cpp
@@ -89,6 +89,25 @@ int main()
     chThdCreateStatic(conversionThreadWA, sizeof(conversionThreadWA),
                       NORMALPRIO, conversionThread, nullptr);
 
+    // TEST (success!)
+    /*double input = 0.25L;
+
+    RCC->AHB2ENR |= RCC_AHB2ENR_CORDICEN;
+    uint32_t dummy = 0;
+    while (CORDIC->CSR & CORDIC_CSR_RRDY)
+        dummy = CORDIC->RDATA;
+
+    CORDIC->CSR = (3 << CORDIC_CSR_PRECISION_Pos) |
+                  (9 << CORDIC_CSR_FUNC_Pos); // 1 arg, 3 iterations, sqrt
+
+    input *= 0x7FFFFFFF;
+    dummy = input;
+    CORDIC->WDATA = dummy;
+    while (!(CORDIC->CSR & CORDIC_CSR_RRDY));
+    // result: 
+    dummy = CORDIC->RDATA; // m cos()
+    double output = (double)dummy / 0x7FFFFFFF;*/
+
     main_loop();
 }