57 lines
1.3 KiB
C
57 lines
1.3 KiB
C
// Copyright 2019 SoloKeys Developers
|
|
//
|
|
// Licensed under the Apache License, Version 2.0, <LICENSE-APACHE or
|
|
// http://apache.org/licenses/LICENSE-2.0> or the MIT license <LICENSE-MIT or
|
|
// http://opensource.org/licenses/MIT>, at your option. This file may not be
|
|
// copied, modified, or distributed except according to those terms.
|
|
#include "stm32l4xx_ll_usart.h"
|
|
#include "usbd_cdc_if.h"
|
|
|
|
#include APP_CONFIG
|
|
#include "fifo.h"
|
|
|
|
#if DEBUG_LEVEL>0
|
|
|
|
void _putchar(char c)
|
|
{
|
|
#if NON_BLOCK_PRINTING
|
|
fifo_debug_add(&c);
|
|
#else
|
|
while (! LL_USART_IsActiveFlag_TXE(DEBUG_UART))
|
|
;
|
|
LL_USART_TransmitData8(DEBUG_UART,c);
|
|
#endif
|
|
}
|
|
|
|
|
|
int _write (int fd, const void *buf, unsigned long int len)
|
|
{
|
|
uint8_t * data = (uint8_t *) buf;
|
|
#if DEBUG_LEVEL>1
|
|
static uint8_t logbuf[1000] = {0};
|
|
static int logbuflen = 0;
|
|
if (logbuflen + len > sizeof(logbuf)) {
|
|
int mlen = logbuflen + len - sizeof(logbuf);
|
|
memmove(logbuf, &logbuf[mlen], sizeof(logbuf) - mlen);
|
|
logbuflen -= mlen;
|
|
}
|
|
memcpy(&logbuf[logbuflen], data, len);
|
|
logbuflen += len;
|
|
|
|
// Send out USB serial
|
|
uint8_t res = CDC_Transmit_FS(logbuf, logbuflen);
|
|
if (res == USBD_OK)
|
|
logbuflen = 0;
|
|
#endif
|
|
#ifdef ENABLE_SERIAL_PRINTING
|
|
// Send out UART serial
|
|
while(len--)
|
|
{
|
|
_putchar(*data++);
|
|
}
|
|
#endif
|
|
return 0;
|
|
|
|
}
|
|
#endif
|