ardupilot/libraries/AP_HAL_AVR_SITL/Console.cpp

107 lines
2.2 KiB
C++
Raw Normal View History

/// -*- tab-width: 4; Mode: C++; c-basic-offset: 4; indent-tabs-mode: nil -*-
#include <AP_HAL.h>
#if CONFIG_HAL_BOARD == HAL_BOARD_AVR_SITL
#include <limits.h>
#include <stdarg.h>
#include "Console.h"
#include "print_vprintf.h"
using namespace AVR_SITL;
SITLConsoleDriver::SITLConsoleDriver() {}
// ConsoleDriver method implementations ///////////////////////////////////////
void SITLConsoleDriver::init(void* base_uart)
{
_base_uart = (AP_HAL::UARTDriver*) base_uart;
}
void SITLConsoleDriver::backend_open()
{
}
void SITLConsoleDriver::backend_close()
{
}
size_t SITLConsoleDriver::backend_read(uint8_t *data, size_t len)
{
return 0;
}
size_t SITLConsoleDriver::backend_write(const uint8_t *data, size_t len)
{
return 0;
}
// SITLConsoleDriver private method implementations ////////////////////////////
// BetterStream method implementations /////////////////////////////////////////
void SITLConsoleDriver::print_P(const prog_char_t *s)
{
char c;
while ('\0' != (c = pgm_read_byte((const prog_char *)s++)))
write(c);
}
void SITLConsoleDriver::println_P(const prog_char_t *s)
{
print_P(s);
println();
}
void SITLConsoleDriver::printf(const char *fmt, ...)
{
va_list ap;
va_start(ap, fmt);
vprintf(fmt, ap);
va_end(ap);
}
void SITLConsoleDriver::vprintf(const char *fmt, va_list ap)
{
print_vprintf((AP_HAL::Print*)this, 0, fmt, ap);
}
void SITLConsoleDriver::_printf_P(const prog_char *fmt, ...)
{
va_list ap;
va_start(ap, fmt);
vprintf_P(fmt, ap);
va_end(ap);
}
void SITLConsoleDriver::vprintf_P(const prog_char *fmt, va_list ap)
{
print_vprintf((AP_HAL::Print*)this, 1, fmt, ap);
}
// Stream method implementations /////////////////////////////////////////
int16_t SITLConsoleDriver::available(void)
{
return _base_uart->available();
}
int16_t SITLConsoleDriver::txspace(void)
{
return _base_uart->txspace();
}
int16_t SITLConsoleDriver::read()
{
return _base_uart->read();
}
// Print method implementations /////////////////////////////////////////
size_t SITLConsoleDriver::write(uint8_t c)
{
return _base_uart->write(c);
}
#endif