| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285 |
- /*
- * Copyright (c) 2021-2024 HPMicro
- *
- * SPDX-License-Identifier: BSD-3-Clause
- *
- */
- #ifndef __ICCRISCV__
- #include <sys/stat.h>
- #endif
- #include "hpm_debug_console.h"
- #if !defined(CONFIG_NDEBUG_CONSOLE) || !CONFIG_NDEBUG_CONSOLE
- #include "hpm_uart_drv.h"
- static UART_Type* g_console_uart = NULL;
- hpm_stat_t console_init(console_config_t *cfg)
- {
- hpm_stat_t stat = status_fail;
- if (cfg->type == CONSOLE_TYPE_UART) {
- uart_config_t config = {0};
- uart_default_config((UART_Type *)cfg->base, &config);
- config.src_freq_in_hz = cfg->src_freq_in_hz;
- config.baudrate = cfg->baudrate;
- stat = uart_init((UART_Type *)cfg->base, &config);
- if (status_success == stat) {
- g_console_uart = (UART_Type *)cfg->base;
- }
- }
- return stat;
- }
- uint8_t console_receive_byte(void)
- {
- uint8_t c;
- while (status_success != uart_receive_byte(g_console_uart, &c)) {
- };
- return c;
- }
- uint8_t console_try_receive_byte(void)
- {
- uint8_t c = 0;
- uart_try_receive_byte(g_console_uart, &c);
- return c;
- }
- void console_send_byte(uint8_t c)
- {
- while (status_success != uart_send_byte(g_console_uart, c)) {
- }
- }
- #ifdef __SEGGER_RTL_VERSION
- #include <stdio.h>
- #include "__SEGGER_RTL_Int.h"
- static int _stdin_ungot = EOF;
- struct __SEGGER_RTL_FILE_impl { /* NOTE: Provides implementation for FILE */
- int stub; /* only needed so impl has size != 0. */
- };
- static FILE __SEGGER_RTL_stdin_file = { 0 }; /* stdin reads from UART */
- static FILE __SEGGER_RTL_stdout_file = { 0 }; /* stdout writes to UART */
- static FILE __SEGGER_RTL_stderr_file = { 0 }; /* stderr writes to UART */
- __attribute__((used)) FILE *stdin = &__SEGGER_RTL_stdin_file; /* NOTE: Provide implementation of stdin for RTL. */
- __attribute__((used)) FILE *stdout = &__SEGGER_RTL_stdout_file; /* NOTE: Provide implementation of stdout for RTL. */
- __attribute__((used)) FILE *stderr = &__SEGGER_RTL_stderr_file; /* NOTE: Provide implementation of stderr for RTL. */
- __attribute__((used)) int __SEGGER_RTL_X_file_write(__SEGGER_RTL_FILE *file, const char *data, unsigned int size)
- {
- unsigned int count;
- (void)file;
- for (count = 0; count < size; count++) {
- if (data[count] == '\n') {
- while (status_success != uart_send_byte(g_console_uart, '\r')) {
- }
- }
- while (status_success != uart_send_byte(g_console_uart, data[count])) {
- }
- }
- while (status_success != uart_flush(g_console_uart)) {
- }
- return count;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_read(__SEGGER_RTL_FILE *file, char *s, unsigned int size)
- {
- (void)file;
- (void) size;
- while (status_success != uart_receive_byte(g_console_uart, (uint8_t *)s)) {
- }
- return 1;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_stat(__SEGGER_RTL_FILE *stream)
- {
- (void) stream;
- return 0;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_bufsize(__SEGGER_RTL_FILE *stream)
- {
- (void) stream;
- return 1;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_unget(__SEGGER_RTL_FILE *stream, int c)
- {
- if (stream == stdin) {
- if (c != EOF && _stdin_ungot == EOF) {
- _stdin_ungot = c;
- } else {
- c = EOF;
- }
- } else {
- c = EOF;
- }
- return c;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_flush(__SEGGER_RTL_FILE *__stream)
- {
- (void) __stream;
- return 1;
- }
- #endif
- int _write(int file, char *data, int size)
- {
- int count;
- (void)file;
- for (count = 0; count < size; count++) {
- if (data[count] == '\n') {
- while (status_success != uart_send_byte(g_console_uart, '\r')) {
- }
- }
- while (status_success != uart_send_byte(g_console_uart, data[count])) {
- }
- }
- while (status_success != uart_flush(g_console_uart)) {
- }
- return count;
- }
- int _read(int file, char *s, int size)
- {
- (void)file;
- (void) size;
- while (status_success != uart_receive_byte(g_console_uart, (uint8_t *)s)) {
- }
- return 1;
- }
- #else
- /* stub functions */
- hpm_stat_t console_init(console_config_t *cfg)
- {
- (void) cfg;
- return status_success;
- }
- uint8_t console_receive_byte(void)
- {
- return 0xFF;
- }
- uint8_t console_try_receive_byte(void)
- {
- uint8_t c = 0;
- return c;
- }
- void console_send_byte(uint8_t c)
- {
- (void) c;
- }
- #ifdef __SEGGER_RTL_VERSION
- #include <stdio.h>
- #include "__SEGGER_RTL_Int.h"
- struct __SEGGER_RTL_FILE_impl { /* NOTE: Provides implementation for FILE */
- int stub; /* only needed so impl has size != 0. */
- };
- static FILE __SEGGER_RTL_stdin_file = { 0 }; /* stdin reads from UART */
- static FILE __SEGGER_RTL_stdout_file = { 0 }; /* stdout writes to UART */
- static FILE __SEGGER_RTL_stderr_file = { 0 }; /* stderr writes to UART */
- __attribute__((used)) FILE *stdin = &__SEGGER_RTL_stdin_file; /* NOTE: Provide implementation of stdin for RTL. */
- __attribute__((used)) FILE *stdout = &__SEGGER_RTL_stdout_file; /* NOTE: Provide implementation of stdout for RTL. */
- __attribute__((used)) FILE *stderr = &__SEGGER_RTL_stderr_file; /* NOTE: Provide implementation of stderr for RTL. */
- __attribute__((used)) int __SEGGER_RTL_X_file_write(__SEGGER_RTL_FILE *file, const char *data, unsigned int size)
- {
- (void) file;
- (void) data;
- return size;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_read(__SEGGER_RTL_FILE *file, char *s, unsigned int size)
- {
- (void) file;
- (void) size;
- (void) s;
- return 1;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_stat(__SEGGER_RTL_FILE *stream)
- {
- (void) stream;
- return 0;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_bufsize(__SEGGER_RTL_FILE *stream)
- {
- (void) stream;
- return 1;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_unget(__SEGGER_RTL_FILE *stream, int c)
- {
- (void) stream;
- (void) c;
- return EOF;
- }
- __attribute__((used)) int __SEGGER_RTL_X_file_flush(__SEGGER_RTL_FILE *__stream)
- {
- (void) __stream;
- return 1;
- }
- #endif
- ATTR_WEAK int _write(int file, char *data, int size)
- {
- (void) file;
- (void) data;
- return size;
- }
- ATTR_WEAK int _read(int file, char *s, int size)
- {
- (void) file;
- (void) size;
- (void) s;
- return 1;
- }
- #endif
- #ifndef __ICCRISCV__
- int _fstat(int file, struct stat *s)
- {
- (void) file;
- s->st_mode = S_IFCHR;
- return 0;
- }
- #else
- #ifndef _DLIB_FILE_DESCRIPTOR
- #define _DLIB_FILE_DESCRIPTOR 0
- #endif
- int __write(int file, char *data, int size)
- {
- return _write(file, data, size);
- }
- int __read(int file, char *s, int size)
- {
- return _read(file, s, size);
- }
- #endif
|