// main.cpp

#include "mbed.h"

#define TARGET_TX_PIN USBTX
#define TARGET_RX_PIN USBRX
#define BAUD_RATE 9600

static BufferedSerial serial_port(TARGET_TX_PIN, TARGET_RX_PIN, BAUD_RATE);

FileHandle *mbed::mbed_override_console(int fd)
{
    return &serial_port;
}

DigitalOut led(LED1);

#define BUFFER_SIZE 64
static char rx_buffer[BUFFER_SIZE];

int main(void)
{
    serial_port.set_format(8, BufferedSerial::None, 1);

    printf("Baud: %d, Format: 8-N-1\r\n", BAUD_RATE);
    while (true) {
        if (serial_port.readable()) {
            memset(rx_buffer, 0, sizeof(rx_buffer));
            ssize_t num = serial_port.read(rx_buffer, sizeof(rx_buffer) - 1);

            if (num > 0) {
                led = !led;

                serial_port.write(rx_buffer, num);

                printf("[RX] %s\r\n", rx_buffer);
            }
        }

        ThisThread::sleep_for(10ms);
    }
}