summaryrefslogtreecommitdiff
path: root/cethcan/can.c
blob: 39da3f11c5516d883586df7ec30915286a13842b (plain)
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
#include "cethcan.h"

static struct can_user *users = NULL, **userlast = &users;

void can_register(struct can_user *user)
{
	user->next = NULL;
	*userlast = user;
	userlast = &user->next;
}

struct can_user *can_register_alloc(void *arg, can_handler handler,
	const char *fmt, ...)
{
	struct can_user *user;
	char *name = NULL;
	va_list ap;

	va_start(ap, fmt);
	vasprintf(&name, fmt, ap);
	va_end(ap);

	user = calloc(sizeof(*user), 1);
	user->arg = arg;
	user->handler = handler;
	user->name = name;

	can_register(user);
	return user;
}

void can_broadcast(struct can_user *origin, struct can_message *msg)
{
	struct can_user *u;
	char buf[3*8+1];

	msg->origin = origin;

	if (msg->dlc > 8) {
		lprintf("invalid CAN message (DLC = %zu)", msg->dlc);
		return;
	}
	if (verbosity >= 1) {
		for (size_t i = 0; i < msg->dlc; i++)
			sprintf(buf + 3 * i, " %02x", msg->bytes[i]);
		lprintf("%s: %08x (%zu)%s", origin->name,
			(unsigned)msg->daddr, msg->dlc, buf);
	}

	for (u = users; u; u = u->next)
		if (u != origin)
			u->handler(u->arg, msg);
}

void can_json(json_t *json, enum json_subtype type)
{
	struct can_user *u;
	for (u = users; u; u = u->next)
		if (u->json)
			u->json(u->arg, json, type);
}

void can_init(void)
{
	/* nothing to do */
}