block_switch.c 2.31 KB
Newer Older
Jeroen Vreeken's avatar
Jeroen Vreeken committed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
/*
	Copyright Jeroen Vreeken (pe1rxq@amsat.org), 2011
	Copyright Stichting C.A. Muller Radioastronomiestation, 2011

	This program is free software: you can redistribute it and/or modify
	it under the terms of the GNU 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 General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program.  If not, see <http://www.gnu.org/licenses/>.

 */

#include <stdio.h>
#include <stdlib.h>
#include <string.h>

Jeroen Vreeken's avatar
Jeroen Vreeken committed
24
#include <controller/controller_block.h>
Jeroen Vreeken's avatar
Jeroen Vreeken committed
25
26
27
28
29
30
31
32
33
34
35
36
37
38

/*
       inputs          outputs
       nr name         nr name

     --------------------------
  ---| 0  in                  |
     |                 0  out |----
  ---| 1  on                  |
     --------------------------
 */

struct controller_block_private {
	float *in;
39
	bool  *on;
Jeroen Vreeken's avatar
Jeroen Vreeken committed
40
41
42
	float out;
};

43
static void switch_calculate(struct controller_block *switchb)
Jeroen Vreeken's avatar
Jeroen Vreeken committed
44
{
45
46
47
48
	struct controller_block_private *priv = switchb->private;
	float in = *priv->in;
	float out;
	bool on = *priv->on;
Jeroen Vreeken's avatar
Jeroen Vreeken committed
49
	
50
51
52
	out = on ? in : 0.0;

	priv->out = out;
Jeroen Vreeken's avatar
Jeroen Vreeken committed
53
54
}

55
56
57
58
59
60
61
62
63
64
static struct controller_block_interm_list interms[] = {
	{ "in", CONTROLLER_BLOCK_TERM_FLOAT, offsetof(struct controller_block_private, in) },
	{ "on", CONTROLLER_BLOCK_TERM_BOOL, offsetof(struct controller_block_private, on) },
	{ NULL }
};

static struct controller_block_outterm_list outterms[] = {
	{ "out", CONTROLLER_BLOCK_TERM_FLOAT, offsetof(struct controller_block_private, out) },
	{ NULL }
};
Jeroen Vreeken's avatar
Jeroen Vreeken committed
65
66
67
68
69

struct controller_block * block_switch_create(char *name)
{
	struct controller_block *switchb;
	
70
	if (!(switchb = controller_block_alloc("switch", name, sizeof(struct controller_block_private))))
Jeroen Vreeken's avatar
Jeroen Vreeken committed
71
72
73
74
		return NULL;

	switchb->private->out = 0.0;
	
75
76
77
78
79
80
	if (controller_block_interm_list_init(switchb, interms))
		goto err_block;

	if (controller_block_outterm_list_init(switchb, outterms))
		goto err_block;

Jeroen Vreeken's avatar
Jeroen Vreeken committed
81
	
82
	switchb->calculate = switch_calculate;
Jeroen Vreeken's avatar
Jeroen Vreeken committed
83
84
85
86
87
88

	switchb->params = 0;

	controller_block_add(switchb);
	return switchb;

89
90
err_block:
	controller_block_free(switchb);
Jeroen Vreeken's avatar
Jeroen Vreeken committed
91
92
	return NULL;
}