aboutsummaryrefslogtreecommitdiff
path: root/shared/protocol.c
blob: fcc0f4123177e79305d36585b821bb632a7e8672 (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
#include <stddef.h>

#include "protocol.h"

#ifdef __cplusplus
extern "C" {
#endif

cd_cmd_id_t  g_cd_protocol_fresh_message_id = 0;

size_t cd_cmd_sizeof(uint8_t data[CD_SERIAL_READ_BUFFER_SIZE], uint8_t data_length) {
	cd_cmd_opcode_t opcode = data[0];
	if (CD_CMD_HANDLERS_SIZE[opcode] > 0) return CD_CMD_HANDLERS_SIZE[opcode];

	cd_s_bin *copy = cd_bin_s_alloc(data_length, data);
	size_t length = (*CD_CMD_HANDLERS_SIZEOF[opcode])(copy);

	free(copy);

	return length;
}

/**
 * @brief macro to calculate size of message based on struct with member to
 * indicate length of dynamic (last) field
 *
 * @param data  cd_s_bin pointer to currently received data
 * @param struct_t  message struct
 * @param length_field  struct field with dynamic length
 *
 * @return size_t with calculated size
 *
 * equivalent c code:
 *
 * size_t size = sizeof(struct_t);
 * size_t dyn_member_offset = offsetof(struct_t, length_field);
 * size_t dyn_member_size = sizeof(((struct_t*)0)->length_field);
 * if (data->bytes >= (dyn_member_offset + dyn_member_size))
 *     size += cd_bin_ntohd(&data->data[dyn_member_offset], dyn_member_size);
 * return size;
 */
#define CD_DYN_MEMBER_SIZEOF(data, struct_t, length_field) \
	sizeof(struct_t) + ( \
	(data->bytes >= (offsetof(struct_t, length_field) + sizeof(((struct_t*)0)->length_field))) ? \
		(cd_bin_ntohd(&data->data[offsetof(struct_t, length_field)], sizeof(((struct_t*)0)->length_field))) :\
		0);

size_t cd_cmd_response_sizeof(cd_s_bin* data) {
	return CD_DYN_MEMBER_SIZEOF(data, cd_s_cmd_response, response_size);
}

cd_cmd_id_t cd_protocol_fresh_message_id() {
	return g_cd_protocol_fresh_message_id++;
}

#ifdef __cplusplus
}
#endif