sine.c

software/signal_processing/sine.c

@@ -2,9 +2,24 @@
 #include "system/data_channel.h"
 #include "system/float_word.h"
 
+#include <math.h>
+
+#define PI 3.14
+
 int task_sine_run( void * data ) {
 
-    // TODO
+    sine_config *task = (sine_config*)data;
+
+    uint32_t data_channel_base = task->base.sink;
+    data_channel_clear(data_channel_base);
+
+    for (uint32_t i = 0; i < DATA_CHANNEL_DEPTH; ++i)
+    {
+        float_word res;
+        res.value = task->amplitude * sin( (2*PI*task->samples_per_periode) * i + task->phase);
+
+        data_channel_write(data_channel_base, res.word);
+    }
 
     return 0;
 }