Mirror
/
ardupilot
mirror of https://github.com/ArduPilot/ardupilot
5
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity

FastSerial: avoid buffer re-allocation on re-open if possible 

we commonly re-open serial ports a lot in the AUTO GPS driver
This commit is contained in:
Andrew Tridgell 2012-06-09 07:43:06 +10:00
parent aeaebb21d5
commit 9c1ce9e1c5
1 changed files with 16 additions and 6 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

22
libraries/FastSerial/FastSerial.cpp
View File

@ -82,6 +82,7 @@ void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
{ {
uint16_t ubrr; uint16_t ubrr;
bool use_u2x = true; bool use_u2x = true;
bool need_allocate = true;
// if we are currently open... // if we are currently open...
if (_open) { if (_open) {
@ -92,14 +93,23 @@ void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
if (0 == txSpace) if (0 == txSpace)
txSpace = _txBuffer->mask + 1; txSpace = _txBuffer->mask + 1;
// close the port in its current configuration, clears _open if (rxSpace == (_rxBuffer->mask + 1) &&
end(); txSpace == (_txBuffer->mask + 1)) {
// avoid re-allocating the buffers if possible
need_allocate = false;
*_ucsrb &= ~(_portEnableBits | _portTxBits);
} else {
// close the port in its current configuration, clears _open
end();
}
} }
// allocate buffers if (need_allocate) {
if (!_allocBuffer(_rxBuffer, rxSpace ? : _default_rx_buffer_size) || !_allocBuffer(_txBuffer, txSpace ? : _default_tx_buffer_size)) { // allocate buffers
end(); if (!_allocBuffer(_rxBuffer, rxSpace ? : _default_rx_buffer_size) || !_allocBuffer(_txBuffer, txSpace ? : _default_tx_buffer_size)) {
return; // couldn't allocate buffers - fatal end();
return; // couldn't allocate buffers - fatal
}
} }
// reset buffer pointers // reset buffer pointers