skydarc meneldoll / Mbed OS test_TFT_11_v5

test st7735 on lpc1768 with mbed v5. bug with spi frequency...

ST7735/GFX.cpp@2:2946f9eefcae, 2020-04-08 (annotated)

Committer:
skydarc
Date:
Wed Apr 08 15:00:13 2020 +0000
Revision:
2:2946f9eefcae
v2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
skydarc 2:2946f9eefcae 1 /*
skydarc 2:2946f9eefcae 2 This is the core graphics library for all our displays, providing a common
skydarc 2:2946f9eefcae 3 set of graphics primitives (points, lines, circles, etc.). It needs to be
skydarc 2:2946f9eefcae 4 paired with a hardware-specific library for each display device we carry
skydarc 2:2946f9eefcae 5 (to handle the lower-level functions).
skydarc 2:2946f9eefcae 6
skydarc 2:2946f9eefcae 7 Adafruit invests time and resources providing this open source code, please
skydarc 2:2946f9eefcae 8 support Adafruit & open-source hardware by purchasing products from Adafruit!
skydarc 2:2946f9eefcae 9
skydarc 2:2946f9eefcae 10 Copyright (c) 2013 Adafruit Industries. All rights reserved.
skydarc 2:2946f9eefcae 11
skydarc 2:2946f9eefcae 12 Redistribution and use in source and binary forms, with or without
skydarc 2:2946f9eefcae 13 modification, are permitted provided that the following conditions are met:
skydarc 2:2946f9eefcae 14
skydarc 2:2946f9eefcae 15 - Redistributions of source code must retain the above copyright notice,
skydarc 2:2946f9eefcae 16 this list of conditions and the following disclaimer.
skydarc 2:2946f9eefcae 17 - Redistributions in binary form must reproduce the above copyright notice,
skydarc 2:2946f9eefcae 18 this list of conditions and the following disclaimer in the documentation
skydarc 2:2946f9eefcae 19 and/or other materials provided with the distribution.
skydarc 2:2946f9eefcae 20
skydarc 2:2946f9eefcae 21 THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
skydarc 2:2946f9eefcae 22 AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
skydarc 2:2946f9eefcae 23 IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
skydarc 2:2946f9eefcae 24 ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
skydarc 2:2946f9eefcae 25 LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
skydarc 2:2946f9eefcae 26 CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
skydarc 2:2946f9eefcae 27 SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
skydarc 2:2946f9eefcae 28 INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
skydarc 2:2946f9eefcae 29 CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
skydarc 2:2946f9eefcae 30 ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
skydarc 2:2946f9eefcae 31 POSSIBILITY OF SUCH DAMAGE.*/
skydarc 2:2946f9eefcae 32
skydarc 2:2946f9eefcae 33 /*Modified for MBED usage and tested with STM32F411RE on a Nucleo board.
skydarc 2:2946f9eefcae 34 Embedded Print methods from Arduino Print.Cpp/Print.h
skydarc 2:2946f9eefcae 35
skydarc 2:2946f9eefcae 36 by James Kidd 2014
skydarc 2:2946f9eefcae 37 * */
skydarc 2:2946f9eefcae 38
skydarc 2:2946f9eefcae 39 #include <stdint.h>
skydarc 2:2946f9eefcae 40 #include "GFX.h"
skydarc 2:2946f9eefcae 41 #include "font.c"
skydarc 2:2946f9eefcae 42 #include <math.h>
skydarc 2:2946f9eefcae 43 #include <stdlib.h>
skydarc 2:2946f9eefcae 44 #include <stddef.h>
skydarc 2:2946f9eefcae 45 #define pgm_read_byte(addr) (*(const unsigned char *)(addr))
skydarc 2:2946f9eefcae 46
skydarc 2:2946f9eefcae 47
skydarc 2:2946f9eefcae 48 GFX::GFX(int16_t w, int16_t h):
skydarc 2:2946f9eefcae 49 WIDTH(w), HEIGHT(h)
skydarc 2:2946f9eefcae 50 {
skydarc 2:2946f9eefcae 51 _width = WIDTH;
skydarc 2:2946f9eefcae 52 _height = HEIGHT;
skydarc 2:2946f9eefcae 53 rotation = 0;
skydarc 2:2946f9eefcae 54 cursor_y = cursor_x = 0;
skydarc 2:2946f9eefcae 55 textsize = 1;
skydarc 2:2946f9eefcae 56 textcolor = textbgcolor = 0xFFFF;
skydarc 2:2946f9eefcae 57 wrap = true;
skydarc 2:2946f9eefcae 58 }
skydarc 2:2946f9eefcae 59
skydarc 2:2946f9eefcae 60 // Draw a circle outline
skydarc 2:2946f9eefcae 61 void GFX::drawCircle(int16_t x0, int16_t y0, int16_t r,
skydarc 2:2946f9eefcae 62 uint16_t color) {
skydarc 2:2946f9eefcae 63 int16_t f = 1 - r;
skydarc 2:2946f9eefcae 64 int16_t ddF_x = 1;
skydarc 2:2946f9eefcae 65 int16_t ddF_y = -2 * r;
skydarc 2:2946f9eefcae 66 int16_t x = 0;
skydarc 2:2946f9eefcae 67 int16_t y = r;
skydarc 2:2946f9eefcae 68
skydarc 2:2946f9eefcae 69 drawPixel(x0 , y0+r, color);
skydarc 2:2946f9eefcae 70 drawPixel(x0 , y0-r, color);
skydarc 2:2946f9eefcae 71 drawPixel(x0+r, y0 , color);
skydarc 2:2946f9eefcae 72 drawPixel(x0-r, y0 , color);
skydarc 2:2946f9eefcae 73
skydarc 2:2946f9eefcae 74 while (x<y) {
skydarc 2:2946f9eefcae 75 if (f >= 0) {
skydarc 2:2946f9eefcae 76 y--;
skydarc 2:2946f9eefcae 77 ddF_y += 2;
skydarc 2:2946f9eefcae 78 f += ddF_y;
skydarc 2:2946f9eefcae 79 }
skydarc 2:2946f9eefcae 80 x++;
skydarc 2:2946f9eefcae 81 ddF_x += 2;
skydarc 2:2946f9eefcae 82 f += ddF_x;
skydarc 2:2946f9eefcae 83
skydarc 2:2946f9eefcae 84 drawPixel(x0 + x, y0 + y, color);
skydarc 2:2946f9eefcae 85 drawPixel(x0 - x, y0 + y, color);
skydarc 2:2946f9eefcae 86 drawPixel(x0 + x, y0 - y, color);
skydarc 2:2946f9eefcae 87 drawPixel(x0 - x, y0 - y, color);
skydarc 2:2946f9eefcae 88 drawPixel(x0 + y, y0 + x, color);
skydarc 2:2946f9eefcae 89 drawPixel(x0 - y, y0 + x, color);
skydarc 2:2946f9eefcae 90 drawPixel(x0 + y, y0 - x, color);
skydarc 2:2946f9eefcae 91 drawPixel(x0 - y, y0 - x, color);
skydarc 2:2946f9eefcae 92 }
skydarc 2:2946f9eefcae 93 }
skydarc 2:2946f9eefcae 94
skydarc 2:2946f9eefcae 95 void GFX::drawCircleHelper( int16_t x0, int16_t y0,
skydarc 2:2946f9eefcae 96 int16_t r, uint8_t cornername, uint16_t color) {
skydarc 2:2946f9eefcae 97 int16_t f = 1 - r;
skydarc 2:2946f9eefcae 98 int16_t ddF_x = 1;
skydarc 2:2946f9eefcae 99 int16_t ddF_y = -2 * r;
skydarc 2:2946f9eefcae 100 int16_t x = 0;
skydarc 2:2946f9eefcae 101 int16_t y = r;
skydarc 2:2946f9eefcae 102
skydarc 2:2946f9eefcae 103 while (x<y) {
skydarc 2:2946f9eefcae 104 if (f >= 0) {
skydarc 2:2946f9eefcae 105 y--;
skydarc 2:2946f9eefcae 106 ddF_y += 2;
skydarc 2:2946f9eefcae 107 f += ddF_y;
skydarc 2:2946f9eefcae 108 }
skydarc 2:2946f9eefcae 109 x++;
skydarc 2:2946f9eefcae 110 ddF_x += 2;
skydarc 2:2946f9eefcae 111 f += ddF_x;
skydarc 2:2946f9eefcae 112 if (cornername & 0x4) {
skydarc 2:2946f9eefcae 113 drawPixel(x0 + x, y0 + y, color);
skydarc 2:2946f9eefcae 114 drawPixel(x0 + y, y0 + x, color);
skydarc 2:2946f9eefcae 115 }
skydarc 2:2946f9eefcae 116 if (cornername & 0x2) {
skydarc 2:2946f9eefcae 117 drawPixel(x0 + x, y0 - y, color);
skydarc 2:2946f9eefcae 118 drawPixel(x0 + y, y0 - x, color);
skydarc 2:2946f9eefcae 119 }
skydarc 2:2946f9eefcae 120 if (cornername & 0x8) {
skydarc 2:2946f9eefcae 121 drawPixel(x0 - y, y0 + x, color);
skydarc 2:2946f9eefcae 122 drawPixel(x0 - x, y0 + y, color);
skydarc 2:2946f9eefcae 123 }
skydarc 2:2946f9eefcae 124 if (cornername & 0x1) {
skydarc 2:2946f9eefcae 125 drawPixel(x0 - y, y0 - x, color);
skydarc 2:2946f9eefcae 126 drawPixel(x0 - x, y0 - y, color);
skydarc 2:2946f9eefcae 127 }
skydarc 2:2946f9eefcae 128 }
skydarc 2:2946f9eefcae 129 }
skydarc 2:2946f9eefcae 130
skydarc 2:2946f9eefcae 131 void GFX::fillCircle(int16_t x0, int16_t y0, int16_t r,
skydarc 2:2946f9eefcae 132 uint16_t color) {
skydarc 2:2946f9eefcae 133 drawFastVLine(x0, y0-r, 2*r+1, color);
skydarc 2:2946f9eefcae 134 fillCircleHelper(x0, y0, r, 3, 0, color);
skydarc 2:2946f9eefcae 135 }
skydarc 2:2946f9eefcae 136
skydarc 2:2946f9eefcae 137 // Used to do circles and roundrects
skydarc 2:2946f9eefcae 138 void GFX::fillCircleHelper(int16_t x0, int16_t y0, int16_t r,
skydarc 2:2946f9eefcae 139 uint8_t cornername, int16_t delta, uint16_t color) {
skydarc 2:2946f9eefcae 140
skydarc 2:2946f9eefcae 141 int16_t f = 1 - r;
skydarc 2:2946f9eefcae 142 int16_t ddF_x = 1;
skydarc 2:2946f9eefcae 143 int16_t ddF_y = -2 * r;
skydarc 2:2946f9eefcae 144 int16_t x = 0;
skydarc 2:2946f9eefcae 145 int16_t y = r;
skydarc 2:2946f9eefcae 146
skydarc 2:2946f9eefcae 147 while (x<y) {
skydarc 2:2946f9eefcae 148
skydarc 2:2946f9eefcae 149 if (f >= 0) {
skydarc 2:2946f9eefcae 150 y--;
skydarc 2:2946f9eefcae 151 ddF_y += 2;
skydarc 2:2946f9eefcae 152 f += ddF_y;
skydarc 2:2946f9eefcae 153 }
skydarc 2:2946f9eefcae 154 x++;
skydarc 2:2946f9eefcae 155 ddF_x += 2;
skydarc 2:2946f9eefcae 156 f += ddF_x;
skydarc 2:2946f9eefcae 157
skydarc 2:2946f9eefcae 158 if (cornername & 0x1) {
skydarc 2:2946f9eefcae 159 drawFastVLine(x0+x, y0-y, 2*y+1+delta, color);
skydarc 2:2946f9eefcae 160 drawFastVLine(x0+y, y0-x, 2*x+1+delta, color);
skydarc 2:2946f9eefcae 161 }
skydarc 2:2946f9eefcae 162 if (cornername & 0x2) {
skydarc 2:2946f9eefcae 163 drawFastVLine(x0-x, y0-y, 2*y+1+delta, color);
skydarc 2:2946f9eefcae 164 drawFastVLine(x0-y, y0-x, 2*x+1+delta, color);
skydarc 2:2946f9eefcae 165 }
skydarc 2:2946f9eefcae 166 }
skydarc 2:2946f9eefcae 167 }
skydarc 2:2946f9eefcae 168
skydarc 2:2946f9eefcae 169 // Bresenham's algorithm - thx wikpedia
skydarc 2:2946f9eefcae 170 void GFX::drawLine(int16_t x0, int16_t y0,
skydarc 2:2946f9eefcae 171 int16_t x1, int16_t y1,
skydarc 2:2946f9eefcae 172 uint16_t color) {
skydarc 2:2946f9eefcae 173 int16_t steep = abs(y1 - y0) > abs(x1 - x0);
skydarc 2:2946f9eefcae 174 if (steep) {
skydarc 2:2946f9eefcae 175 swap(x0, y0);
skydarc 2:2946f9eefcae 176 swap(x1, y1);
skydarc 2:2946f9eefcae 177 }
skydarc 2:2946f9eefcae 178
skydarc 2:2946f9eefcae 179 if (x0 > x1) {
skydarc 2:2946f9eefcae 180 swap(x0, x1);
skydarc 2:2946f9eefcae 181 swap(y0, y1);
skydarc 2:2946f9eefcae 182 }
skydarc 2:2946f9eefcae 183
skydarc 2:2946f9eefcae 184 int16_t dx, dy;
skydarc 2:2946f9eefcae 185 dx = x1 - x0;
skydarc 2:2946f9eefcae 186 dy = abs(y1 - y0);
skydarc 2:2946f9eefcae 187
skydarc 2:2946f9eefcae 188 int16_t err = dx / 2;
skydarc 2:2946f9eefcae 189 int16_t ystep;
skydarc 2:2946f9eefcae 190
skydarc 2:2946f9eefcae 191 if (y0 < y1) {
skydarc 2:2946f9eefcae 192 ystep = 1;
skydarc 2:2946f9eefcae 193 } else {
skydarc 2:2946f9eefcae 194 ystep = -1;
skydarc 2:2946f9eefcae 195 }
skydarc 2:2946f9eefcae 196
skydarc 2:2946f9eefcae 197 for (; x0<=x1; x0++) {
skydarc 2:2946f9eefcae 198 if (steep) {
skydarc 2:2946f9eefcae 199 drawPixel(y0, x0, color);
skydarc 2:2946f9eefcae 200 } else {
skydarc 2:2946f9eefcae 201 drawPixel(x0, y0, color);
skydarc 2:2946f9eefcae 202 }
skydarc 2:2946f9eefcae 203 err -= dy;
skydarc 2:2946f9eefcae 204 if (err < 0) {
skydarc 2:2946f9eefcae 205 y0 += ystep;
skydarc 2:2946f9eefcae 206 err += dx;
skydarc 2:2946f9eefcae 207 }
skydarc 2:2946f9eefcae 208 }
skydarc 2:2946f9eefcae 209 }
skydarc 2:2946f9eefcae 210
skydarc 2:2946f9eefcae 211 // Draw a rectangle
skydarc 2:2946f9eefcae 212 void GFX::drawRect(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 213 int16_t w, int16_t h,
skydarc 2:2946f9eefcae 214 uint16_t color) {
skydarc 2:2946f9eefcae 215 drawFastHLine(x, y, w, color);
skydarc 2:2946f9eefcae 216 drawFastHLine(x, y+h-1, w, color);
skydarc 2:2946f9eefcae 217 drawFastVLine(x, y, h, color);
skydarc 2:2946f9eefcae 218 drawFastVLine(x+w-1, y, h, color);
skydarc 2:2946f9eefcae 219 }
skydarc 2:2946f9eefcae 220
skydarc 2:2946f9eefcae 221 void GFX::drawFastVLine(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 222 int16_t h, uint16_t color) {
skydarc 2:2946f9eefcae 223 // Update in subclasses if desired!
skydarc 2:2946f9eefcae 224 drawLine(x, y, x, y+h-1, color);
skydarc 2:2946f9eefcae 225 }
skydarc 2:2946f9eefcae 226
skydarc 2:2946f9eefcae 227 void GFX::drawFastHLine(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 228 int16_t w, uint16_t color) {
skydarc 2:2946f9eefcae 229 // Update in subclasses if desired!
skydarc 2:2946f9eefcae 230 drawLine(x, y, x+w-1, y, color);
skydarc 2:2946f9eefcae 231 }
skydarc 2:2946f9eefcae 232
skydarc 2:2946f9eefcae 233 void GFX::fillRect(int16_t x, int16_t y, int16_t w, int16_t h,
skydarc 2:2946f9eefcae 234 uint16_t color) {
skydarc 2:2946f9eefcae 235 // Update in subclasses if desired!
skydarc 2:2946f9eefcae 236 for (int16_t i=x; i<x+w; i++) {
skydarc 2:2946f9eefcae 237 drawFastVLine(i, y, h, color);
skydarc 2:2946f9eefcae 238 }
skydarc 2:2946f9eefcae 239 }
skydarc 2:2946f9eefcae 240
skydarc 2:2946f9eefcae 241 void GFX::fillScreen(uint16_t color) {
skydarc 2:2946f9eefcae 242 fillRect(-10, -10, _width+20, _height+20, color);
skydarc 2:2946f9eefcae 243 }
skydarc 2:2946f9eefcae 244
skydarc 2:2946f9eefcae 245 // Draw a rounded rectangle
skydarc 2:2946f9eefcae 246 void GFX::drawRoundRect(int16_t x, int16_t y, int16_t w,
skydarc 2:2946f9eefcae 247 int16_t h, int16_t r, uint16_t color) {
skydarc 2:2946f9eefcae 248 // smarter version
skydarc 2:2946f9eefcae 249 drawFastHLine(x+r , y , w-2*r, color); // Top
skydarc 2:2946f9eefcae 250 drawFastHLine(x+r , y+h-1, w-2*r, color); // Bottom
skydarc 2:2946f9eefcae 251 drawFastVLine(x , y+r , h-2*r, color); // Left
skydarc 2:2946f9eefcae 252 drawFastVLine(x+w-1, y+r , h-2*r, color); // Right
skydarc 2:2946f9eefcae 253 // draw four corners
skydarc 2:2946f9eefcae 254 drawCircleHelper(x+r , y+r , r, 1, color);
skydarc 2:2946f9eefcae 255 drawCircleHelper(x+w-r-1, y+r , r, 2, color);
skydarc 2:2946f9eefcae 256 drawCircleHelper(x+w-r-1, y+h-r-1, r, 4, color);
skydarc 2:2946f9eefcae 257 drawCircleHelper(x+r , y+h-r-1, r, 8, color);
skydarc 2:2946f9eefcae 258 }
skydarc 2:2946f9eefcae 259
skydarc 2:2946f9eefcae 260 // Fill a rounded rectangle
skydarc 2:2946f9eefcae 261 void GFX::fillRoundRect(int16_t x, int16_t y, int16_t w,
skydarc 2:2946f9eefcae 262 int16_t h, int16_t r, uint16_t color) {
skydarc 2:2946f9eefcae 263 // smarter version
skydarc 2:2946f9eefcae 264 fillRect(x+r, y, w-2*r, h, color);
skydarc 2:2946f9eefcae 265
skydarc 2:2946f9eefcae 266 // draw four corners
skydarc 2:2946f9eefcae 267 fillCircleHelper(x+w-r-1, y+r, r, 1, h-2*r-1, color);
skydarc 2:2946f9eefcae 268 fillCircleHelper(x+r , y+r, r, 2, h-2*r-1, color);
skydarc 2:2946f9eefcae 269 }
skydarc 2:2946f9eefcae 270
skydarc 2:2946f9eefcae 271 // Draw a triangle
skydarc 2:2946f9eefcae 272 void GFX::drawTriangle(int16_t x0, int16_t y0,
skydarc 2:2946f9eefcae 273 int16_t x1, int16_t y1,
skydarc 2:2946f9eefcae 274 int16_t x2, int16_t y2, uint16_t color) {
skydarc 2:2946f9eefcae 275 drawLine(x0, y0, x1, y1, color);
skydarc 2:2946f9eefcae 276 drawLine(x1, y1, x2, y2, color);
skydarc 2:2946f9eefcae 277 drawLine(x2, y2, x0, y0, color);
skydarc 2:2946f9eefcae 278 }
skydarc 2:2946f9eefcae 279
skydarc 2:2946f9eefcae 280 // Fill a triangle
skydarc 2:2946f9eefcae 281 void GFX::fillTriangle ( int16_t x0, int16_t y0,
skydarc 2:2946f9eefcae 282 int16_t x1, int16_t y1,
skydarc 2:2946f9eefcae 283 int16_t x2, int16_t y2, uint16_t color) {
skydarc 2:2946f9eefcae 284
skydarc 2:2946f9eefcae 285 int16_t a, b, y, last;
skydarc 2:2946f9eefcae 286
skydarc 2:2946f9eefcae 287 // Sort coordinates by Y order (y2 >= y1 >= y0)
skydarc 2:2946f9eefcae 288 if (y0 > y1) {
skydarc 2:2946f9eefcae 289 swap(y0, y1); swap(x0, x1);
skydarc 2:2946f9eefcae 290 }
skydarc 2:2946f9eefcae 291 if (y1 > y2) {
skydarc 2:2946f9eefcae 292 swap(y2, y1); swap(x2, x1);
skydarc 2:2946f9eefcae 293 }
skydarc 2:2946f9eefcae 294 if (y0 > y1) {
skydarc 2:2946f9eefcae 295 swap(y0, y1); swap(x0, x1);
skydarc 2:2946f9eefcae 296 }
skydarc 2:2946f9eefcae 297
skydarc 2:2946f9eefcae 298 if(y0 == y2) { // Handle awkward all-on-same-line case as its own thing
skydarc 2:2946f9eefcae 299 a = b = x0;
skydarc 2:2946f9eefcae 300 if(x1 < a) a = x1;
skydarc 2:2946f9eefcae 301 else if(x1 > b) b = x1;
skydarc 2:2946f9eefcae 302 if(x2 < a) a = x2;
skydarc 2:2946f9eefcae 303 else if(x2 > b) b = x2;
skydarc 2:2946f9eefcae 304 drawFastHLine(a, y0, b-a+1, color);
skydarc 2:2946f9eefcae 305 return;
skydarc 2:2946f9eefcae 306 }
skydarc 2:2946f9eefcae 307
skydarc 2:2946f9eefcae 308 int16_t
skydarc 2:2946f9eefcae 309 dx01 = x1 - x0,
skydarc 2:2946f9eefcae 310 dy01 = y1 - y0,
skydarc 2:2946f9eefcae 311 dx02 = x2 - x0,
skydarc 2:2946f9eefcae 312 dy02 = y2 - y0,
skydarc 2:2946f9eefcae 313 dx12 = x2 - x1,
skydarc 2:2946f9eefcae 314 dy12 = y2 - y1;
skydarc 2:2946f9eefcae 315 int32_t
skydarc 2:2946f9eefcae 316 sa = 0,
skydarc 2:2946f9eefcae 317 sb = 0;
skydarc 2:2946f9eefcae 318
skydarc 2:2946f9eefcae 319 // For upper part of triangle, find scanline crossings for segments
skydarc 2:2946f9eefcae 320 // 0-1 and 0-2. If y1=y2 (flat-bottomed triangle), the scanline y1
skydarc 2:2946f9eefcae 321 // is included here (and second loop will be skipped, avoiding a /0
skydarc 2:2946f9eefcae 322 // error there), otherwise scanline y1 is skipped here and handled
skydarc 2:2946f9eefcae 323 // in the second loop...which also avoids a /0 error here if y0=y1
skydarc 2:2946f9eefcae 324 // (flat-topped triangle).
skydarc 2:2946f9eefcae 325 if(y1 == y2) last = y1; // Include y1 scanline
skydarc 2:2946f9eefcae 326 else last = y1-1; // Skip it
skydarc 2:2946f9eefcae 327
skydarc 2:2946f9eefcae 328 for(y=y0; y<=last; y++) {
skydarc 2:2946f9eefcae 329 a = x0 + sa / dy01;
skydarc 2:2946f9eefcae 330 b = x0 + sb / dy02;
skydarc 2:2946f9eefcae 331 sa += dx01;
skydarc 2:2946f9eefcae 332 sb += dx02;
skydarc 2:2946f9eefcae 333 /* longhand:
skydarc 2:2946f9eefcae 334 a = x0 + (x1 - x0) * (y - y0) / (y1 - y0);
skydarc 2:2946f9eefcae 335 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
skydarc 2:2946f9eefcae 336 */
skydarc 2:2946f9eefcae 337 if(a > b) swap(a,b);
skydarc 2:2946f9eefcae 338 drawFastHLine(a, y, b-a+1, color);
skydarc 2:2946f9eefcae 339 }
skydarc 2:2946f9eefcae 340
skydarc 2:2946f9eefcae 341 // For lower part of triangle, find scanline crossings for segments
skydarc 2:2946f9eefcae 342 // 0-2 and 1-2. This loop is skipped if y1=y2.
skydarc 2:2946f9eefcae 343 sa = dx12 * (y - y1);
skydarc 2:2946f9eefcae 344 sb = dx02 * (y - y0);
skydarc 2:2946f9eefcae 345 for(; y<=y2; y++) {
skydarc 2:2946f9eefcae 346 a = x1 + sa / dy12;
skydarc 2:2946f9eefcae 347 b = x0 + sb / dy02;
skydarc 2:2946f9eefcae 348 sa += dx12;
skydarc 2:2946f9eefcae 349 sb += dx02;
skydarc 2:2946f9eefcae 350 /* longhand:
skydarc 2:2946f9eefcae 351 a = x1 + (x2 - x1) * (y - y1) / (y2 - y1);
skydarc 2:2946f9eefcae 352 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
skydarc 2:2946f9eefcae 353 */
skydarc 2:2946f9eefcae 354 if(a > b) swap(a,b);
skydarc 2:2946f9eefcae 355 drawFastHLine(a, y, b-a+1, color);
skydarc 2:2946f9eefcae 356 }
skydarc 2:2946f9eefcae 357 }
skydarc 2:2946f9eefcae 358
skydarc 2:2946f9eefcae 359 void GFX::drawBitmap(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 360 const uint8_t *bitmap, int16_t w, int16_t h,
skydarc 2:2946f9eefcae 361 uint16_t color) {
skydarc 2:2946f9eefcae 362
skydarc 2:2946f9eefcae 363 int16_t i, j, byteWidth = (w + 7) / 8;
skydarc 2:2946f9eefcae 364
skydarc 2:2946f9eefcae 365 for(j=0; j<h; j++) {
skydarc 2:2946f9eefcae 366 for(i=0; i<w; i++ ) {
skydarc 2:2946f9eefcae 367 if(pgm_read_byte(bitmap + j * byteWidth + i / 8) & (128 >> (i & 7))) {
skydarc 2:2946f9eefcae 368 drawPixel(x+i, y+j, color);
skydarc 2:2946f9eefcae 369 }
skydarc 2:2946f9eefcae 370 }
skydarc 2:2946f9eefcae 371 }
skydarc 2:2946f9eefcae 372 }
skydarc 2:2946f9eefcae 373
skydarc 2:2946f9eefcae 374 // Draw a 1-bit color bitmap at the specified x, y position from the
skydarc 2:2946f9eefcae 375 // provided bitmap buffer (must be PROGMEM memory) using color as the
skydarc 2:2946f9eefcae 376 // foreground color and bg as the background color.
skydarc 2:2946f9eefcae 377 void GFX::drawBitmap(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 378 const uint8_t *bitmap, int16_t w, int16_t h,
skydarc 2:2946f9eefcae 379 uint16_t color, uint16_t bg) {
skydarc 2:2946f9eefcae 380
skydarc 2:2946f9eefcae 381 int16_t i, j, byteWidth = (w + 7) / 8;
skydarc 2:2946f9eefcae 382
skydarc 2:2946f9eefcae 383 for(j=0; j<h; j++) {
skydarc 2:2946f9eefcae 384 for(i=0; i<w; i++ ) {
skydarc 2:2946f9eefcae 385 if(pgm_read_byte(bitmap + j * byteWidth + i / 8) & (128 >> (i & 7))) {
skydarc 2:2946f9eefcae 386 drawPixel(x+i, y+j, color);
skydarc 2:2946f9eefcae 387 }
skydarc 2:2946f9eefcae 388 else {
skydarc 2:2946f9eefcae 389 drawPixel(x+i, y+j, bg);
skydarc 2:2946f9eefcae 390 }
skydarc 2:2946f9eefcae 391 }
skydarc 2:2946f9eefcae 392 }
skydarc 2:2946f9eefcae 393 }
skydarc 2:2946f9eefcae 394
skydarc 2:2946f9eefcae 395 //Draw XBitMap Files (*.xbm), exported from GIMP,
skydarc 2:2946f9eefcae 396 //Usage: Export from GIMP to *.xbm, rename *.xbm to *.c and open in editor.
skydarc 2:2946f9eefcae 397 //C Array can be directly used with this function
skydarc 2:2946f9eefcae 398 void GFX::drawXBitmap(int16_t x, int16_t y,
skydarc 2:2946f9eefcae 399 const uint8_t *bitmap, int16_t w, int16_t h,
skydarc 2:2946f9eefcae 400 uint16_t color) {
skydarc 2:2946f9eefcae 401
skydarc 2:2946f9eefcae 402 int16_t i, j, byteWidth = (w + 7) / 8;
skydarc 2:2946f9eefcae 403
skydarc 2:2946f9eefcae 404 for(j=0; j<h; j++) {
skydarc 2:2946f9eefcae 405 for(i=0; i<w; i++ ) {
skydarc 2:2946f9eefcae 406 if(pgm_read_byte(bitmap + j * byteWidth + i / 8) & (1 << (i % 8))) {
skydarc 2:2946f9eefcae 407 drawPixel(x+i, y+j, color);
skydarc 2:2946f9eefcae 408 }
skydarc 2:2946f9eefcae 409 }
skydarc 2:2946f9eefcae 410 }
skydarc 2:2946f9eefcae 411 }
skydarc 2:2946f9eefcae 412
skydarc 2:2946f9eefcae 413
skydarc 2:2946f9eefcae 414 uint8_t GFX::write(uint8_t c) {
skydarc 2:2946f9eefcae 415
skydarc 2:2946f9eefcae 416 if (c == '\n') {
skydarc 2:2946f9eefcae 417 cursor_y += textsize*8;
skydarc 2:2946f9eefcae 418 cursor_x = 0;
skydarc 2:2946f9eefcae 419 } else if (c == '\r') {
skydarc 2:2946f9eefcae 420 // skip em
skydarc 2:2946f9eefcae 421 } else {
skydarc 2:2946f9eefcae 422 drawChar(cursor_x, cursor_y, c, textcolor, textbgcolor, textsize);
skydarc 2:2946f9eefcae 423 cursor_x += textsize*6;
skydarc 2:2946f9eefcae 424 if (wrap && (cursor_x > (_width - textsize*6))) {
skydarc 2:2946f9eefcae 425 cursor_y += textsize*8;
skydarc 2:2946f9eefcae 426 cursor_x = 0;
skydarc 2:2946f9eefcae 427 }
skydarc 2:2946f9eefcae 428 }
skydarc 2:2946f9eefcae 429
skydarc 2:2946f9eefcae 430 return 1;
skydarc 2:2946f9eefcae 431
skydarc 2:2946f9eefcae 432 }
skydarc 2:2946f9eefcae 433
skydarc 2:2946f9eefcae 434 // Draw a character
skydarc 2:2946f9eefcae 435 void GFX::drawChar(int16_t x, int16_t y, unsigned char c,
skydarc 2:2946f9eefcae 436 uint16_t color, uint16_t bg, uint8_t size) {
skydarc 2:2946f9eefcae 437
skydarc 2:2946f9eefcae 438 if((x >= _width) || // Clip right
skydarc 2:2946f9eefcae 439 (y >= _height) || // Clip bottom
skydarc 2:2946f9eefcae 440 ((x + 6 * size - 1) < 0) || // Clip left
skydarc 2:2946f9eefcae 441 ((y + 8 * size - 1) < 0)) // Clip top
skydarc 2:2946f9eefcae 442 return;
skydarc 2:2946f9eefcae 443
skydarc 2:2946f9eefcae 444 for (int8_t i=0; i<6; i++ ) {
skydarc 2:2946f9eefcae 445 uint8_t line;
skydarc 2:2946f9eefcae 446 if (i == 5)
skydarc 2:2946f9eefcae 447 line = 0x0;
skydarc 2:2946f9eefcae 448 else
skydarc 2:2946f9eefcae 449 line = pgm_read_byte(font+(c*5)+i);
skydarc 2:2946f9eefcae 450 for (int8_t j = 0; j<8; j++) {
skydarc 2:2946f9eefcae 451 if (line & 0x1) {
skydarc 2:2946f9eefcae 452 if (size == 1) // default size
skydarc 2:2946f9eefcae 453 drawPixel(x+i, y+j, color);
skydarc 2:2946f9eefcae 454 else { // big size
skydarc 2:2946f9eefcae 455 fillRect(x+(i*size), y+(j*size), size, size, color);
skydarc 2:2946f9eefcae 456 }
skydarc 2:2946f9eefcae 457 } else if (bg != color) {
skydarc 2:2946f9eefcae 458 if (size == 1) // default size
skydarc 2:2946f9eefcae 459 drawPixel(x+i, y+j, bg);
skydarc 2:2946f9eefcae 460 else { // big size
skydarc 2:2946f9eefcae 461 fillRect(x+i*size, y+j*size, size, size, bg);
skydarc 2:2946f9eefcae 462 }
skydarc 2:2946f9eefcae 463 }
skydarc 2:2946f9eefcae 464 line >>= 1;
skydarc 2:2946f9eefcae 465 }
skydarc 2:2946f9eefcae 466 }
skydarc 2:2946f9eefcae 467 }
skydarc 2:2946f9eefcae 468
skydarc 2:2946f9eefcae 469 void GFX::setCursor(int16_t x, int16_t y) {
skydarc 2:2946f9eefcae 470 cursor_x = x;
skydarc 2:2946f9eefcae 471 cursor_y = y;
skydarc 2:2946f9eefcae 472 }
skydarc 2:2946f9eefcae 473
skydarc 2:2946f9eefcae 474 void GFX::setTextSize(uint8_t s) {
skydarc 2:2946f9eefcae 475 textsize = (s > 0) ? s : 1;
skydarc 2:2946f9eefcae 476 }
skydarc 2:2946f9eefcae 477
skydarc 2:2946f9eefcae 478 void GFX::setTextColor(uint16_t c) {
skydarc 2:2946f9eefcae 479 // For 'transparent' background, we'll set the bg
skydarc 2:2946f9eefcae 480 // to the same as fg instead of using a flag
skydarc 2:2946f9eefcae 481 textcolor = textbgcolor = c;
skydarc 2:2946f9eefcae 482 }
skydarc 2:2946f9eefcae 483
skydarc 2:2946f9eefcae 484 void GFX::setTextColor(uint16_t c, uint16_t b) {
skydarc 2:2946f9eefcae 485 textcolor = c;
skydarc 2:2946f9eefcae 486 textbgcolor = b;
skydarc 2:2946f9eefcae 487 }
skydarc 2:2946f9eefcae 488
skydarc 2:2946f9eefcae 489 void GFX::setTextWrap(bool w) {
skydarc 2:2946f9eefcae 490 wrap = w;
skydarc 2:2946f9eefcae 491 }
skydarc 2:2946f9eefcae 492
skydarc 2:2946f9eefcae 493 uint8_t GFX::getRotation(void) const {
skydarc 2:2946f9eefcae 494 return rotation;
skydarc 2:2946f9eefcae 495 }
skydarc 2:2946f9eefcae 496
skydarc 2:2946f9eefcae 497 void GFX::setRotation(uint8_t x) {
skydarc 2:2946f9eefcae 498 rotation = (x & 3);
skydarc 2:2946f9eefcae 499 switch(rotation) {
skydarc 2:2946f9eefcae 500 case 0:
skydarc 2:2946f9eefcae 501 case 2:
skydarc 2:2946f9eefcae 502 _width = WIDTH;
skydarc 2:2946f9eefcae 503 _height = HEIGHT;
skydarc 2:2946f9eefcae 504 break;
skydarc 2:2946f9eefcae 505 case 1:
skydarc 2:2946f9eefcae 506 case 3:
skydarc 2:2946f9eefcae 507 _width = HEIGHT;
skydarc 2:2946f9eefcae 508 _height = WIDTH;
skydarc 2:2946f9eefcae 509 break;
skydarc 2:2946f9eefcae 510 }
skydarc 2:2946f9eefcae 511 }
skydarc 2:2946f9eefcae 512
skydarc 2:2946f9eefcae 513 // Return the size of the display (per current rotation)
skydarc 2:2946f9eefcae 514 int16_t GFX::width(void) const {
skydarc 2:2946f9eefcae 515 return _width;
skydarc 2:2946f9eefcae 516 }
skydarc 2:2946f9eefcae 517
skydarc 2:2946f9eefcae 518 int16_t GFX::height(void) const {
skydarc 2:2946f9eefcae 519 return _height;
skydarc 2:2946f9eefcae 520 }
skydarc 2:2946f9eefcae 521
skydarc 2:2946f9eefcae 522 void GFX::invertDisplay(bool i) {
skydarc 2:2946f9eefcae 523 // Do nothing, must be subclassed if supported
skydarc 2:2946f9eefcae 524 }
skydarc 2:2946f9eefcae 525
skydarc 2:2946f9eefcae 526
skydarc 2:2946f9eefcae 527 //Methods from Print.cpp Arduino
skydarc 2:2946f9eefcae 528
skydarc 2:2946f9eefcae 529 uint8_t GFX::write(const uint8_t *buffer, uint8_t size)
skydarc 2:2946f9eefcae 530 {
skydarc 2:2946f9eefcae 531 uint8_t n = 0;
skydarc 2:2946f9eefcae 532 while (size--) {
skydarc 2:2946f9eefcae 533 n += write(*buffer++);
skydarc 2:2946f9eefcae 534 }
skydarc 2:2946f9eefcae 535 return n;
skydarc 2:2946f9eefcae 536 }
skydarc 2:2946f9eefcae 537
skydarc 2:2946f9eefcae 538 uint8_t GFX::print(const char str[])
skydarc 2:2946f9eefcae 539 {
skydarc 2:2946f9eefcae 540 return write(str);
skydarc 2:2946f9eefcae 541 }
skydarc 2:2946f9eefcae 542
skydarc 2:2946f9eefcae 543 uint8_t GFX::print(char c)
skydarc 2:2946f9eefcae 544 {
skydarc 2:2946f9eefcae 545 return write(c);
skydarc 2:2946f9eefcae 546 }
skydarc 2:2946f9eefcae 547
skydarc 2:2946f9eefcae 548 uint8_t GFX::print(unsigned char b, int base)
skydarc 2:2946f9eefcae 549 {
skydarc 2:2946f9eefcae 550 return print((unsigned long) b, base);
skydarc 2:2946f9eefcae 551 }
skydarc 2:2946f9eefcae 552
skydarc 2:2946f9eefcae 553 uint8_t GFX::print(int n, int base)
skydarc 2:2946f9eefcae 554 {
skydarc 2:2946f9eefcae 555 return print((long) n, base);
skydarc 2:2946f9eefcae 556 }
skydarc 2:2946f9eefcae 557
skydarc 2:2946f9eefcae 558 uint8_t GFX::print(unsigned int n, int base)
skydarc 2:2946f9eefcae 559 {
skydarc 2:2946f9eefcae 560 return print((unsigned long) n, base);
skydarc 2:2946f9eefcae 561 }
skydarc 2:2946f9eefcae 562
skydarc 2:2946f9eefcae 563 uint8_t GFX::print(long n, int base)
skydarc 2:2946f9eefcae 564 {
skydarc 2:2946f9eefcae 565 if (base == 0) {
skydarc 2:2946f9eefcae 566 return write(n);
skydarc 2:2946f9eefcae 567 } else if (base == 10) {
skydarc 2:2946f9eefcae 568 if (n < 0) {
skydarc 2:2946f9eefcae 569 int t = print('-');
skydarc 2:2946f9eefcae 570 n = -n;
skydarc 2:2946f9eefcae 571 return printNumber(n, 10) + t;
skydarc 2:2946f9eefcae 572 }
skydarc 2:2946f9eefcae 573 return printNumber(n, 10);
skydarc 2:2946f9eefcae 574 } else {
skydarc 2:2946f9eefcae 575 return printNumber(n, base);
skydarc 2:2946f9eefcae 576 }
skydarc 2:2946f9eefcae 577 }
skydarc 2:2946f9eefcae 578
skydarc 2:2946f9eefcae 579 uint8_t GFX::print(unsigned long n, int base)
skydarc 2:2946f9eefcae 580 {
skydarc 2:2946f9eefcae 581 if (base == 0) return write(n);
skydarc 2:2946f9eefcae 582 else return printNumber(n, base);
skydarc 2:2946f9eefcae 583 }
skydarc 2:2946f9eefcae 584
skydarc 2:2946f9eefcae 585 uint8_t GFX::print(double n, int digits)
skydarc 2:2946f9eefcae 586 {
skydarc 2:2946f9eefcae 587 return printFloat(n, digits);
skydarc 2:2946f9eefcae 588 }
skydarc 2:2946f9eefcae 589
skydarc 2:2946f9eefcae 590
skydarc 2:2946f9eefcae 591
skydarc 2:2946f9eefcae 592
skydarc 2:2946f9eefcae 593
skydarc 2:2946f9eefcae 594 uint8_t GFX::println(void)
skydarc 2:2946f9eefcae 595 {
skydarc 2:2946f9eefcae 596 size_t n = print('\r');
skydarc 2:2946f9eefcae 597 n += print('\n');
skydarc 2:2946f9eefcae 598 return n;
skydarc 2:2946f9eefcae 599 }
skydarc 2:2946f9eefcae 600
skydarc 2:2946f9eefcae 601
skydarc 2:2946f9eefcae 602
skydarc 2:2946f9eefcae 603 uint8_t GFX::println(const char c[])
skydarc 2:2946f9eefcae 604 {
skydarc 2:2946f9eefcae 605 size_t n = print(c);
skydarc 2:2946f9eefcae 606 n += println();
skydarc 2:2946f9eefcae 607 return n;
skydarc 2:2946f9eefcae 608 }
skydarc 2:2946f9eefcae 609
skydarc 2:2946f9eefcae 610 uint8_t GFX::println(char c)
skydarc 2:2946f9eefcae 611 {
skydarc 2:2946f9eefcae 612 size_t n = print(c);
skydarc 2:2946f9eefcae 613 n += println();
skydarc 2:2946f9eefcae 614 return n;
skydarc 2:2946f9eefcae 615 }
skydarc 2:2946f9eefcae 616
skydarc 2:2946f9eefcae 617 uint8_t GFX::println(unsigned char b, int numBase)
skydarc 2:2946f9eefcae 618 {
skydarc 2:2946f9eefcae 619 size_t n = print(b, numBase);
skydarc 2:2946f9eefcae 620 n += println();
skydarc 2:2946f9eefcae 621 return n;
skydarc 2:2946f9eefcae 622 }
skydarc 2:2946f9eefcae 623
skydarc 2:2946f9eefcae 624 uint8_t GFX::println(int num, int base)
skydarc 2:2946f9eefcae 625 {
skydarc 2:2946f9eefcae 626 size_t n = print(num, base);
skydarc 2:2946f9eefcae 627 n += println();
skydarc 2:2946f9eefcae 628 return n;
skydarc 2:2946f9eefcae 629 }
skydarc 2:2946f9eefcae 630
skydarc 2:2946f9eefcae 631 uint8_t GFX::println(unsigned int num, int base)
skydarc 2:2946f9eefcae 632 {
skydarc 2:2946f9eefcae 633 size_t n = print(num, base);
skydarc 2:2946f9eefcae 634 n += println();
skydarc 2:2946f9eefcae 635 return n;
skydarc 2:2946f9eefcae 636 }
skydarc 2:2946f9eefcae 637
skydarc 2:2946f9eefcae 638 uint8_t GFX::println(long num, int base)
skydarc 2:2946f9eefcae 639 {
skydarc 2:2946f9eefcae 640 size_t n = print(num, base);
skydarc 2:2946f9eefcae 641 n += println();
skydarc 2:2946f9eefcae 642 return n;
skydarc 2:2946f9eefcae 643 }
skydarc 2:2946f9eefcae 644
skydarc 2:2946f9eefcae 645 uint8_t GFX::println(unsigned long num, int base)
skydarc 2:2946f9eefcae 646 {
skydarc 2:2946f9eefcae 647 size_t n = print(num, base);
skydarc 2:2946f9eefcae 648 n += println();
skydarc 2:2946f9eefcae 649 return n;
skydarc 2:2946f9eefcae 650 }
skydarc 2:2946f9eefcae 651
skydarc 2:2946f9eefcae 652 uint8_t GFX::println(double num, int digits)
skydarc 2:2946f9eefcae 653 {
skydarc 2:2946f9eefcae 654 size_t n = print(num, digits);
skydarc 2:2946f9eefcae 655 n += println();
skydarc 2:2946f9eefcae 656 return n;
skydarc 2:2946f9eefcae 657 }
skydarc 2:2946f9eefcae 658
skydarc 2:2946f9eefcae 659
skydarc 2:2946f9eefcae 660
skydarc 2:2946f9eefcae 661 // Private Methods /////////////////////////////////////////////////////////////
skydarc 2:2946f9eefcae 662
skydarc 2:2946f9eefcae 663 uint8_t GFX::printNumber(unsigned long n, uint8_t base) {
skydarc 2:2946f9eefcae 664 char buf[8 * sizeof(long) + 1]; // Assumes 8-bit chars plus zero byte.
skydarc 2:2946f9eefcae 665 char *str = &buf[sizeof(buf) - 1];
skydarc 2:2946f9eefcae 666
skydarc 2:2946f9eefcae 667 *str = '\0';
skydarc 2:2946f9eefcae 668
skydarc 2:2946f9eefcae 669 // prevent crash if called with base == 1
skydarc 2:2946f9eefcae 670 if (base < 2) base = 10;
skydarc 2:2946f9eefcae 671
skydarc 2:2946f9eefcae 672 do {
skydarc 2:2946f9eefcae 673 unsigned long m = n;
skydarc 2:2946f9eefcae 674 n /= base;
skydarc 2:2946f9eefcae 675 char c = m - base * n;
skydarc 2:2946f9eefcae 676 *--str = c < 10 ? c + '0' : c + 'A' - 10;
skydarc 2:2946f9eefcae 677 } while(n);
skydarc 2:2946f9eefcae 678
skydarc 2:2946f9eefcae 679 return write(str);
skydarc 2:2946f9eefcae 680 }
skydarc 2:2946f9eefcae 681
skydarc 2:2946f9eefcae 682 uint8_t GFX::printFloat(double number, uint8_t digits)
skydarc 2:2946f9eefcae 683 {
skydarc 2:2946f9eefcae 684 uint8_t n = 0;
skydarc 2:2946f9eefcae 685
skydarc 2:2946f9eefcae 686 if (isnan(number)) return print("nan");
skydarc 2:2946f9eefcae 687 if (isinf(number)) return print("inf");
skydarc 2:2946f9eefcae 688 if (number > 4294967040.0) return print ("ovf"); // constant determined empirically
skydarc 2:2946f9eefcae 689 if (number <-4294967040.0) return print ("ovf"); // constant determined empirically
skydarc 2:2946f9eefcae 690
skydarc 2:2946f9eefcae 691 // Handle negative numbers
skydarc 2:2946f9eefcae 692 if (number < 0.0)
skydarc 2:2946f9eefcae 693 {
skydarc 2:2946f9eefcae 694 n += print('-');
skydarc 2:2946f9eefcae 695 number = -number;
skydarc 2:2946f9eefcae 696 }
skydarc 2:2946f9eefcae 697
skydarc 2:2946f9eefcae 698 // Round correctly so that print(1.999, 2) prints as "2.00"
skydarc 2:2946f9eefcae 699 double rounding = 0.5;
skydarc 2:2946f9eefcae 700 for (uint8_t i=0; i<digits; ++i)
skydarc 2:2946f9eefcae 701 rounding /= 10.0;
skydarc 2:2946f9eefcae 702
skydarc 2:2946f9eefcae 703 number += rounding;
skydarc 2:2946f9eefcae 704
skydarc 2:2946f9eefcae 705 // Extract the integer part of the number and print it
skydarc 2:2946f9eefcae 706 unsigned long int_part = (unsigned long)number;
skydarc 2:2946f9eefcae 707 double remainder = number - (double)int_part;
skydarc 2:2946f9eefcae 708 n += print(int_part);
skydarc 2:2946f9eefcae 709
skydarc 2:2946f9eefcae 710 // Print the decimal point, but only if there are digits beyond
skydarc 2:2946f9eefcae 711 if (digits > 0) {
skydarc 2:2946f9eefcae 712 n += print(".");
skydarc 2:2946f9eefcae 713 }
skydarc 2:2946f9eefcae 714
skydarc 2:2946f9eefcae 715 // Extract digits from the remainder one at a time
skydarc 2:2946f9eefcae 716 while (digits-- > 0)
skydarc 2:2946f9eefcae 717 {
skydarc 2:2946f9eefcae 718 remainder *= 10.0;
skydarc 2:2946f9eefcae 719 int toPrint = int(remainder);
skydarc 2:2946f9eefcae 720 n += print(toPrint);
skydarc 2:2946f9eefcae 721 remainder -= toPrint;
skydarc 2:2946f9eefcae 722 }
skydarc 2:2946f9eefcae 723
skydarc 2:2946f9eefcae 724 return n;
skydarc 2:2946f9eefcae 725 }
skydarc 2:2946f9eefcae 726
skydarc 2:2946f9eefcae 727