logging.c

/*
 *  logging.c
 *  Copyright (C) 2018 Ho Tuan Kiet
 *
 *  This program is free software: you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation, either version 3 of the License, or
 *  (at your option) any later version.
 * 
 *  This program is distributed in the hope that it will be useful,
 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 *  GNU General Public License for more details.
 */

#include "logging.h"

#ifdef DEBUG

void log_init() {
	rcc_periph_clock_enable(RCC_GPIOA);
	rcc_periph_clock_enable(RCC_USART1);

	gpio_mode_setup(GPIOA, GPIO_MODE_AF, GPIO_PUPD_NONE, (GPIO2 | GPIO3));
	gpio_set_af(GPIOA, GPIO_AF1, (GPIO2 | GPIO3));

	usart_disable(USART1);

	usart_set_baudrate(USART1, 912600);
	usart_set_databits(USART1, 8);
	usart_set_flow_control(USART1, USART_FLOWCONTROL_NONE);
	usart_set_mode(USART1, USART_MODE_TX_RX);
	usart_set_parity(USART1, USART_PARITY_NONE);
	usart_set_stopbits(USART1, USART_STOPBITS_1);

	usart_enable(USART1);
}

void LOG(const char fmt[], ...) {
	char log_str[1024];
	int len;

	const char prefix[] = "[ DEBUG ] ";
	for (size_t i = 0; i < strlen(prefix); ++i) {
		usart_send_blocking(USART1, prefix[i]);
	}

	va_list args;
	va_start(args, fmt);
	len = vsnprintf(log_str, sizeof(log_str), fmt, args);
	va_end(args);

	for (int i = 0; i < len; ++i) {
		usart_send_blocking(USART1, log_str[i]);
	}

	usart_send_blocking(USART1, '\n');
}

#endif