Files
epd42/components/libraries/console/console.c
Shuanglei Tao f353d23368 Initial commit
2024-11-11 15:35:36 +08:00

505 lines
13 KiB
C

/* Copyright (c) 2007 Nordic Semiconductor. All Rights Reserved.
*
* The information contained herein is property of Nordic Semiconductor ASA.
* Terms and conditions of usage are described in detail in NORDIC
* SEMICONDUCTOR STANDARD SOFTWARE LICENSE AGREEMENT.
*
* Licensees are granted free, non-transferable use of the information. NO
* WARRANTY of ANY KIND is provided. This heading must NOT be removed from
* the file.
*
*/
/** \file
*
* Implementation of console.h.
*
*/
#include "console.h"
#include "uart_legacy.h"
static const uint8_t newline_input[] = CONSOLE_NEWLINE_INPUT; /*!< Needed to compare input against to find end of line */
#define NEWLINE_INPUT_LEN (sizeof CONSOLE_NEWLINE_INPUT - 1) /*!< Subtract one for the zero termination */
static const char hex_tab[] = "0123456789ABCDEF"; /*!< Table of ASCII hexadecimal digits */
// static uint8_t m_IEN_status; // not referenced
/** Console init
*/
static enum
{
CONSOLE_UNINIT = 0,
CONSOLE_AVAILABLE
} m_console = CONSOLE_UNINIT;
void console_init(void)
{
hal_uart_init(UART_BAUD_19K2);
m_console = CONSOLE_AVAILABLE;
}
bool console_available(void)
{
if ( m_console == CONSOLE_AVAILABLE )
{
return (true);
}
else
{
return (false);
}
}
void console_put_string(uint8_t const * string)
{
if ( m_console == CONSOLE_AVAILABLE )
{
while (*string != 0)
{
hal_uart_putchar(*string++);
}
}
}
void console_put_line(uint8_t const * string)
{
if ( m_console == CONSOLE_AVAILABLE )
{
while (*string != 0)
{
hal_uart_putchar(*string++);
}
console_put_string((uint8_t *)CONSOLE_NEWLINE_OUTPUT);
}
}
void console_put_newline(void)
{
if ( m_console == CONSOLE_AVAILABLE )
{
console_put_string((uint8_t *)CONSOLE_NEWLINE_OUTPUT);
}
}
void console_put_chars(uint8_t const * chars, uint8_t num_chars)
{
if ( m_console == CONSOLE_AVAILABLE )
{
for ( ; num_chars > 0; num_chars--)
{
hal_uart_putchar(*chars++);
}
}
}
void console_get_string(uint8_t * string, uint8_t num_chars)
{
if ( m_console == CONSOLE_AVAILABLE )
{
for ( ; num_chars > 0; num_chars--)
{
*string++ = hal_uart_getchar();
#ifdef CONSOLE_ENABLE_ECHO
hal_uart_putchar(*(string-1));
#endif
}
*string = 0; /* Add zero terminator */
}
}
void console_get_line(uint8_t * string, uint8_t max_len)
{
uint8_t c, k, m;
if ( m_console == CONSOLE_AVAILABLE )
{
c = '\0';
for ( k = 0; k < max_len - 1 ; k++ )
{
c = hal_uart_getchar();
if (c == newline_input[0])
{
break;
}
string[k] = c;
#ifdef CONSOLE_ENABLE_ECHO
hal_uart_putchar(c);
#endif
}
string[k] = 0;
/* Read (and discard) also rest of newline sequence if we found the start of if */
/* This is were we may discard characters we should not, se the comments in the header file. */
/* NOTE: We really should check what we read, and notify the caller if it is not really the newline sequence. */
if ( c == newline_input[0] )
{
for( m = 0; m < NEWLINE_INPUT_LEN - 1; m++) /* We have already read the first character */
{
c = hal_uart_getchar();
}
#ifdef CONSOLE_ENABLE_ECHO
/* We have read a newline, and since echo is enabled, we should also echo back a newline. */
/* But this should be the output newline, which may differ from the input newline we read. */
console_put_string((uint8_t *)CONSOLE_NEWLINE_OUTPUT
#endif
}
}
} //lint !e438 Last value assigned to 'c' not used
bool console_chars_available(void)
{
return(hal_uart_chars_available());
}
void console_get_chars(uint8_t * chars, uint8_t num_chars)
{
if ( m_console == CONSOLE_AVAILABLE )
{
for ( ; num_chars > 0; num_chars--)
{
*chars++ = hal_uart_getchar();
#ifdef CONSOLE_ENABLE_ECHO
hal_uart_putchar(*(chars-1));
#endif
}
}
}
void console_put_char(uint8_t ch)
{
if ( m_console == CONSOLE_AVAILABLE )
{
hal_uart_putchar(ch);
}
}
uint8_t console_get_char(void)
{
uint8_t ch = '\0';
if ( m_console == CONSOLE_AVAILABLE )
{
ch = hal_uart_getchar();
#ifdef CONSOLE_ENABLE_ECHO
hal_uart_putchar(ch);
#endif
}
return ch;
}
void console_put_decbyte(uint8_t b) // b is in the range [0 255]
{
uint8_t b0;
uint8_t b1;
if ( m_console == CONSOLE_AVAILABLE )
{
b0 = (b % 10); // Remainder of b when divided by 10
b /= 10; // forces w into the range [0 25]
b1 = (b % 10); // Remainder of b when divided by 10
b /= 10; // forces w into the range [0 2]
if (b != 0)
{
hal_uart_putchar(b + '0');
hal_uart_putchar(b1 + '0');
hal_uart_putchar(b0 + '0');
}
else if (b1 != 0)
{
hal_uart_putchar(b1 + '0');
hal_uart_putchar(b0 + '0');
}
else
{
hal_uart_putchar(b0 + '0');
}
}
}
void console_put_decword(uint16_t w) // w is in the range [0 65535]
{
uint8_t w0;
uint8_t w1;
uint8_t w2;
uint8_t w3;
if ( m_console == CONSOLE_AVAILABLE )
{
w0 = (w % 10); // Remainder of w when divided by 10
w /= 10; // forces w into the range [0 6553]
w1 = (w % 10); // Remainder of w when divided by 10
w /= 10; // forces w into the range [0 655]
w2 = (w % 10); // Remainder of w when divided by 10
w /= 10; // forces w into the range [0 65]
w3 = (w % 10); // Remainder of w when divided by 10
w /= 10; // forces w into the range [0 6]
if (w != 0)
{
hal_uart_putchar((uint8_t)w + '0'); /* We may safely cast w to the smaller type, as we have */
/* made sure (above) that its value will fit. */
hal_uart_putchar(w3 + '0');
hal_uart_putchar(w2 + '0');
hal_uart_putchar(w1 + '0');
hal_uart_putchar(w0 + '0');
}
else if (w3 != 0)
{
hal_uart_putchar(w3 + '0');
hal_uart_putchar(w2 + '0');
hal_uart_putchar(w1 + '0');
hal_uart_putchar(w0 + '0');
}
else if (w2 != 0)
{
hal_uart_putchar(w2 + '0');
hal_uart_putchar(w1 + '0');
hal_uart_putchar(w0 + '0');
}
else if (w1 != 0)
{
hal_uart_putchar(w1 + '0');
hal_uart_putchar(w0 + '0');
}
else
{
hal_uart_putchar(w0 + '0');
}
}
}
void console_put_dec32bit(uint32_t ww) // ww is in the range [0 4294967295]
{
uint8_t ww0;
uint8_t ww1;
uint8_t ww2;
uint8_t ww3;
uint8_t ww4;
uint8_t ww5;
uint8_t ww6;
uint8_t ww7;
uint8_t ww8;
if ( m_console == CONSOLE_AVAILABLE )
{
ww0 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 429496729]
ww1 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 42949672]
ww2 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 4294967]
ww3 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 429496]
ww4 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 42949]
ww5 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 4294]
ww6 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 429]
ww7 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 42]
ww8 = (ww % 10); // Remainder of ww when divided by 10
ww /= 10; // forces ww into the range [0 4]
if (ww != 0)
{
hal_uart_putchar((uint8_t)ww + '0'); /* We may safely cast ww to the smaller type, as we have */
/* made sure (above) that its value will fit. */
hal_uart_putchar(ww8 + '0');
hal_uart_putchar(ww7 + '0');
hal_uart_putchar(ww6 + '0');
hal_uart_putchar(ww5 + '0');
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww8 != 0)
{
hal_uart_putchar(ww8 + '0');
hal_uart_putchar(ww7 + '0');
hal_uart_putchar(ww6 + '0');
hal_uart_putchar(ww5 + '0');
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww7 != 0)
{
hal_uart_putchar(ww7 + '0');
hal_uart_putchar(ww6 + '0');
hal_uart_putchar(ww5 + '0');
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww6 != 0)
{
hal_uart_putchar(ww6 + '0');
hal_uart_putchar(ww5 + '0');
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww5 != 0)
{
hal_uart_putchar(ww5 + '0');
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww4 != 0)
{
hal_uart_putchar(ww4 + '0');
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww3 != 0)
{
hal_uart_putchar(ww3 + '0');
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww2 != 0)
{
hal_uart_putchar(ww2 + '0');
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else if (ww1 != 0)
{
hal_uart_putchar(ww1 + '0');
hal_uart_putchar(ww0 + '0');
}
else
{
hal_uart_putchar(ww0 + '0');
}
}
}
void console_put_hexnybble(uint8_t n)
{
if ( m_console == CONSOLE_AVAILABLE )
{
hal_uart_putchar((uint8_t)hex_tab[n & 0x0f]);
}
}
void console_put_hexbyte(uint8_t b)
{
console_put_hexnybble(b >> 4);
console_put_hexnybble(b & 0x0f);
}
void console_put_hexword(uint16_t w)
{
console_put_hexbyte((uint8_t)(w >> 8));
console_put_hexbyte(w & 0xff);
}
void console_put_hexbytearray(uint8_t * p, uint8_t n)
{
uint8_t i;
if (n > 0)
{
console_put_hexbyte(p[0]);
}
for (i = 1; i < n; ++i)
{
console_put_string((uint8_t *)"-");
console_put_hexbyte(p[i]);
}
}
uint8_t console_get_hexnybble(void)
{
uint8_t c;
if ( m_console == CONSOLE_AVAILABLE )
{
c = hal_uart_getchar();
#ifdef CONSOLE_ENABLE_ECHO
hal_uart_putchar(c);
#endif
if (c >= '0' && c <= '9')
{
return c - '0';
}
else if (c >= 'a' && c <= 'f')
{
return (c - 'a') + 10;
}
else if (c >= 'A' && c <= 'F')
{
return (c - 'A') + 10;
}
else
{
/** @note We have encountered something that is not a hexadecimal digit.
* This is an error, and it is not reported. An ASSERT(false) would be suitable here. */
return 0;
}
return 0; // @note This may not be the correct value, what should be returned if m_console != CONSOLE_AVAILABLE ?
}
uint8_t console_get_hexbyte(void)
{
uint8_t nh = console_get_hexnybble();
return (uint8_t)((nh << 4) | console_get_hexnybble());
}
uint16_t console_get_hexword(void)
{
uint16_t bh = console_get_hexbyte();
return (bh << 8) | console_get_hexbyte();
}
/*
bool console_tx_completed(void)
{
return hal_uart_tx_buf_empty();
}
*/