57 lines
1.3 KiB
C++
57 lines
1.3 KiB
C++
// 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);
|
|
}
|
|
}
|