You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
 
 
 
 
 
 

28 lines
658 B

#include <stdarg.h>
#include <AP_HAL.h>
#include "AP_InertialSensor_UserInteract_Stream.h"
extern const AP_HAL::HAL& hal;
uint8_t AP_InertialSensor_UserInteractStream::blocking_read() {
/* Wait for input to be available */
while(!_s->available()) {
hal.scheduler->delay(20);
}
/* Grab first character */
uint8_t ret = (uint8_t) _s->read();
/* Clear all available input */
while (_s->available()) {
_s->read();
}
return ret;
}
void AP_InertialSensor_UserInteractStream::_printf_P(
const prog_char* fmt, ...) {
va_list ap;
va_start(ap, fmt);
_s->vprintf_P(fmt, ap);
va_end(ap);
}