src/libs/sig/ops_sin.c


1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64

#include <assert.h>
#include <math.h>

#include "sig.h"


typedef struct ops_sin_ctxt_t {
	sig_t	*hz;
} ops_sin_ctxt_t;


static size_t ops_sin_size(va_list ap)
{
	return sizeof(ops_sin_ctxt_t);
}


static void ops_sin_init(void *context, va_list ap)
{
	ops_sin_ctxt_t	*ctxt = context;

	assert(ctxt);

	ctxt->hz = va_arg(ap, sig_t *);
}


static void ops_sin_destroy(void *context)
{
	ops_sin_ctxt_t	*ctxt = context;

	assert(ctxt);

	sig_free(ctxt->hz);
}


static float ops_sin_output(void *context, unsigned ticks_ms)
{
	ops_sin_ctxt_t	*ctxt = context;
	float		rads_per_ms, rads, hz;
	unsigned	ms_per_cycle;

	assert(ctxt);
	assert(ctxt->hz);

	hz = sig_output(ctxt->hz, ticks_ms);
	if (hz < .0001f)
		return 0.f;

	ms_per_cycle = hz * 1000.f;
	rads_per_ms = (M_PI * 2.f) * hz * .001f;
	rads = (float)(ticks_ms % ms_per_cycle) * rads_per_ms;

	return sinf(rads);
}


sig_ops_t	sig_ops_sin = {
	.size = ops_sin_size,
	.init = ops_sin_init,
	.destroy = ops_sin_destroy,
	.output = ops_sin_output,
};