Comm/COMM_PACKETS.c at Main · TauraBots/Comm · GitHub

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
#include <Comm/COMM_PACKETS.h>
#include <string.h>


void Comm_Packets_Create_VSSSCommand(comm_packet_t* packet_buffer,
                                     uint8_t seq_num,
                                     const vsss_command_payload_t* cmd_payload)
{
    if (packet_buffer == NULL || cmd_payload == NULL) {
        return;
    }
    memset(packet_buffer, 0, sizeof(comm_packet_t));

    packet_buffer->header.main_type = MAIN_PACKET_TYPE_VSSS_COMMAND;
    packet_buffer->header.seq_number = seq_num;

    memcpy(&packet_buffer->payload_u.vsss_cmd, cmd_payload, sizeof(vsss_command_payload_t));
}

void Comm_Packets_Create_SSLCommand(comm_packet_t* packet_buffer,
                                    uint8_t seq_num,
                                    const ssl_command_payload_t* cmd_payload)
{
    if (packet_buffer == NULL || cmd_payload == NULL) {
        return;
    }
    memset(packet_buffer, 0, sizeof(comm_packet_t));

    packet_buffer->header.main_type = MAIN_PACKET_TYPE_SSL_COMMAND;
    packet_buffer->header.seq_number = seq_num;

    memcpy(&packet_buffer->payload_u.ssl_cmd, cmd_payload, sizeof(ssl_command_payload_t));
}

void Comm_Packets_Create_DebugText(comm_packet_t* packet_buffer,
                                   uint8_t seq_num,
                                   const char* text_payload)
{
    if (packet_buffer == NULL || text_payload == NULL) {
        return;
    }
    memset(packet_buffer, 0, sizeof(comm_packet_t));

    packet_buffer->header.main_type = MAIN_PACKET_TYPE_DEBUG_TEXT;
    packet_buffer->header.seq_number = seq_num;

    strncpy(packet_buffer->payload_u.debug_text.text, text_payload, DEBUG_TEXT_MAX_LEN -1);
    packet_buffer->payload_u.debug_text.text[DEBUG_TEXT_MAX_LEN - 1] = '\0';
}


void Comm_Packets_Create_VSSTelemetry(comm_packet_t* packet_buffer,
                                      uint8_t seq_num,
                                      const vsss_telemetry_payload_t* tel_payload)
{
    if (packet_buffer == NULL || tel_payload == NULL) {
        return;
    }
    memset(packet_buffer, 0, sizeof(comm_packet_t));

    packet_buffer->header.main_type = MAIN_PACKET_TYPE_VSSS_TELEMETRY;
    packet_buffer->header.seq_number = seq_num;

    memcpy(&packet_buffer->payload_u.vsss_tel, tel_payload, sizeof(vsss_telemetry_payload_t));
}

void Comm_Packets_Create_SSLTelemetry(comm_packet_t* packet_buffer,
                                      uint8_t seq_num,
                                      const ssl_telemetry_payload_t* tel_payload)
{
    if (packet_buffer == NULL || tel_payload == NULL) {
        return;
    }
    memset(packet_buffer, 0, sizeof(comm_packet_t));

    packet_buffer->header.main_type = MAIN_PACKET_TYPE_SSL_TELEMETRY;
    packet_buffer->header.seq_number = seq_num;

    memcpy(&packet_buffer->payload_u.ssl_tel, tel_payload, sizeof(ssl_telemetry_payload_t));
}