//
// Created by MightyPork on 2017/11/21.
//
// TinyFrame integration
//

#include "platform.h"
#include "task_main.h"

#include "utils/hexdump.h"
#include "USB/usbd_cdc_if.h"
#include "TinyFrame.h"

extern osSemaphoreId semVcomTxReadyHandle;
extern osMutexId mutTinyFrameTxHandle;

void TF_WriteImpl(TinyFrame *tf, const uint8_t *buff, size_t len)
{
    (void) tf;
#define CHUNK 64 // same as TF_SENDBUF_LEN, so we should always have only one run of the loop
    int32_t total = (int32_t) len;
    while (total > 0) {
        assert_param(osOK == osSemaphoreWait(semVcomTxReadyHandle, 5000));
        uint16_t chunksize = (uint16_t) MIN(total, CHUNK);
        assert_param(USBD_OK == CDC_Transmit_FS((uint8_t *) buff, chunksize));

        PUTS("Tx: ");
        for(int i=0;i<chunksize; i++) {
            PRINTF("%02X ", buff[i]);
        }
        PUTS("\r\n");

        buff += chunksize;
        total -= chunksize;
    }
}

/** Claim the TX interface before composing and sending a frame */
void TF_ClaimTx(TinyFrame *tf)
{
    (void) tf;
    assert_param(osThreadGetId() != tskMainHandle);
    assert_param(!inIRQ());

    assert_param(osOK == osMutexWait(mutTinyFrameTxHandle, 5000));
}

/** Free the TX interface after composing and sending a frame */
void TF_ReleaseTx(TinyFrame *tf)
{
    (void) tf;
    assert_param(osOK == osMutexRelease(mutTinyFrameTxHandle));
}