/**
 * @file telemetry.c
 * @brief Telemetry-frame creation, checksum finalisation, and serialisation.
 */

#include "telemetry.h"

#include <string.h>

#include "app_uart_protocol.h"

void telemetry_reset(telemetry_frame_t *frame)
{
    if (frame == NULL)
    {
        return;
    }

    memset(frame->words, 0, sizeof(frame->words));
    frame->words[0] = APP_PACKET_HEADER_WORK_CONFIG;
}

void telemetry_set_message_id(telemetry_frame_t *frame, uint16_t message_id)
{
    if (frame != NULL)
    {
        frame->words[13] = message_id;
    }
}

void telemetry_set_live_data(telemetry_frame_t *frame,
                             uint16_t laser1_power,
                             uint16_t laser2_power,
                             uint32_t tick_10ms,
                             uint16_t laser1_temperature,
                             uint16_t laser2_temperature,
                             uint16_t adc_slot_7,
                             uint16_t adc_slot_8,
                             uint16_t adc_slot_9,
                             uint16_t adc_slot_10,
                             uint16_t adc_slot_11,
                             uint16_t adc_slot_12)
{
    if (frame == NULL)
    {
        return;
    }

    frame->words[1] = laser1_power;
    frame->words[2] = laser2_power;
    frame->words[3] = (uint16_t)(tick_10ms & 0xFFFFu);
    frame->words[4] = (uint16_t)((tick_10ms >> 16) & 0xFFFFu);
    frame->words[5] = laser1_temperature;
    frame->words[6] = laser2_temperature;
    frame->words[7] = adc_slot_7;
    frame->words[8] = adc_slot_8;
    frame->words[9] = adc_slot_9;
    frame->words[10] = adc_slot_10;
    frame->words[11] = adc_slot_11;
    frame->words[12] = adc_slot_12;
}

void telemetry_finalize(telemetry_frame_t *frame)
{
    if (frame == NULL)
    {
        return;
    }

    frame->words[14] = app_protocol_calculate_checksum(&frame->words[1], 13u);
}

void telemetry_to_bytes(const telemetry_frame_t *frame, uint8_t *out_bytes)
{
    uint8_t index;

    if ((frame == NULL) || (out_bytes == NULL))
    {
        return;
    }

    for (index = 0u; index < APP_TELEMETRY_WORD_COUNT; ++index)
    {
        out_bytes[index * 2u] = (uint8_t)(frame->words[index] & 0x00FFu);
        out_bytes[(index * 2u) + 1u] = (uint8_t)((frame->words[index] >> 8) & 0x00FFu);
    }
}