pengfei wu
/
ESP8266Program
For test
Print.cpp@35:90be2bc2a492, 2015-02-05 (annotated)
- Committer:
- shennongmin
- Date:
- Thu Feb 05 06:48:45 2015 +0000
- Revision:
- 35:90be2bc2a492
- Parent:
- 24:b5ba3e321e34
compile okay and test okay
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
shennongmin | 10:9d4ec0359a5c | 1 | /* |
shennongmin | 10:9d4ec0359a5c | 2 | Print.cpp - Base class that provides print() and println() |
shennongmin | 10:9d4ec0359a5c | 3 | Copyright (c) 2008 David A. Mellis. All right reserved. |
shennongmin | 10:9d4ec0359a5c | 4 | |
shennongmin | 10:9d4ec0359a5c | 5 | This library is free software; you can redistribute it and/or |
shennongmin | 10:9d4ec0359a5c | 6 | modify it under the terms of the GNU Lesser General Public |
shennongmin | 10:9d4ec0359a5c | 7 | License as published by the Free Software Foundation; either |
shennongmin | 10:9d4ec0359a5c | 8 | version 2.1 of the License, or (at your option) any later version. |
shennongmin | 10:9d4ec0359a5c | 9 | |
shennongmin | 10:9d4ec0359a5c | 10 | This library is distributed in the hope that it will be useful, |
shennongmin | 10:9d4ec0359a5c | 11 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
shennongmin | 10:9d4ec0359a5c | 12 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
shennongmin | 10:9d4ec0359a5c | 13 | Lesser General Public License for more details. |
shennongmin | 10:9d4ec0359a5c | 14 | |
shennongmin | 10:9d4ec0359a5c | 15 | You should have received a copy of the GNU Lesser General Public |
shennongmin | 10:9d4ec0359a5c | 16 | License along with this library; if not, write to the Free Software |
shennongmin | 10:9d4ec0359a5c | 17 | Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA |
shennongmin | 10:9d4ec0359a5c | 18 | |
shennongmin | 10:9d4ec0359a5c | 19 | Modified 23 November 2006 by David A. Mellis |
shennongmin | 10:9d4ec0359a5c | 20 | */ |
shennongmin | 10:9d4ec0359a5c | 21 | |
shennongmin | 10:9d4ec0359a5c | 22 | #include <stdlib.h> |
shennongmin | 10:9d4ec0359a5c | 23 | #include <stdio.h> |
shennongmin | 10:9d4ec0359a5c | 24 | #include <string.h> |
shennongmin | 10:9d4ec0359a5c | 25 | #include <math.h> |
shennongmin | 10:9d4ec0359a5c | 26 | |
shennongmin | 10:9d4ec0359a5c | 27 | #include "Print.h" |
shennongmin | 10:9d4ec0359a5c | 28 | |
shennongmin | 10:9d4ec0359a5c | 29 | // Public Methods ////////////////////////////////////////////////////////////// |
shennongmin | 10:9d4ec0359a5c | 30 | |
shennongmin | 10:9d4ec0359a5c | 31 | /* default implementation: may be overridden */ |
shennongmin | 10:9d4ec0359a5c | 32 | size_t Print::write(const uint8_t *buffer, size_t size) |
shennongmin | 10:9d4ec0359a5c | 33 | { |
shennongmin | 10:9d4ec0359a5c | 34 | size_t n = 0; |
shennongmin | 10:9d4ec0359a5c | 35 | while (size--) { |
shennongmin | 10:9d4ec0359a5c | 36 | n += write(*buffer++); |
shennongmin | 10:9d4ec0359a5c | 37 | } |
shennongmin | 10:9d4ec0359a5c | 38 | return n; |
shennongmin | 10:9d4ec0359a5c | 39 | } |
shennongmin | 10:9d4ec0359a5c | 40 | |
shennongmin | 10:9d4ec0359a5c | 41 | |
shennongmin | 10:9d4ec0359a5c | 42 | size_t Print::print(const String &s) |
shennongmin | 10:9d4ec0359a5c | 43 | { |
shennongmin | 10:9d4ec0359a5c | 44 | size_t n = 0; |
shennongmin | 10:9d4ec0359a5c | 45 | for (uint16_t i = 0; i < s.length(); i++) { |
shennongmin | 10:9d4ec0359a5c | 46 | n += write(s[i]); |
shennongmin | 10:9d4ec0359a5c | 47 | } |
shennongmin | 10:9d4ec0359a5c | 48 | return n; |
shennongmin | 10:9d4ec0359a5c | 49 | } |
shennongmin | 10:9d4ec0359a5c | 50 | |
shennongmin | 10:9d4ec0359a5c | 51 | size_t Print::print(const char str[]) |
shennongmin | 10:9d4ec0359a5c | 52 | { |
shennongmin | 10:9d4ec0359a5c | 53 | return write(str); |
shennongmin | 10:9d4ec0359a5c | 54 | } |
shennongmin | 10:9d4ec0359a5c | 55 | |
shennongmin | 10:9d4ec0359a5c | 56 | size_t Print::print(char c) |
shennongmin | 10:9d4ec0359a5c | 57 | { |
shennongmin | 10:9d4ec0359a5c | 58 | return write(c); |
shennongmin | 10:9d4ec0359a5c | 59 | } |
shennongmin | 10:9d4ec0359a5c | 60 | |
shennongmin | 10:9d4ec0359a5c | 61 | size_t Print::print(unsigned char b, int base) |
shennongmin | 10:9d4ec0359a5c | 62 | { |
shennongmin | 10:9d4ec0359a5c | 63 | return print((unsigned long) b, base); |
shennongmin | 10:9d4ec0359a5c | 64 | } |
shennongmin | 10:9d4ec0359a5c | 65 | |
shennongmin | 10:9d4ec0359a5c | 66 | size_t Print::print(int n, int base) |
shennongmin | 10:9d4ec0359a5c | 67 | { |
shennongmin | 10:9d4ec0359a5c | 68 | return print((long) n, base); |
shennongmin | 10:9d4ec0359a5c | 69 | } |
shennongmin | 10:9d4ec0359a5c | 70 | |
shennongmin | 10:9d4ec0359a5c | 71 | size_t Print::print(unsigned int n, int base) |
shennongmin | 10:9d4ec0359a5c | 72 | { |
shennongmin | 10:9d4ec0359a5c | 73 | return print((unsigned long) n, base); |
shennongmin | 10:9d4ec0359a5c | 74 | } |
shennongmin | 10:9d4ec0359a5c | 75 | |
shennongmin | 10:9d4ec0359a5c | 76 | size_t Print::print(long n, int base) |
shennongmin | 10:9d4ec0359a5c | 77 | { |
shennongmin | 10:9d4ec0359a5c | 78 | if (base == 0) { |
shennongmin | 10:9d4ec0359a5c | 79 | return write(n); |
shennongmin | 10:9d4ec0359a5c | 80 | } else if (base == 10) { |
shennongmin | 10:9d4ec0359a5c | 81 | if (n < 0) { |
shennongmin | 10:9d4ec0359a5c | 82 | int t = print('-'); |
shennongmin | 10:9d4ec0359a5c | 83 | n = -n; |
shennongmin | 10:9d4ec0359a5c | 84 | return printNumber(n, 10) + t; |
shennongmin | 10:9d4ec0359a5c | 85 | } |
shennongmin | 10:9d4ec0359a5c | 86 | return printNumber(n, 10); |
shennongmin | 10:9d4ec0359a5c | 87 | } else { |
shennongmin | 10:9d4ec0359a5c | 88 | return printNumber(n, base); |
shennongmin | 10:9d4ec0359a5c | 89 | } |
shennongmin | 10:9d4ec0359a5c | 90 | } |
shennongmin | 10:9d4ec0359a5c | 91 | |
shennongmin | 10:9d4ec0359a5c | 92 | size_t Print::print(unsigned long n, int base) |
shennongmin | 10:9d4ec0359a5c | 93 | { |
shennongmin | 10:9d4ec0359a5c | 94 | if (base == 0) return write(n); |
shennongmin | 10:9d4ec0359a5c | 95 | else return printNumber(n, base); |
shennongmin | 10:9d4ec0359a5c | 96 | } |
shennongmin | 10:9d4ec0359a5c | 97 | |
shennongmin | 10:9d4ec0359a5c | 98 | size_t Print::print(double n, int digits) |
shennongmin | 10:9d4ec0359a5c | 99 | { |
shennongmin | 10:9d4ec0359a5c | 100 | return printFloat(n, digits); |
shennongmin | 10:9d4ec0359a5c | 101 | } |
shennongmin | 10:9d4ec0359a5c | 102 | |
shennongmin | 10:9d4ec0359a5c | 103 | size_t Print::println(void) |
shennongmin | 10:9d4ec0359a5c | 104 | { |
shennongmin | 10:9d4ec0359a5c | 105 | size_t n = print('\r'); |
shennongmin | 10:9d4ec0359a5c | 106 | n += print('\n'); |
shennongmin | 10:9d4ec0359a5c | 107 | return n; |
shennongmin | 10:9d4ec0359a5c | 108 | } |
shennongmin | 10:9d4ec0359a5c | 109 | |
shennongmin | 10:9d4ec0359a5c | 110 | size_t Print::println(const String &s) |
shennongmin | 10:9d4ec0359a5c | 111 | { |
shennongmin | 10:9d4ec0359a5c | 112 | size_t n = print(s); |
shennongmin | 10:9d4ec0359a5c | 113 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 114 | return n; |
shennongmin | 10:9d4ec0359a5c | 115 | } |
shennongmin | 10:9d4ec0359a5c | 116 | |
shennongmin | 10:9d4ec0359a5c | 117 | size_t Print::println(const char c[]) |
shennongmin | 10:9d4ec0359a5c | 118 | { |
shennongmin | 10:9d4ec0359a5c | 119 | size_t n = print(c); |
shennongmin | 10:9d4ec0359a5c | 120 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 121 | return n; |
shennongmin | 10:9d4ec0359a5c | 122 | } |
shennongmin | 10:9d4ec0359a5c | 123 | |
shennongmin | 10:9d4ec0359a5c | 124 | size_t Print::println(char c) |
shennongmin | 10:9d4ec0359a5c | 125 | { |
shennongmin | 10:9d4ec0359a5c | 126 | size_t n = print(c); |
shennongmin | 10:9d4ec0359a5c | 127 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 128 | return n; |
shennongmin | 10:9d4ec0359a5c | 129 | } |
shennongmin | 10:9d4ec0359a5c | 130 | |
shennongmin | 10:9d4ec0359a5c | 131 | size_t Print::println(unsigned char b, int base) |
shennongmin | 10:9d4ec0359a5c | 132 | { |
shennongmin | 10:9d4ec0359a5c | 133 | size_t n = print(b, base); |
shennongmin | 10:9d4ec0359a5c | 134 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 135 | return n; |
shennongmin | 10:9d4ec0359a5c | 136 | } |
shennongmin | 10:9d4ec0359a5c | 137 | |
shennongmin | 10:9d4ec0359a5c | 138 | size_t Print::println(int num, int base) |
shennongmin | 10:9d4ec0359a5c | 139 | { |
shennongmin | 10:9d4ec0359a5c | 140 | size_t n = print(num, base); |
shennongmin | 10:9d4ec0359a5c | 141 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 142 | return n; |
shennongmin | 10:9d4ec0359a5c | 143 | } |
shennongmin | 10:9d4ec0359a5c | 144 | |
shennongmin | 10:9d4ec0359a5c | 145 | size_t Print::println(unsigned int num, int base) |
shennongmin | 10:9d4ec0359a5c | 146 | { |
shennongmin | 10:9d4ec0359a5c | 147 | size_t n = print(num, base); |
shennongmin | 10:9d4ec0359a5c | 148 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 149 | return n; |
shennongmin | 10:9d4ec0359a5c | 150 | } |
shennongmin | 10:9d4ec0359a5c | 151 | |
shennongmin | 10:9d4ec0359a5c | 152 | size_t Print::println(long num, int base) |
shennongmin | 10:9d4ec0359a5c | 153 | { |
shennongmin | 10:9d4ec0359a5c | 154 | size_t n = print(num, base); |
shennongmin | 10:9d4ec0359a5c | 155 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 156 | return n; |
shennongmin | 10:9d4ec0359a5c | 157 | } |
shennongmin | 10:9d4ec0359a5c | 158 | |
shennongmin | 10:9d4ec0359a5c | 159 | size_t Print::println(unsigned long num, int base) |
shennongmin | 10:9d4ec0359a5c | 160 | { |
shennongmin | 10:9d4ec0359a5c | 161 | size_t n = print(num, base); |
shennongmin | 10:9d4ec0359a5c | 162 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 163 | return n; |
shennongmin | 10:9d4ec0359a5c | 164 | } |
shennongmin | 10:9d4ec0359a5c | 165 | |
shennongmin | 10:9d4ec0359a5c | 166 | size_t Print::println(double num, int digits) |
shennongmin | 10:9d4ec0359a5c | 167 | { |
shennongmin | 10:9d4ec0359a5c | 168 | size_t n = print(num, digits); |
shennongmin | 10:9d4ec0359a5c | 169 | n += println(); |
shennongmin | 10:9d4ec0359a5c | 170 | return n; |
shennongmin | 10:9d4ec0359a5c | 171 | } |
shennongmin | 10:9d4ec0359a5c | 172 | |
shennongmin | 10:9d4ec0359a5c | 173 | // Private Methods ///////////////////////////////////////////////////////////// |
shennongmin | 10:9d4ec0359a5c | 174 | |
shennongmin | 10:9d4ec0359a5c | 175 | size_t Print::printNumber(unsigned long n, uint8_t base) { |
shennongmin | 10:9d4ec0359a5c | 176 | char buf[8 * sizeof(long) + 1]; // Assumes 8-bit chars plus zero byte. |
shennongmin | 10:9d4ec0359a5c | 177 | char *str = &buf[sizeof(buf) - 1]; |
shennongmin | 10:9d4ec0359a5c | 178 | |
shennongmin | 10:9d4ec0359a5c | 179 | *str = '\0'; |
shennongmin | 10:9d4ec0359a5c | 180 | |
shennongmin | 10:9d4ec0359a5c | 181 | // prevent crash if called with base == 1 |
shennongmin | 10:9d4ec0359a5c | 182 | if (base < 2) base = 10; |
shennongmin | 10:9d4ec0359a5c | 183 | |
shennongmin | 10:9d4ec0359a5c | 184 | do { |
shennongmin | 10:9d4ec0359a5c | 185 | unsigned long m = n; |
shennongmin | 10:9d4ec0359a5c | 186 | n /= base; |
shennongmin | 10:9d4ec0359a5c | 187 | char c = m - base * n; |
shennongmin | 10:9d4ec0359a5c | 188 | *--str = c < 10 ? c + '0' : c + 'A' - 10; |
shennongmin | 10:9d4ec0359a5c | 189 | } while(n); |
shennongmin | 10:9d4ec0359a5c | 190 | |
shennongmin | 10:9d4ec0359a5c | 191 | return write(str); |
shennongmin | 10:9d4ec0359a5c | 192 | } |
shennongmin | 10:9d4ec0359a5c | 193 | |
shennongmin | 10:9d4ec0359a5c | 194 | size_t Print::printFloat(double number, uint8_t digits) |
shennongmin | 10:9d4ec0359a5c | 195 | { |
shennongmin | 10:9d4ec0359a5c | 196 | size_t n = 0; |
shennongmin | 10:9d4ec0359a5c | 197 | |
shennongmin | 10:9d4ec0359a5c | 198 | if (isnan(number)) return print("nan"); |
shennongmin | 10:9d4ec0359a5c | 199 | if (isinf(number)) return print("inf"); |
shennongmin | 10:9d4ec0359a5c | 200 | if (number > 4294967040.0) return print ("ovf"); // constant determined empirically |
shennongmin | 10:9d4ec0359a5c | 201 | if (number <-4294967040.0) return print ("ovf"); // constant determined empirically |
shennongmin | 10:9d4ec0359a5c | 202 | |
shennongmin | 10:9d4ec0359a5c | 203 | // Handle negative numbers |
shennongmin | 10:9d4ec0359a5c | 204 | if (number < 0.0) |
shennongmin | 10:9d4ec0359a5c | 205 | { |
shennongmin | 10:9d4ec0359a5c | 206 | n += print('-'); |
shennongmin | 10:9d4ec0359a5c | 207 | number = -number; |
shennongmin | 10:9d4ec0359a5c | 208 | } |
shennongmin | 10:9d4ec0359a5c | 209 | |
shennongmin | 10:9d4ec0359a5c | 210 | // Round correctly so that print(1.999, 2) prints as "2.00" |
shennongmin | 10:9d4ec0359a5c | 211 | double rounding = 0.5; |
shennongmin | 10:9d4ec0359a5c | 212 | for (uint8_t i=0; i<digits; ++i) |
shennongmin | 10:9d4ec0359a5c | 213 | rounding /= 10.0; |
shennongmin | 10:9d4ec0359a5c | 214 | |
shennongmin | 10:9d4ec0359a5c | 215 | number += rounding; |
shennongmin | 10:9d4ec0359a5c | 216 | |
shennongmin | 10:9d4ec0359a5c | 217 | // Extract the integer part of the number and print it |
shennongmin | 10:9d4ec0359a5c | 218 | unsigned long int_part = (unsigned long)number; |
shennongmin | 10:9d4ec0359a5c | 219 | double remainder = number - (double)int_part; |
shennongmin | 10:9d4ec0359a5c | 220 | n += print(int_part); |
shennongmin | 10:9d4ec0359a5c | 221 | |
shennongmin | 10:9d4ec0359a5c | 222 | // Print the decimal point, but only if there are digits beyond |
shennongmin | 10:9d4ec0359a5c | 223 | if (digits > 0) { |
shennongmin | 10:9d4ec0359a5c | 224 | n += print("."); |
shennongmin | 10:9d4ec0359a5c | 225 | } |
shennongmin | 10:9d4ec0359a5c | 226 | |
shennongmin | 10:9d4ec0359a5c | 227 | // Extract digits from the remainder one at a time |
shennongmin | 10:9d4ec0359a5c | 228 | while (digits-- > 0) |
shennongmin | 10:9d4ec0359a5c | 229 | { |
shennongmin | 10:9d4ec0359a5c | 230 | remainder *= 10.0; |
shennongmin | 10:9d4ec0359a5c | 231 | int toPrint = int(remainder); |
shennongmin | 10:9d4ec0359a5c | 232 | n += print(toPrint); |
shennongmin | 10:9d4ec0359a5c | 233 | remainder -= toPrint; |
shennongmin | 10:9d4ec0359a5c | 234 | } |
shennongmin | 10:9d4ec0359a5c | 235 | |
shennongmin | 10:9d4ec0359a5c | 236 | return n; |
shennongmin | 10:9d4ec0359a5c | 237 | } |