// 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];

void print_ascii_mask(uint32_t mask)
{
    for (int byte = 3; byte >= 0; byte--) {   // High byte first
        uint8_t b = (mask >> (byte * 8)) & 0xFF;
        for (int i = 7; i >= 0; i--) {
            printf("%c", (b & (1 << i)) ? '#' : '.');  // '#' for 1, '.' for 0
        }
        printf("\r\n");
    }
    printf("\r\n");
}

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);
                uint32_t mask = 0xF0F0A55A;
                print_ascii_mask(mask);
            }
        }

        ThisThread::sleep_for(10ms);
    }
}