ardupilot/libraries/AP_HAL_PX4/Console.cpp

83 lines
1.5 KiB
C++
Raw Normal View History

#include <AP_HAL.h>
#if CONFIG_HAL_BOARD == HAL_BOARD_PX4
#include <stdarg.h>
#include "Console.h"
#include "UARTDriver.h"
#include <stdio.h>
using namespace PX4;
PX4ConsoleDriver::PX4ConsoleDriver() {}
void PX4ConsoleDriver::init(void* uart)
{
_uart = (PX4UARTDriver *)uart;
}
void PX4ConsoleDriver::backend_open()
{}
void PX4ConsoleDriver::backend_close()
{}
size_t PX4ConsoleDriver::backend_read(uint8_t *data, size_t len) {
return 0;
}
size_t PX4ConsoleDriver::backend_write(const uint8_t *data, size_t len) {
return 0;
}
void PX4ConsoleDriver::print_P(const prog_char_t *pstr) {
print(pstr);
}
void PX4ConsoleDriver::println_P(const prog_char_t *pstr) {
println(pstr);
}
void PX4ConsoleDriver::printf(const char *fmt, ...) {
va_list ap;
va_start(ap, fmt);
_uart->vprintf(fmt, ap);
va_end(ap);
}
void PX4ConsoleDriver::_printf_P(const prog_char *fmt, ...) {
va_list ap;
va_start(ap, fmt);
_uart->vprintf(fmt, ap);
va_end(ap);
}
void PX4ConsoleDriver::vprintf(const char *fmt, va_list ap) {
_uart->vprintf(fmt, ap);
}
void PX4ConsoleDriver::vprintf_P(const prog_char *fmt, va_list ap) {
_uart->vprintf(fmt, ap);
}
int16_t PX4ConsoleDriver::available() {
return _uart->available();
}
int16_t PX4ConsoleDriver::txspace() {
return _uart->txspace();
}
int16_t PX4ConsoleDriver::read() {
return _uart->read();
}
int16_t PX4ConsoleDriver::peek() {
return _uart->peek();
}
size_t PX4ConsoleDriver::write(uint8_t c) {
return _uart->write(c);
}
#endif