56 lines
1.5 KiB
C
56 lines
1.5 KiB
C
#include "stm32f1xx_hal.h"
|
|
#include "defines.h"
|
|
#include "setup.h"
|
|
#include "config.h"
|
|
#include "stdio.h"
|
|
#include "string.h"
|
|
|
|
UART_HandleTypeDef huart2;
|
|
|
|
volatile uint8_t uart_buf[300];
|
|
volatile int16_t ch_buf[8];
|
|
//volatile char char_buf[300];
|
|
|
|
void setScopeChannel(uint8_t ch, int16_t val) {
|
|
ch_buf[ch] = val;
|
|
}
|
|
|
|
void consoleScope() {
|
|
#ifdef DEBUG_SERIAL_SERVOTERM
|
|
uart_buf[0] = 0xff;
|
|
uart_buf[1] = CLAMP(ch_buf[0]+127, 0, 255);
|
|
uart_buf[2] = CLAMP(ch_buf[1]+127, 0, 255);
|
|
uart_buf[3] = CLAMP(ch_buf[2]+127, 0, 255);
|
|
uart_buf[4] = CLAMP(ch_buf[3]+127, 0, 255);
|
|
uart_buf[5] = CLAMP(ch_buf[4]+127, 0, 255);
|
|
uart_buf[6] = CLAMP(ch_buf[5]+127, 0, 255);
|
|
uart_buf[7] = CLAMP(ch_buf[6]+127, 0, 255);
|
|
uart_buf[8] = CLAMP(ch_buf[7]+127, 0, 255);
|
|
uart_buf[9] = '\n';
|
|
|
|
if(DMA1_Channel2->CNDTR == 0) {
|
|
DMA1_Channel2->CCR &= ~DMA_CCR_EN;
|
|
DMA1_Channel2->CNDTR = 10;
|
|
DMA1_Channel2->CMAR = (uint32_t)uart_buf;
|
|
DMA1_Channel2->CCR |= DMA_CCR_EN;
|
|
}
|
|
#endif
|
|
|
|
#ifdef DEBUG_SERIAL_ASCII
|
|
memset(&uart_buf, 0, sizeof(uart_buf));
|
|
sprintf(uart_buf, "%i;%i;%i;%i;%i;%i;%i;%i\n\r", ch_buf[0], ch_buf[1], ch_buf[2], ch_buf[3], ch_buf[4], ch_buf[5], ch_buf[6], ch_buf[7]);
|
|
|
|
if(DMA1_Channel2->CNDTR == 0) {
|
|
DMA1_Channel2->CCR &= ~DMA_CCR_EN;
|
|
DMA1_Channel2->CNDTR = strlen(uart_buf);
|
|
DMA1_Channel2->CMAR = (uint32_t)uart_buf;
|
|
DMA1_Channel2->CCR |= DMA_CCR_EN;
|
|
}
|
|
#endif
|
|
}
|
|
|
|
void consoleLog(char *message)
|
|
{
|
|
HAL_UART_Transmit_DMA(&huart2, (uint8_t *)message, strlen(message));
|
|
}
|