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.
80 lines
2.2 KiB
80 lines
2.2 KiB
#pragma once |
|
|
|
#include "AP_HAL_VRBRAIN.h" |
|
#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 */ |
|
uint32_t available() override; |
|
uint32_t txspace() override; |
|
int16_t read() override; |
|
|
|
/* 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); |
|
uint64_t _first_write_time; |
|
uint64_t _last_write_time; |
|
|
|
void try_initialise(void); |
|
uint32_t _last_initialise_attempt_ms; |
|
|
|
uint32_t _os_start_auto_space; |
|
uint32_t _total_read; |
|
uint32_t _total_written; |
|
enum flow_control _flow_control; |
|
|
|
pid_t _uart_owner_pid; |
|
|
|
};
|
|
|