FastSerial Fix

git-svn-id: https://arducopter.googlecode.com/svn/trunk@1826 f9c3cf11-9bcb-44bc-f272-b75c42450872
14 years ago · c8281da5ec
1 changed files with 2 additions and 1 deletions
--- a/libraries/FastSerial/FastSerial.cpp
+++ b/libraries/FastSerial/FastSerial.cpp
@ -112,12 +112,13 @@ void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
				@@ -112,12 +112,13 @@ void FastSerial::begin(long baud, unsigned int rxSpace, unsigned int txSpace)
 #endif

 		if (use_u2x) {
+			*_ucsra = 1 << _u2x;
 			ubrr = (F_CPU / 4 / baud - 1) / 2;
 		} else {
+			*_ucsra = 0;
 			ubrr = (F_CPU / 8 / baud - 1) / 2;
 		}

-		*_ucsra = use_u2x ? _BV(_u2x) : 0;
 		*_ubrrh = ubrr >> 8;
 		*_ubrrl = ubrr;
 	}