Adding support for printing floats and doubles (defaulting to 2 decimal places)

1 files changed, 30 insertions, 0 deletions

diff --git a/cores/arduino/Print.cpp b/cores/arduino/Print.cpp
index feff940..143f15d 100755
--- a/cores/arduino/Print.cpp
+++ b/cores/arduino/Print.cpp
@@ -22,6 +22,7 @@
 #include <stdio.h>
 #include <string.h>
 #include <inttypes.h>
+#include <math.h>
 #include "wiring.h"
 
 #include "Print.h"
@@ -78,6 +79,11 @@ void Print::print(long n, int base)
     printNumber(n, base);
 }
 
+void Print::print(double n)
+{
+  printFloat(n*100, 2);
+}
+
 void Print::println(void)
 {
   print('\r');
@@ -132,6 +138,12 @@ void Print::println(long n, int base)
   println();
 }
 
+void Print::println(double n)
+{
+  print(n);
+  println();
+}
+
 // Private Methods /////////////////////////////////////////////////////////////
 
 void Print::printNumber(unsigned long n, uint8_t base)
@@ -154,3 +166,21 @@ void Print::printNumber(unsigned long n, uint8_t base)
       '0' + buf[i - 1] :
       'A' + buf[i - 1] - 10));
 }
+
+void Print::printFloat(double number, uint8_t scale) 
+{ 
+  double mult = pow(10,scale); 
+  double rounded = floor(number /mult); 
+  double biground = rounded * mult; 
+  double remainder = (number - biground);  
+  remainder = remainder / mult; 
+  print(long(rounded)); 
+  print("."); 
+
+  while (scale--) {  
+    double toPrint = floor(remainder * 10); 
+    print(int(toPrint)); 
+    remainder -= (toPrint/10); 
+    remainder *= 10; 
+  } 
+} 
\ No newline at end of file