heart rate mesuarement

Dependencies:   mbed USBDevice

Committer:
zmoutaou
Date:
Fri Jan 24 11:16:30 2020 +0000
Revision:
2:515e6791dfe2
Pulse sensor

Who changed what in which revision?

UserRevisionLine numberNew contents of line
zmoutaou 2:515e6791dfe2 1 /***********************************
zmoutaou 2:515e6791dfe2 2 This is a our graphics core library, for all our displays.
zmoutaou 2:515e6791dfe2 3 We'll be adapting all the
zmoutaou 2:515e6791dfe2 4 existing libaries to use this core to make updating, support
zmoutaou 2:515e6791dfe2 5 and upgrading easier!
zmoutaou 2:515e6791dfe2 6
zmoutaou 2:515e6791dfe2 7 Adafruit invests time and resources providing this open source code,
zmoutaou 2:515e6791dfe2 8 please support Adafruit and open-source hardware by purchasing
zmoutaou 2:515e6791dfe2 9 products from Adafruit!
zmoutaou 2:515e6791dfe2 10
zmoutaou 2:515e6791dfe2 11 Written by Limor Fried/Ladyada for Adafruit Industries.
zmoutaou 2:515e6791dfe2 12 BSD license, check license.txt for more information
zmoutaou 2:515e6791dfe2 13 All text above must be included in any redistribution
zmoutaou 2:515e6791dfe2 14 ****************************************/
zmoutaou 2:515e6791dfe2 15
zmoutaou 2:515e6791dfe2 16 /*
zmoutaou 2:515e6791dfe2 17 * Modified by Neal Horman 7/14/2012 for use in mbed
zmoutaou 2:515e6791dfe2 18 */
zmoutaou 2:515e6791dfe2 19
zmoutaou 2:515e6791dfe2 20 #include "mbed.h"
zmoutaou 2:515e6791dfe2 21
zmoutaou 2:515e6791dfe2 22 #include "Adafruit_GFX.h"
zmoutaou 2:515e6791dfe2 23 #include "glcdfont.h"
zmoutaou 2:515e6791dfe2 24
zmoutaou 2:515e6791dfe2 25 #if defined(GFX_WANT_ABSTRACTS)
zmoutaou 2:515e6791dfe2 26 // draw a circle outline
zmoutaou 2:515e6791dfe2 27 void Adafruit_GFX::drawCircle(int16_t x0, int16_t y0, int16_t r, uint16_t color)
zmoutaou 2:515e6791dfe2 28 {
zmoutaou 2:515e6791dfe2 29 int16_t f = 1 - r;
zmoutaou 2:515e6791dfe2 30 int16_t ddF_x = 1;
zmoutaou 2:515e6791dfe2 31 int16_t ddF_y = -2 * r;
zmoutaou 2:515e6791dfe2 32 int16_t x = 0;
zmoutaou 2:515e6791dfe2 33 int16_t y = r;
zmoutaou 2:515e6791dfe2 34
zmoutaou 2:515e6791dfe2 35 drawPixel(x0, y0+r, color);
zmoutaou 2:515e6791dfe2 36 drawPixel(x0, y0-r, color);
zmoutaou 2:515e6791dfe2 37 drawPixel(x0+r, y0, color);
zmoutaou 2:515e6791dfe2 38 drawPixel(x0-r, y0, color);
zmoutaou 2:515e6791dfe2 39
zmoutaou 2:515e6791dfe2 40 while (x<y)
zmoutaou 2:515e6791dfe2 41 {
zmoutaou 2:515e6791dfe2 42 if (f >= 0)
zmoutaou 2:515e6791dfe2 43 {
zmoutaou 2:515e6791dfe2 44 y--;
zmoutaou 2:515e6791dfe2 45 ddF_y += 2;
zmoutaou 2:515e6791dfe2 46 f += ddF_y;
zmoutaou 2:515e6791dfe2 47 }
zmoutaou 2:515e6791dfe2 48 x++;
zmoutaou 2:515e6791dfe2 49 ddF_x += 2;
zmoutaou 2:515e6791dfe2 50 f += ddF_x;
zmoutaou 2:515e6791dfe2 51
zmoutaou 2:515e6791dfe2 52 drawPixel(x0 + x, y0 + y, color);
zmoutaou 2:515e6791dfe2 53 drawPixel(x0 - x, y0 + y, color);
zmoutaou 2:515e6791dfe2 54 drawPixel(x0 + x, y0 - y, color);
zmoutaou 2:515e6791dfe2 55 drawPixel(x0 - x, y0 - y, color);
zmoutaou 2:515e6791dfe2 56 drawPixel(x0 + y, y0 + x, color);
zmoutaou 2:515e6791dfe2 57 drawPixel(x0 - y, y0 + x, color);
zmoutaou 2:515e6791dfe2 58 drawPixel(x0 + y, y0 - x, color);
zmoutaou 2:515e6791dfe2 59 drawPixel(x0 - y, y0 - x, color);
zmoutaou 2:515e6791dfe2 60 }
zmoutaou 2:515e6791dfe2 61 }
zmoutaou 2:515e6791dfe2 62
zmoutaou 2:515e6791dfe2 63 void Adafruit_GFX::drawCircleHelper( int16_t x0, int16_t y0, int16_t r, uint8_t cornername, uint16_t color)
zmoutaou 2:515e6791dfe2 64 {
zmoutaou 2:515e6791dfe2 65 int16_t f = 1 - r;
zmoutaou 2:515e6791dfe2 66 int16_t ddF_x = 1;
zmoutaou 2:515e6791dfe2 67 int16_t ddF_y = -2 * r;
zmoutaou 2:515e6791dfe2 68 int16_t x = 0;
zmoutaou 2:515e6791dfe2 69 int16_t y = r;
zmoutaou 2:515e6791dfe2 70
zmoutaou 2:515e6791dfe2 71 while (x<y)
zmoutaou 2:515e6791dfe2 72 {
zmoutaou 2:515e6791dfe2 73 if (f >= 0)
zmoutaou 2:515e6791dfe2 74 {
zmoutaou 2:515e6791dfe2 75 y--;
zmoutaou 2:515e6791dfe2 76 ddF_y += 2;
zmoutaou 2:515e6791dfe2 77 f += ddF_y;
zmoutaou 2:515e6791dfe2 78 }
zmoutaou 2:515e6791dfe2 79 x++;
zmoutaou 2:515e6791dfe2 80 ddF_x += 2;
zmoutaou 2:515e6791dfe2 81 f += ddF_x;
zmoutaou 2:515e6791dfe2 82
zmoutaou 2:515e6791dfe2 83 if (cornername & 0x4)
zmoutaou 2:515e6791dfe2 84 {
zmoutaou 2:515e6791dfe2 85 drawPixel(x0 + x, y0 + y, color);
zmoutaou 2:515e6791dfe2 86 drawPixel(x0 + y, y0 + x, color);
zmoutaou 2:515e6791dfe2 87 }
zmoutaou 2:515e6791dfe2 88
zmoutaou 2:515e6791dfe2 89 if (cornername & 0x2)
zmoutaou 2:515e6791dfe2 90 {
zmoutaou 2:515e6791dfe2 91 drawPixel(x0 + x, y0 - y, color);
zmoutaou 2:515e6791dfe2 92 drawPixel(x0 + y, y0 - x, color);
zmoutaou 2:515e6791dfe2 93 }
zmoutaou 2:515e6791dfe2 94
zmoutaou 2:515e6791dfe2 95 if (cornername & 0x8)
zmoutaou 2:515e6791dfe2 96 {
zmoutaou 2:515e6791dfe2 97 drawPixel(x0 - y, y0 + x, color);
zmoutaou 2:515e6791dfe2 98 drawPixel(x0 - x, y0 + y, color);
zmoutaou 2:515e6791dfe2 99 }
zmoutaou 2:515e6791dfe2 100
zmoutaou 2:515e6791dfe2 101 if (cornername & 0x1)
zmoutaou 2:515e6791dfe2 102 {
zmoutaou 2:515e6791dfe2 103 drawPixel(x0 - y, y0 - x, color);
zmoutaou 2:515e6791dfe2 104 drawPixel(x0 - x, y0 - y, color);
zmoutaou 2:515e6791dfe2 105 }
zmoutaou 2:515e6791dfe2 106 }
zmoutaou 2:515e6791dfe2 107 }
zmoutaou 2:515e6791dfe2 108
zmoutaou 2:515e6791dfe2 109 void Adafruit_GFX::fillCircle(int16_t x0, int16_t y0, int16_t r, uint16_t color)
zmoutaou 2:515e6791dfe2 110 {
zmoutaou 2:515e6791dfe2 111 drawFastVLine(x0, y0-r, 2*r+1, color);
zmoutaou 2:515e6791dfe2 112 fillCircleHelper(x0, y0, r, 3, 0, color);
zmoutaou 2:515e6791dfe2 113 }
zmoutaou 2:515e6791dfe2 114
zmoutaou 2:515e6791dfe2 115 // used to do circles and roundrects!
zmoutaou 2:515e6791dfe2 116 void Adafruit_GFX::fillCircleHelper(int16_t x0, int16_t y0, int16_t r, uint8_t cornername, int16_t delta, uint16_t color)
zmoutaou 2:515e6791dfe2 117 {
zmoutaou 2:515e6791dfe2 118 int16_t f = 1 - r;
zmoutaou 2:515e6791dfe2 119 int16_t ddF_x = 1;
zmoutaou 2:515e6791dfe2 120 int16_t ddF_y = -2 * r;
zmoutaou 2:515e6791dfe2 121 int16_t x = 0;
zmoutaou 2:515e6791dfe2 122 int16_t y = r;
zmoutaou 2:515e6791dfe2 123
zmoutaou 2:515e6791dfe2 124 while (x<y)
zmoutaou 2:515e6791dfe2 125 {
zmoutaou 2:515e6791dfe2 126 if (f >= 0)
zmoutaou 2:515e6791dfe2 127 {
zmoutaou 2:515e6791dfe2 128 y--;
zmoutaou 2:515e6791dfe2 129 ddF_y += 2;
zmoutaou 2:515e6791dfe2 130 f += ddF_y;
zmoutaou 2:515e6791dfe2 131 }
zmoutaou 2:515e6791dfe2 132 x++;
zmoutaou 2:515e6791dfe2 133 ddF_x += 2;
zmoutaou 2:515e6791dfe2 134 f += ddF_x;
zmoutaou 2:515e6791dfe2 135
zmoutaou 2:515e6791dfe2 136 if (cornername & 0x1)
zmoutaou 2:515e6791dfe2 137 {
zmoutaou 2:515e6791dfe2 138 drawFastVLine(x0+x, y0-y, 2*y+1+delta, color);
zmoutaou 2:515e6791dfe2 139 drawFastVLine(x0+y, y0-x, 2*x+1+delta, color);
zmoutaou 2:515e6791dfe2 140 }
zmoutaou 2:515e6791dfe2 141
zmoutaou 2:515e6791dfe2 142 if (cornername & 0x2)
zmoutaou 2:515e6791dfe2 143 {
zmoutaou 2:515e6791dfe2 144 drawFastVLine(x0-x, y0-y, 2*y+1+delta, color);
zmoutaou 2:515e6791dfe2 145 drawFastVLine(x0-y, y0-x, 2*x+1+delta, color);
zmoutaou 2:515e6791dfe2 146 }
zmoutaou 2:515e6791dfe2 147 }
zmoutaou 2:515e6791dfe2 148 }
zmoutaou 2:515e6791dfe2 149 #endif
zmoutaou 2:515e6791dfe2 150
zmoutaou 2:515e6791dfe2 151 #if defined(GFX_WANT_ABSTRACTS) || defined(GFX_SIZEABLE_TEXT)
zmoutaou 2:515e6791dfe2 152 // bresenham's algorithm - thx wikpedia
zmoutaou 2:515e6791dfe2 153 void Adafruit_GFX::drawLine(int16_t x0, int16_t y0, int16_t x1, int16_t y1, uint16_t color)
zmoutaou 2:515e6791dfe2 154 {
zmoutaou 2:515e6791dfe2 155 int16_t steep = abs(y1 - y0) > abs(x1 - x0);
zmoutaou 2:515e6791dfe2 156
zmoutaou 2:515e6791dfe2 157 if (steep)
zmoutaou 2:515e6791dfe2 158 {
zmoutaou 2:515e6791dfe2 159 swap(x0, y0);
zmoutaou 2:515e6791dfe2 160 swap(x1, y1);
zmoutaou 2:515e6791dfe2 161 }
zmoutaou 2:515e6791dfe2 162
zmoutaou 2:515e6791dfe2 163 if (x0 > x1)
zmoutaou 2:515e6791dfe2 164 {
zmoutaou 2:515e6791dfe2 165 swap(x0, x1);
zmoutaou 2:515e6791dfe2 166 swap(y0, y1);
zmoutaou 2:515e6791dfe2 167 }
zmoutaou 2:515e6791dfe2 168
zmoutaou 2:515e6791dfe2 169 int16_t dx, dy;
zmoutaou 2:515e6791dfe2 170 dx = x1 - x0;
zmoutaou 2:515e6791dfe2 171 dy = abs(y1 - y0);
zmoutaou 2:515e6791dfe2 172
zmoutaou 2:515e6791dfe2 173 int16_t err = dx / 2;
zmoutaou 2:515e6791dfe2 174 int16_t ystep;
zmoutaou 2:515e6791dfe2 175
zmoutaou 2:515e6791dfe2 176 if (y0 < y1)
zmoutaou 2:515e6791dfe2 177 ystep = 1;
zmoutaou 2:515e6791dfe2 178 else
zmoutaou 2:515e6791dfe2 179 ystep = -1;
zmoutaou 2:515e6791dfe2 180
zmoutaou 2:515e6791dfe2 181 for (; x0<=x1; x0++)
zmoutaou 2:515e6791dfe2 182 {
zmoutaou 2:515e6791dfe2 183 if (steep)
zmoutaou 2:515e6791dfe2 184 drawPixel(y0, x0, color);
zmoutaou 2:515e6791dfe2 185 else
zmoutaou 2:515e6791dfe2 186 drawPixel(x0, y0, color);
zmoutaou 2:515e6791dfe2 187
zmoutaou 2:515e6791dfe2 188 err -= dy;
zmoutaou 2:515e6791dfe2 189 if (err < 0)
zmoutaou 2:515e6791dfe2 190 {
zmoutaou 2:515e6791dfe2 191 y0 += ystep;
zmoutaou 2:515e6791dfe2 192 err += dx;
zmoutaou 2:515e6791dfe2 193 }
zmoutaou 2:515e6791dfe2 194 }
zmoutaou 2:515e6791dfe2 195 }
zmoutaou 2:515e6791dfe2 196
zmoutaou 2:515e6791dfe2 197 void Adafruit_GFX::drawFastVLine(int16_t x, int16_t y, int16_t h, uint16_t color)
zmoutaou 2:515e6791dfe2 198 {
zmoutaou 2:515e6791dfe2 199 // stupidest version - update in subclasses if desired!
zmoutaou 2:515e6791dfe2 200 drawLine(x, y, x, y+h-1, color);
zmoutaou 2:515e6791dfe2 201 }
zmoutaou 2:515e6791dfe2 202
zmoutaou 2:515e6791dfe2 203 void Adafruit_GFX::fillRect(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t color)
zmoutaou 2:515e6791dfe2 204 {
zmoutaou 2:515e6791dfe2 205 // stupidest version - update in subclasses if desired!
zmoutaou 2:515e6791dfe2 206 for (int16_t i=x; i<x+w; i++)
zmoutaou 2:515e6791dfe2 207 drawFastVLine(i, y, h, color);
zmoutaou 2:515e6791dfe2 208 }
zmoutaou 2:515e6791dfe2 209 #endif
zmoutaou 2:515e6791dfe2 210
zmoutaou 2:515e6791dfe2 211 #if defined(GFX_WANT_ABSTRACTS)
zmoutaou 2:515e6791dfe2 212 // draw a rectangle
zmoutaou 2:515e6791dfe2 213 void Adafruit_GFX::drawRect(int16_t x, int16_t y, int16_t w, int16_t h, uint16_t color)
zmoutaou 2:515e6791dfe2 214 {
zmoutaou 2:515e6791dfe2 215 drawFastHLine(x, y, w, color);
zmoutaou 2:515e6791dfe2 216 drawFastHLine(x, y+h-1, w, color);
zmoutaou 2:515e6791dfe2 217 drawFastVLine(x, y, h, color);
zmoutaou 2:515e6791dfe2 218 drawFastVLine(x+w-1, y, h, color);
zmoutaou 2:515e6791dfe2 219 }
zmoutaou 2:515e6791dfe2 220
zmoutaou 2:515e6791dfe2 221 void Adafruit_GFX::drawFastHLine(int16_t x, int16_t y, int16_t w, uint16_t color)
zmoutaou 2:515e6791dfe2 222 {
zmoutaou 2:515e6791dfe2 223 // stupidest version - update in subclasses if desired!
zmoutaou 2:515e6791dfe2 224 drawLine(x, y, x+w-1, y, color);
zmoutaou 2:515e6791dfe2 225 }
zmoutaou 2:515e6791dfe2 226
zmoutaou 2:515e6791dfe2 227 void Adafruit_GFX::fillScreen(uint16_t color)
zmoutaou 2:515e6791dfe2 228 {
zmoutaou 2:515e6791dfe2 229 fillRect(0, 0, _width, _height, color);
zmoutaou 2:515e6791dfe2 230 }
zmoutaou 2:515e6791dfe2 231
zmoutaou 2:515e6791dfe2 232 // draw a rounded rectangle!
zmoutaou 2:515e6791dfe2 233 void Adafruit_GFX::drawRoundRect(int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint16_t color)
zmoutaou 2:515e6791dfe2 234 {
zmoutaou 2:515e6791dfe2 235 // smarter version
zmoutaou 2:515e6791dfe2 236 drawFastHLine(x+r , y , w-2*r, color); // Top
zmoutaou 2:515e6791dfe2 237 drawFastHLine(x+r , y+h-1, w-2*r, color); // Bottom
zmoutaou 2:515e6791dfe2 238 drawFastVLine( x , y+r , h-2*r, color); // Left
zmoutaou 2:515e6791dfe2 239 drawFastVLine( x+w-1, y+r , h-2*r, color); // Right
zmoutaou 2:515e6791dfe2 240 // draw four corners
zmoutaou 2:515e6791dfe2 241 drawCircleHelper(x+r , y+r , r, 1, color);
zmoutaou 2:515e6791dfe2 242 drawCircleHelper(x+w-r-1, y+r , r, 2, color);
zmoutaou 2:515e6791dfe2 243 drawCircleHelper(x+w-r-1, y+h-r-1, r, 4, color);
zmoutaou 2:515e6791dfe2 244 drawCircleHelper(x+r , y+h-r-1, r, 8, color);
zmoutaou 2:515e6791dfe2 245 }
zmoutaou 2:515e6791dfe2 246
zmoutaou 2:515e6791dfe2 247 // fill a rounded rectangle!
zmoutaou 2:515e6791dfe2 248 void Adafruit_GFX::fillRoundRect(int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint16_t color)
zmoutaou 2:515e6791dfe2 249 {
zmoutaou 2:515e6791dfe2 250 // smarter version
zmoutaou 2:515e6791dfe2 251 fillRect(x+r, y, w-2*r, h, color);
zmoutaou 2:515e6791dfe2 252
zmoutaou 2:515e6791dfe2 253 // draw four corners
zmoutaou 2:515e6791dfe2 254 fillCircleHelper(x+w-r-1, y+r, r, 1, h-2*r-1, color);
zmoutaou 2:515e6791dfe2 255 fillCircleHelper(x+r , y+r, r, 2, h-2*r-1, color);
zmoutaou 2:515e6791dfe2 256 }
zmoutaou 2:515e6791dfe2 257
zmoutaou 2:515e6791dfe2 258 // draw a triangle!
zmoutaou 2:515e6791dfe2 259 void Adafruit_GFX::drawTriangle(int16_t x0, int16_t y0, int16_t x1, int16_t y1, int16_t x2, int16_t y2, uint16_t color)
zmoutaou 2:515e6791dfe2 260 {
zmoutaou 2:515e6791dfe2 261 drawLine(x0, y0, x1, y1, color);
zmoutaou 2:515e6791dfe2 262 drawLine(x1, y1, x2, y2, color);
zmoutaou 2:515e6791dfe2 263 drawLine(x2, y2, x0, y0, color);
zmoutaou 2:515e6791dfe2 264 }
zmoutaou 2:515e6791dfe2 265
zmoutaou 2:515e6791dfe2 266 // fill a triangle!
zmoutaou 2:515e6791dfe2 267 void Adafruit_GFX::fillTriangle ( int16_t x0, int16_t y0, int16_t x1, int16_t y1, int16_t x2, int16_t y2, uint16_t color)
zmoutaou 2:515e6791dfe2 268 {
zmoutaou 2:515e6791dfe2 269 int16_t a, b, y, last;
zmoutaou 2:515e6791dfe2 270
zmoutaou 2:515e6791dfe2 271 // Sort coordinates by Y order (y2 >= y1 >= y0)
zmoutaou 2:515e6791dfe2 272 if (y0 > y1)
zmoutaou 2:515e6791dfe2 273 swap(y0, y1); swap(x0, x1);
zmoutaou 2:515e6791dfe2 274
zmoutaou 2:515e6791dfe2 275 if (y1 > y2)
zmoutaou 2:515e6791dfe2 276 swap(y2, y1); swap(x2, x1);
zmoutaou 2:515e6791dfe2 277
zmoutaou 2:515e6791dfe2 278 if (y0 > y1)
zmoutaou 2:515e6791dfe2 279 swap(y0, y1); swap(x0, x1);
zmoutaou 2:515e6791dfe2 280
zmoutaou 2:515e6791dfe2 281
zmoutaou 2:515e6791dfe2 282 if(y0 == y2)
zmoutaou 2:515e6791dfe2 283 { // Handle awkward all-on-same-line case as its own thing
zmoutaou 2:515e6791dfe2 284 a = b = x0;
zmoutaou 2:515e6791dfe2 285 if(x1 < a)
zmoutaou 2:515e6791dfe2 286 a = x1;
zmoutaou 2:515e6791dfe2 287 else if(x1 > b)
zmoutaou 2:515e6791dfe2 288 b = x1;
zmoutaou 2:515e6791dfe2 289
zmoutaou 2:515e6791dfe2 290 if(x2 < a)
zmoutaou 2:515e6791dfe2 291 a = x2;
zmoutaou 2:515e6791dfe2 292 else if(x2 > b) b = x2;
zmoutaou 2:515e6791dfe2 293 drawFastHLine(a, y0, b-a+1, color);
zmoutaou 2:515e6791dfe2 294 return;
zmoutaou 2:515e6791dfe2 295 }
zmoutaou 2:515e6791dfe2 296
zmoutaou 2:515e6791dfe2 297 int16_t
zmoutaou 2:515e6791dfe2 298 dx01 = x1 - x0,
zmoutaou 2:515e6791dfe2 299 dy01 = y1 - y0,
zmoutaou 2:515e6791dfe2 300 dx02 = x2 - x0,
zmoutaou 2:515e6791dfe2 301 dy02 = y2 - y0,
zmoutaou 2:515e6791dfe2 302 dx12 = x2 - x1,
zmoutaou 2:515e6791dfe2 303 dy12 = y2 - y1,
zmoutaou 2:515e6791dfe2 304 sa = 0,
zmoutaou 2:515e6791dfe2 305 sb = 0;
zmoutaou 2:515e6791dfe2 306
zmoutaou 2:515e6791dfe2 307 // For upper part of triangle, find scanline crossings for segments
zmoutaou 2:515e6791dfe2 308 // 0-1 and 0-2. If y1=y2 (flat-bottomed triangle), the scanline y1
zmoutaou 2:515e6791dfe2 309 // is included here (and second loop will be skipped, avoiding a /0
zmoutaou 2:515e6791dfe2 310 // error there), otherwise scanline y1 is skipped here and handled
zmoutaou 2:515e6791dfe2 311 // in the second loop...which also avoids a /0 error here if y0=y1
zmoutaou 2:515e6791dfe2 312 // (flat-topped triangle).
zmoutaou 2:515e6791dfe2 313 if(y1 == y2)
zmoutaou 2:515e6791dfe2 314 last = y1; // Include y1 scanline
zmoutaou 2:515e6791dfe2 315 else
zmoutaou 2:515e6791dfe2 316 last = y1-1; // Skip it
zmoutaou 2:515e6791dfe2 317
zmoutaou 2:515e6791dfe2 318 for(y=y0; y<=last; y++)
zmoutaou 2:515e6791dfe2 319 {
zmoutaou 2:515e6791dfe2 320 a = x0 + sa / dy01;
zmoutaou 2:515e6791dfe2 321 b = x0 + sb / dy02;
zmoutaou 2:515e6791dfe2 322 sa += dx01;
zmoutaou 2:515e6791dfe2 323 sb += dx02;
zmoutaou 2:515e6791dfe2 324 /* longhand:
zmoutaou 2:515e6791dfe2 325 a = x0 + (x1 - x0) * (y - y0) / (y1 - y0);
zmoutaou 2:515e6791dfe2 326 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
zmoutaou 2:515e6791dfe2 327 */
zmoutaou 2:515e6791dfe2 328 if(a > b)
zmoutaou 2:515e6791dfe2 329 swap(a,b);
zmoutaou 2:515e6791dfe2 330 drawFastHLine(a, y, b-a+1, color);
zmoutaou 2:515e6791dfe2 331 }
zmoutaou 2:515e6791dfe2 332
zmoutaou 2:515e6791dfe2 333 // For lower part of triangle, find scanline crossings for segments
zmoutaou 2:515e6791dfe2 334 // 0-2 and 1-2. This loop is skipped if y1=y2.
zmoutaou 2:515e6791dfe2 335 sa = dx12 * (y - y1);
zmoutaou 2:515e6791dfe2 336 sb = dx02 * (y - y0);
zmoutaou 2:515e6791dfe2 337 for(; y<=y2; y++)
zmoutaou 2:515e6791dfe2 338 {
zmoutaou 2:515e6791dfe2 339 a = x1 + sa / dy12;
zmoutaou 2:515e6791dfe2 340 b = x0 + sb / dy02;
zmoutaou 2:515e6791dfe2 341 sa += dx12;
zmoutaou 2:515e6791dfe2 342 sb += dx02;
zmoutaou 2:515e6791dfe2 343 /* longhand:
zmoutaou 2:515e6791dfe2 344 a = x1 + (x2 - x1) * (y - y1) / (y2 - y1);
zmoutaou 2:515e6791dfe2 345 b = x0 + (x2 - x0) * (y - y0) / (y2 - y0);
zmoutaou 2:515e6791dfe2 346 */
zmoutaou 2:515e6791dfe2 347 if(a > b)
zmoutaou 2:515e6791dfe2 348 swap(a,b);
zmoutaou 2:515e6791dfe2 349 drawFastHLine(a, y, b-a+1, color);
zmoutaou 2:515e6791dfe2 350 }
zmoutaou 2:515e6791dfe2 351 }
zmoutaou 2:515e6791dfe2 352
zmoutaou 2:515e6791dfe2 353 void Adafruit_GFX::drawBitmap(int16_t x, int16_t y, const uint8_t *bitmap, int16_t w, int16_t h, uint16_t color)
zmoutaou 2:515e6791dfe2 354 {
zmoutaou 2:515e6791dfe2 355 for (int16_t j=0; j<h; j++)
zmoutaou 2:515e6791dfe2 356 {
zmoutaou 2:515e6791dfe2 357 for (int16_t i=0; i<w; i++ )
zmoutaou 2:515e6791dfe2 358 {
zmoutaou 2:515e6791dfe2 359 if (bitmap[i + (j/8)*w] & _BV(j%8))
zmoutaou 2:515e6791dfe2 360 drawPixel(x+i, y+j, color);
zmoutaou 2:515e6791dfe2 361 }
zmoutaou 2:515e6791dfe2 362 }
zmoutaou 2:515e6791dfe2 363 }
zmoutaou 2:515e6791dfe2 364 #endif
zmoutaou 2:515e6791dfe2 365
zmoutaou 2:515e6791dfe2 366 size_t Adafruit_GFX::writeChar(uint8_t c)
zmoutaou 2:515e6791dfe2 367 {
zmoutaou 2:515e6791dfe2 368 if (c == '\n')
zmoutaou 2:515e6791dfe2 369 {
zmoutaou 2:515e6791dfe2 370 cursor_y += textsize*8;
zmoutaou 2:515e6791dfe2 371 cursor_x = 0;
zmoutaou 2:515e6791dfe2 372 }
zmoutaou 2:515e6791dfe2 373 else if (c == '\r')
zmoutaou 2:515e6791dfe2 374 cursor_x = 0;
zmoutaou 2:515e6791dfe2 375 else
zmoutaou 2:515e6791dfe2 376 {
zmoutaou 2:515e6791dfe2 377 drawChar(cursor_x, cursor_y, c, textcolor, textbgcolor, textsize);
zmoutaou 2:515e6791dfe2 378 cursor_x += textsize*6;
zmoutaou 2:515e6791dfe2 379 if (wrap && (cursor_x > (_width - textsize*6)))
zmoutaou 2:515e6791dfe2 380 {
zmoutaou 2:515e6791dfe2 381 cursor_y += textsize*8;
zmoutaou 2:515e6791dfe2 382 cursor_x = 0;
zmoutaou 2:515e6791dfe2 383 }
zmoutaou 2:515e6791dfe2 384 }
zmoutaou 2:515e6791dfe2 385 return 1;
zmoutaou 2:515e6791dfe2 386 }
zmoutaou 2:515e6791dfe2 387
zmoutaou 2:515e6791dfe2 388 // draw a character
zmoutaou 2:515e6791dfe2 389 void Adafruit_GFX::drawChar(int16_t x, int16_t y, unsigned char c, uint16_t color, uint16_t bg, uint8_t size)
zmoutaou 2:515e6791dfe2 390 {
zmoutaou 2:515e6791dfe2 391 if(
zmoutaou 2:515e6791dfe2 392 (x >= _width) || // Clip right
zmoutaou 2:515e6791dfe2 393 (y >= _height) || // Clip bottom
zmoutaou 2:515e6791dfe2 394 ((x + 5 * size - 1) < 0) || // Clip left
zmoutaou 2:515e6791dfe2 395 ((y + 8 * size - 1) < 0) // Clip top
zmoutaou 2:515e6791dfe2 396 )
zmoutaou 2:515e6791dfe2 397 return;
zmoutaou 2:515e6791dfe2 398
zmoutaou 2:515e6791dfe2 399 for (int8_t i=0; i<6; i++ )
zmoutaou 2:515e6791dfe2 400 {
zmoutaou 2:515e6791dfe2 401 uint8_t line = 0;
zmoutaou 2:515e6791dfe2 402
zmoutaou 2:515e6791dfe2 403 if (i == 5)
zmoutaou 2:515e6791dfe2 404 line = 0x0;
zmoutaou 2:515e6791dfe2 405 else
zmoutaou 2:515e6791dfe2 406 line = font[(c*5)+i];
zmoutaou 2:515e6791dfe2 407
zmoutaou 2:515e6791dfe2 408 for (int8_t j = 0; j<8; j++)
zmoutaou 2:515e6791dfe2 409 {
zmoutaou 2:515e6791dfe2 410 if (line & 0x1)
zmoutaou 2:515e6791dfe2 411 {
zmoutaou 2:515e6791dfe2 412 #if defined(GFX_WANT_ABSTRACTS) || defined(GFX_SIZEABLE_TEXT)
zmoutaou 2:515e6791dfe2 413 if (size == 1) // default size
zmoutaou 2:515e6791dfe2 414 drawPixel(x+i, y+j, color);
zmoutaou 2:515e6791dfe2 415 else // big size
zmoutaou 2:515e6791dfe2 416 fillRect(x+(i*size), y+(j*size), size, size, color);
zmoutaou 2:515e6791dfe2 417 #else
zmoutaou 2:515e6791dfe2 418 drawPixel(x+i, y+j, color);
zmoutaou 2:515e6791dfe2 419 #endif
zmoutaou 2:515e6791dfe2 420 }
zmoutaou 2:515e6791dfe2 421 else if (bg != color)
zmoutaou 2:515e6791dfe2 422 {
zmoutaou 2:515e6791dfe2 423 #if defined(GFX_WANT_ABSTRACTS) || defined(GFX_SIZEABLE_TEXT)
zmoutaou 2:515e6791dfe2 424 if (size == 1) // default size
zmoutaou 2:515e6791dfe2 425 drawPixel(x+i, y+j, bg);
zmoutaou 2:515e6791dfe2 426 else // big size
zmoutaou 2:515e6791dfe2 427 fillRect(x+i*size, y+j*size, size, size, bg);
zmoutaou 2:515e6791dfe2 428 #else
zmoutaou 2:515e6791dfe2 429 drawPixel(x+i, y+j, bg);
zmoutaou 2:515e6791dfe2 430 #endif
zmoutaou 2:515e6791dfe2 431 }
zmoutaou 2:515e6791dfe2 432 line >>= 1;
zmoutaou 2:515e6791dfe2 433 }
zmoutaou 2:515e6791dfe2 434 }
zmoutaou 2:515e6791dfe2 435 }
zmoutaou 2:515e6791dfe2 436
zmoutaou 2:515e6791dfe2 437 void Adafruit_GFX::setRotation(uint8_t x)
zmoutaou 2:515e6791dfe2 438 {
zmoutaou 2:515e6791dfe2 439 x %= 4; // cant be higher than 3
zmoutaou 2:515e6791dfe2 440 rotation = x;
zmoutaou 2:515e6791dfe2 441 switch (x)
zmoutaou 2:515e6791dfe2 442 {
zmoutaou 2:515e6791dfe2 443 case 0:
zmoutaou 2:515e6791dfe2 444 case 2:
zmoutaou 2:515e6791dfe2 445 _width = _rawWidth;
zmoutaou 2:515e6791dfe2 446 _height = _rawHeight;
zmoutaou 2:515e6791dfe2 447 break;
zmoutaou 2:515e6791dfe2 448 case 1:
zmoutaou 2:515e6791dfe2 449 case 3:
zmoutaou 2:515e6791dfe2 450 _width = _rawHeight;
zmoutaou 2:515e6791dfe2 451 _height = _rawWidth;
zmoutaou 2:515e6791dfe2 452 break;
zmoutaou 2:515e6791dfe2 453 }
zmoutaou 2:515e6791dfe2 454 }