File: sig_mdi.c

package info (click to toggle)
faumachine 20180503-4
  • links: PTS
  • area: main
  • in suites: bullseye, sid
  • size: 61,272 kB
  • sloc: ansic: 272,290; makefile: 6,199; asm: 4,251; sh: 3,022; perl: 886; xml: 563; pascal: 311; lex: 214; vhdl: 204
file content (146 lines) | stat: -rw-r--r-- 2,331 bytes parent folder | download
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
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
/*
 * Copyright (C) 2013 FAUmachine Team <info@faumachine.org>.
 * This program is free software. You can redistribute it and/or modify it
 * under the terms of the GNU General Public License, either version 2 of
 * the License, or (at your option) any later version. See COPYING.
 */

#include "config.h"

#include <assert.h>
#include <stdio.h>

#include "glue.h"

#include "sig_mdi.h"

void
sig_mdi_read(
	struct sig_mdi *b,
	void *s,
	unsigned int reg,
	uint16_t *valp
)
{
	unsigned int nr;
	void (*func)(void *, unsigned int, uint16_t *);

	for (nr = 0; ; nr++) {
		if (nr == b->nmembers) {
			*valp = 0xffff;
			return;
		}
		if (b->member[nr].s == s) {
			continue;
		}
		func = b->member[nr].f->read;
		assert(func);
		func(b->member[nr].s, reg, valp);
		return;
	}
}

void
sig_mdi_write(
	struct sig_mdi *b,
	void *s,
	unsigned int reg,
	uint16_t val
)
{
	unsigned int nr;
	void (*func)(void *, unsigned int, uint16_t);

	for (nr = 0; ; nr++) {
		if (nr == b->nmembers) {
			return;
		}
		if (b->member[nr].s == s) {
			continue;
		}
		func = b->member[nr].f->write;
		assert(func);
		func(b->member[nr].s, reg, val);
		return;
	}
}

void
sig_mdi_send(
	struct sig_mdi *b,
	void *s,
	const void *buf,
	unsigned int buflen
)
{
	unsigned int nr;
	void (*func)(void *, const void *, unsigned int);

	for (nr = 0; ; nr++) {
		if (nr == b->nmembers) {
			return;
		}
		if (b->member[nr].s == s) {
			continue;
		}
		func = b->member[nr].f->recv;
		assert(func);
		func(b->member[nr].s, buf, buflen);
		return;
	}
}

void
sig_mdi_connect(
	struct sig_mdi *b,
	void *s,
	const struct sig_mdi_funcs *f
)
{
	assert(b);
	assert(b->type == SIG_GEN_MDI);
	assert(b->nmembers < sizeof(b->member) / sizeof(b->member[0]));

	b->member[b->nmembers].s = s;
	b->member[b->nmembers].f = f;
	b->nmembers++;
}

struct sig_mdi *
sig_mdi_create(const char *name)
{
	struct sig_mdi *bus;

	bus = shm_alloc(sizeof(*bus));
	assert(bus);

	bus->type = SIG_GEN_MDI;
	bus->nmembers = 0;

	return bus;
}

void
sig_mdi_destroy(struct sig_mdi *bus)
{
	assert(bus);
	assert(bus->type == SIG_GEN_MDI);

	shm_free(bus);
}

void
sig_mdi_suspend(struct sig_mdi *b, FILE *fSig)
{
	size_t size = sizeof(*b);
	
	generic_suspend(b, size, fSig);
}

void
sig_mdi_resume(struct sig_mdi *b, FILE *fSig)
{
	size_t size = sizeof(*b);
	
	generic_resume(b, size, fSig);
}