Mirror/ardupilot
5
0
Fork 0
mirror of https://github.com/ArduPilot/ardupilot synced 2025-01-03 06:28:27 -04:00
Code Issues Packages Projects Releases Wiki Activity

Clean up the bitrate calculations per the Atmel datasheet.

Browse Source 
Verified that when configured for 115200, the actual output as seen on a scope is around 117600Hz consistent with the +2.1% error in the datasheet.

git-svn-id: https://arducopter.googlecode.com/svn/trunk@542 f9c3cf11-9bcb-44bc-f272-b75c42450872
This commit is contained in:
DrZiplok@gmail.com 2010-09-23 05:41:30 +00:00
parent 15e6469ca9
commit f72129bdb3
1 changed files with 31 additions and 24 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

51
libraries/FastSerial/FastSerial.cpp
View File

@ -121,8 +121,10 @@ void FastSerial::begin(long baud)
void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace) void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
{ {
uint16_t baud_setting; uint16_t ubrr;
bool use_u2x; bool use_u2x = false;
int ureg, u2;
long breg, b2, dreg, d2;
// if we are currently open, close and restart // if we are currently open, close and restart
if (_open) if (_open)
@ -136,33 +138,38 @@ void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
} }
_open = true; _open = true;
// U2X mode is needed for baud rates higher than (CPU Hz / 16) // U2X mode is needed for bitrates higher than (F_CPU / 16)
if (baud > F_CPU / 16) { if (baud > F_CPU / 16) {
use_u2x = true; use_u2x = true;
ubrr = F_CPU / (8 * baud) - 1;
} else { } else {
// figure out if U2X mode would allow for a better connection // Determine whether u2x mode would give a closer
// approximation of the desired speed.
// calculate the percent difference between the baud-rate specified and // ubrr for non-2x mode, corresponding baudrate and delta
// the real baud rate for both U2X and non-U2X mode (0-255 error percent) ureg = F_CPU / 16 / baud - 1;
uint8_t nonu2x_baud_error = abs((int)(255-((F_CPU/(16*(((F_CPU/8/baud-1)/2)+1))*255)/baud))); breg = F_CPU / 16 / (ureg + 1);
uint8_t u2x_baud_error = abs((int)(255-((F_CPU/(8*(((F_CPU/4/baud-1)/2)+1))*255)/baud))); dreg = abs(baud - breg);
// prefer non-U2X mode because it handles clock skew better // ubrr for 2x mode, corresponding bitrate and delta
use_u2x = (nonu2x_baud_error > u2x_baud_error); u2 = F_CPU / 8 / baud - 1;
b2 = F_CPU / 8 / (u2 + 1);
d2 = abs(baud - b2);
// Pick the setting that gives the smallest rate
// error, preferring non-u2x mode if the delta is
// identical.
if (dreg <= d2) {
ubrr = ureg;
} else {
ubrr = u2;
use_u2x = true;
}
} }
if (use_u2x) { *_ucsra = use_u2x ? _BV(_u2x) : 0;
*_ucsra = _BV(_u2x); *_ubrrh = ubrr >> 8;
baud_setting = (F_CPU / 4 / baud - 1) / 2; *_ubrrl = ubrr;
} else {
*_ucsra = 0;
baud_setting = (F_CPU / 8 / baud - 1) / 2;
}
// assign the baud_setting, a.k.a. ubbr (USART Baud Rate Register)
*_ubrrh = baud_setting >> 8;
*_ubrrl = baud_setting;
*_ucsrb |= _portEnableBits; *_ucsrb |= _portEnableBits;
} }