36 lines
791 B
C
36 lines
791 B
C
#include "system/task_sine.h"
|
|
#include "system/data_channel.h"
|
|
#include "system/float_word.h"
|
|
#include <math.h>
|
|
|
|
#ifndef M_PI
|
|
#define M_PI 3.14159265358979323846
|
|
#endif
|
|
|
|
int task_sine_run(void *data)
|
|
{
|
|
sine_config *task = (sine_config *) data;
|
|
|
|
uint32_t data_channel_base = task->base.sink;
|
|
data_channel_clear(data_channel_base);
|
|
|
|
float amplitude = task->amplitude;
|
|
float phase_rad = task->phase * (float)M_PI / 180.0f;
|
|
float step = 2.0f * (float)M_PI / (float)task->samples_per_periode;
|
|
|
|
for (uint32_t i = 0; i < DATA_CHANNEL_DEPTH; i++)
|
|
{
|
|
float angle = phase_rad + i * step;
|
|
float y = amplitude * sinf(angle);
|
|
|
|
float_word res;
|
|
res.value = y;
|
|
|
|
data_channel_write(data_channel_base, res.word);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
|