2016-02-17 21:25:29 -04:00
|
|
|
#pragma once
|
2014-03-31 14:29:33 -03:00
|
|
|
|
2015-08-11 03:28:43 -03:00
|
|
|
#include "AP_HAL_VRBRAIN.h"
|
2014-03-31 14:29:33 -03:00
|
|
|
#include <systemlib/perf_counter.h>
|
|
|
|
|
|
|
|
class VRBRAIN::VRBRAINUARTDriver : public AP_HAL::UARTDriver {
|
|
|
|
public:
|
|
|
|
VRBRAINUARTDriver(const char *devpath, const char *perf_name);
|
|
|
|
/* VRBRAIN implementations of UARTDriver virtual methods */
|
|
|
|
void begin(uint32_t b);
|
|
|
|
void begin(uint32_t b, uint16_t rxS, uint16_t txS);
|
|
|
|
void end();
|
|
|
|
void flush();
|
|
|
|
bool is_initialized();
|
|
|
|
void set_blocking_writes(bool blocking);
|
|
|
|
bool tx_pending();
|
|
|
|
|
|
|
|
/* VRBRAIN implementations of Stream virtual methods */
|
|
|
|
int16_t available();
|
|
|
|
int16_t txspace();
|
|
|
|
int16_t read();
|
|
|
|
|
|
|
|
/* VRBRAIN implementations of Print virtual methods */
|
|
|
|
size_t write(uint8_t c);
|
|
|
|
size_t write(const uint8_t *buffer, size_t size);
|
|
|
|
|
|
|
|
void set_device_path(const char *path) {
|
|
|
|
_devpath = path;
|
|
|
|
}
|
|
|
|
|
|
|
|
void _timer_tick(void);
|
|
|
|
|
|
|
|
int _get_fd(void) {
|
|
|
|
return _fd;
|
|
|
|
}
|
|
|
|
|
|
|
|
void set_flow_control(enum flow_control flow_control);
|
|
|
|
enum flow_control get_flow_control(void) { return _flow_control; }
|
|
|
|
|
|
|
|
private:
|
|
|
|
const char *_devpath;
|
|
|
|
int _fd;
|
|
|
|
uint32_t _baudrate;
|
|
|
|
volatile bool _initialised;
|
|
|
|
volatile bool _in_timer;
|
|
|
|
|
|
|
|
bool _nonblocking_writes;
|
|
|
|
|
|
|
|
// we use in-task ring buffers to reduce the system call cost
|
|
|
|
// of ::read() and ::write() in the main loop
|
|
|
|
uint8_t *_readbuf;
|
|
|
|
uint16_t _readbuf_size;
|
|
|
|
|
|
|
|
// _head is where the next available data is. _tail is where new
|
|
|
|
// data is put
|
|
|
|
volatile uint16_t _readbuf_head;
|
|
|
|
volatile uint16_t _readbuf_tail;
|
|
|
|
|
|
|
|
uint8_t *_writebuf;
|
|
|
|
uint16_t _writebuf_size;
|
|
|
|
volatile uint16_t _writebuf_head;
|
|
|
|
volatile uint16_t _writebuf_tail;
|
|
|
|
perf_counter_t _perf_uart;
|
|
|
|
|
|
|
|
int _write_fd(const uint8_t *buf, uint16_t n);
|
|
|
|
int _read_fd(uint8_t *buf, uint16_t n);
|
2015-07-13 21:08:58 -03:00
|
|
|
uint64_t _first_write_time;
|
2014-03-31 14:29:33 -03:00
|
|
|
uint64_t _last_write_time;
|
|
|
|
|
|
|
|
void try_initialise(void);
|
|
|
|
uint32_t _last_initialise_attempt_ms;
|
|
|
|
|
2015-07-13 21:08:58 -03:00
|
|
|
uint32_t _os_start_auto_space;
|
2014-03-31 14:29:33 -03:00
|
|
|
uint32_t _total_read;
|
|
|
|
uint32_t _total_written;
|
|
|
|
enum flow_control _flow_control;
|
|
|
|
};
|