Diff: BufferedSerial.cpp

Revision:

10:9ee15ae3d1a3

Parent:

8:506247a040bc

Child:

11:779304f9c5d2

--- a/BufferedSerial.cpp	Sun Jan 04 23:27:53 2015 +0000
+++ b/BufferedSerial.cpp	Wed Jan 07 18:37:11 2015 +0000
@@ -23,11 +23,12 @@
 #include "BufferedSerial.h"
 #include <stdarg.h>
 
-BufferedSerial::BufferedSerial(PinName tx, PinName rx, const char* name)
-    : SERIAL_BASE(tx, rx) , _rxbuf(2*BUFFEREDSERIAL_MAX_BUFFER_SIZE), _txbuf(2*BUFFEREDSERIAL_MAX_BUFFER_SIZE)
+BufferedSerial::BufferedSerial(PinName tx, PinName rx, uint32_t buf_size, uint32_t tx_multiple, const char* name)
+    : SERIAL_BASE(tx, rx) , _rxbuf(buf_size), _txbuf((uint32_t)(tx_multiple*buf_size))
 {
     SERIAL_BASE::attach(this, &BufferedSerial::rxIrq, Serial::RxIrq);
-    
+    this->_buf_size = buf_size;
+    this->_tx_multiple = tx_multiple;   
     return;
 }
 
@@ -80,20 +81,21 @@
 
 int BufferedSerial::printf(const char* format, ...)
 {
-    memset(this->_buffer,0,BUFFEREDSERIAL_MAX_BUFFER_SIZE+1);
+    char buffer[this->_buf_size];
+    memset(buffer,0,this->_buf_size);
     int r = 0;
 
     va_list arg;
     va_start(arg, format);
-    r = vsprintf(this->_buffer, format, arg);
+    r = vsprintf(buffer, format, arg);
     // this may not hit the heap but should alert the user anyways
-    if(r > BUFFEREDSERIAL_MAX_BUFFER_SIZE) {
-        error("%s %d buffer overwrite (max_buf_size: %d exceeded: %d)!\r\n", __FILE__, __LINE__,BUFFEREDSERIAL_MAX_BUFFER_SIZE,r);
+    if(r > this->_buf_size) {
+        error("%s %d buffer overwrite (max_buf_size: %d exceeded: %d)!\r\n", __FILE__, __LINE__,this->_buf_size,r);
         va_end(arg);
         return 0;
     }
     va_end(arg);
-    r = BufferedSerial::write(this->_buffer, r);
+    r = BufferedSerial::write(buffer, r);
 
     return r;
 }