Louis Mayencourt / Mbed OS NRFBOY

MBED NRF51 Arduboy port

abstractarduboy.cpp@1:c53e766082b4, 2017-01-06 (annotated)

Committer:
lmayencou
Date:
Fri Jan 06 22:10:20 2017 +0000
Revision:
1:c53e766082b4
Child:
2:e3ef9f476913
display circle and hello on SPI screen !

Who changed what in which revision?

UserRevisionLine numberNew contents of line
lmayencou 1:c53e766082b4 1 #include "abstractarduboy.h"
lmayencou 1:c53e766082b4 2
lmayencou 1:c53e766082b4 3 #define _BV(b) (1UL << (b))
lmayencou 1:c53e766082b4 4 #define min(a,b) (((a)<(b))?(a):(b))
lmayencou 1:c53e766082b4 5 #define max(a,b) (((a)>(b))?(a):(b))
lmayencou 1:c53e766082b4 6 #define abs(a) (((a) < 0) ? -(a) : (a))
lmayencou 1:c53e766082b4 7 #define pgm_read_byte(a) 1
lmayencou 1:c53e766082b4 8
lmayencou 1:c53e766082b4 9 AbstractArduboy::AbstractArduboy()
lmayencou 1:c53e766082b4 10 {
lmayencou 1:c53e766082b4 11 frameRate = 60;
lmayencou 1:c53e766082b4 12 frameCount = 0;
lmayencou 1:c53e766082b4 13 eachFrameMillis = 1000 / 60;
lmayencou 1:c53e766082b4 14 lastFrameStart = 0;
lmayencou 1:c53e766082b4 15 nextFrameStart = 0;
lmayencou 1:c53e766082b4 16 post_render = false;
lmayencou 1:c53e766082b4 17 lastFrameDurationMs = 0;
lmayencou 1:c53e766082b4 18
lmayencou 1:c53e766082b4 19 currentButtonState = 0;
lmayencou 1:c53e766082b4 20 previousButtonState = 0;
lmayencou 1:c53e766082b4 21
lmayencou 1:c53e766082b4 22 textcolor = WHITE;
lmayencou 1:c53e766082b4 23 textbgcolor = BLACK;
lmayencou 1:c53e766082b4 24 textsize = 1;
lmayencou 1:c53e766082b4 25 }
lmayencou 1:c53e766082b4 26
lmayencou 1:c53e766082b4 27 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 28 // default virtual function
lmayencou 1:c53e766082b4 29 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 30 void AbstractArduboy::idle()
lmayencou 1:c53e766082b4 31 {}
lmayencou 1:c53e766082b4 32
lmayencou 1:c53e766082b4 33 void AbstractArduboy::saveMuchPower()
lmayencou 1:c53e766082b4 34 {}
lmayencou 1:c53e766082b4 35
lmayencou 1:c53e766082b4 36 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 37 // frame management
lmayencou 1:c53e766082b4 38 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 39 void AbstractArduboy::setFrameRate(uint8_t rate)
lmayencou 1:c53e766082b4 40 {
lmayencou 1:c53e766082b4 41 frameRate = rate;
lmayencou 1:c53e766082b4 42 eachFrameMillis = 1000 / rate;
lmayencou 1:c53e766082b4 43 }
lmayencou 1:c53e766082b4 44
lmayencou 1:c53e766082b4 45 bool AbstractArduboy::everyXFrames(uint8_t frames)
lmayencou 1:c53e766082b4 46 {
lmayencou 1:c53e766082b4 47 return frameCount % frames == 0;
lmayencou 1:c53e766082b4 48 }
lmayencou 1:c53e766082b4 49
lmayencou 1:c53e766082b4 50 bool AbstractArduboy::nextFrame()
lmayencou 1:c53e766082b4 51 {
lmayencou 1:c53e766082b4 52 long now = getTime();
lmayencou 1:c53e766082b4 53 uint8_t remaining;
lmayencou 1:c53e766082b4 54
lmayencou 1:c53e766082b4 55 // post render
lmayencou 1:c53e766082b4 56 if (post_render) {
lmayencou 1:c53e766082b4 57 lastFrameDurationMs = now - lastFrameStart;
lmayencou 1:c53e766082b4 58 frameCount++;
lmayencou 1:c53e766082b4 59 post_render = false;
lmayencou 1:c53e766082b4 60 }
lmayencou 1:c53e766082b4 61
lmayencou 1:c53e766082b4 62 // if it's not time for the next frame yet
lmayencou 1:c53e766082b4 63 if (now < nextFrameStart) {
lmayencou 1:c53e766082b4 64 remaining = nextFrameStart - now;
lmayencou 1:c53e766082b4 65 // if we have more than 1ms to spare, lets sleep
lmayencou 1:c53e766082b4 66 // we should be woken up by timer0 every 1ms, so this should be ok
lmayencou 1:c53e766082b4 67 if (remaining > 1)
lmayencou 1:c53e766082b4 68 idle();
lmayencou 1:c53e766082b4 69 return false;
lmayencou 1:c53e766082b4 70 }
lmayencou 1:c53e766082b4 71
lmayencou 1:c53e766082b4 72 // pre-render
lmayencou 1:c53e766082b4 73
lmayencou 1:c53e766082b4 74 // technically next frame should be last frame + each frame but if we're
lmayencou 1:c53e766082b4 75 // running a slow render we would constnatly be behind the clock
lmayencou 1:c53e766082b4 76 // keep an eye on this and see how it works. If it works well the
lmayencou 1:c53e766082b4 77 // lastFrameStart variable could be eliminated completely
lmayencou 1:c53e766082b4 78 nextFrameStart = now + eachFrameMillis;
lmayencou 1:c53e766082b4 79 lastFrameStart = now;
lmayencou 1:c53e766082b4 80 post_render = true;
lmayencou 1:c53e766082b4 81 return post_render;
lmayencou 1:c53e766082b4 82 }
lmayencou 1:c53e766082b4 83
lmayencou 1:c53e766082b4 84 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 85 // info
lmayencou 1:c53e766082b4 86 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 87 // returns the load on the CPU as a percentage
lmayencou 1:c53e766082b4 88 // this is based on how much of the time your app is spends rendering
lmayencou 1:c53e766082b4 89 // frames. This number can be higher than 100 if your app is rendering
lmayencou 1:c53e766082b4 90 // really slowly.
lmayencou 1:c53e766082b4 91 int AbstractArduboy::cpuLoad()
lmayencou 1:c53e766082b4 92 {
lmayencou 1:c53e766082b4 93 return lastFrameDurationMs * 100 / eachFrameMillis;
lmayencou 1:c53e766082b4 94 }
lmayencou 1:c53e766082b4 95
lmayencou 1:c53e766082b4 96
lmayencou 1:c53e766082b4 97 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 98 // buttons
lmayencou 1:c53e766082b4 99 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 100
lmayencou 1:c53e766082b4 101 void AbstractArduboy::poll()
lmayencou 1:c53e766082b4 102 {
lmayencou 1:c53e766082b4 103 previousButtonState = currentButtonState;
lmayencou 1:c53e766082b4 104 currentButtonState = getInput();
lmayencou 1:c53e766082b4 105 }
lmayencou 1:c53e766082b4 106
lmayencou 1:c53e766082b4 107 // returns true if the button mask passed in is pressed
lmayencou 1:c53e766082b4 108 //
lmayencou 1:c53e766082b4 109 // if (pressed(LEFT_BUTTON + A_BUTTON))
lmayencou 1:c53e766082b4 110 bool AbstractArduboy::pressed(uint8_t buttons)
lmayencou 1:c53e766082b4 111 {
lmayencou 1:c53e766082b4 112 uint8_t button_state = getInput();
lmayencou 1:c53e766082b4 113 return (button_state & buttons) == buttons;
lmayencou 1:c53e766082b4 114 }
lmayencou 1:c53e766082b4 115
lmayencou 1:c53e766082b4 116 // returns true if the button mask passed in not pressed
lmayencou 1:c53e766082b4 117 //
lmayencou 1:c53e766082b4 118 // if (not_pressed(LEFT_BUTTON))
lmayencou 1:c53e766082b4 119 bool AbstractArduboy::notPressed(uint8_t buttons)
lmayencou 1:c53e766082b4 120 {
lmayencou 1:c53e766082b4 121 uint8_t button_state = getInput();
lmayencou 1:c53e766082b4 122 return (button_state & buttons) == 0;
lmayencou 1:c53e766082b4 123 }
lmayencou 1:c53e766082b4 124
lmayencou 1:c53e766082b4 125 // returns true if a button has just been pressed
lmayencou 1:c53e766082b4 126 // if the button has been held down for multiple frames this will return
lmayencou 1:c53e766082b4 127 // false. You should only use this to poll a single button.
lmayencou 1:c53e766082b4 128 bool AbstractArduboy::justPressed(uint8_t button)
lmayencou 1:c53e766082b4 129 {
lmayencou 1:c53e766082b4 130 uint8_t button_state = getInput();
lmayencou 1:c53e766082b4 131 return (!(previousButtonState & button) && (currentButtonState & button));
lmayencou 1:c53e766082b4 132 }
lmayencou 1:c53e766082b4 133
lmayencou 1:c53e766082b4 134 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 135 // graphics
lmayencou 1:c53e766082b4 136 ////////////////////////////////////////////////
lmayencou 1:c53e766082b4 137
lmayencou 1:c53e766082b4 138 void AbstractArduboy::blank()
lmayencou 1:c53e766082b4 139 {
lmayencou 1:c53e766082b4 140 fillScreen(0);
lmayencou 1:c53e766082b4 141 }
lmayencou 1:c53e766082b4 142
lmayencou 1:c53e766082b4 143 void AbstractArduboy::clearDisplay()
lmayencou 1:c53e766082b4 144 {
lmayencou 1:c53e766082b4 145 fillScreen(0);
lmayencou 1:c53e766082b4 146 }
lmayencou 1:c53e766082b4 147
lmayencou 1:c53e766082b4 148 void AbstractArduboy::drawPixel(int x, int y, uint8_t color)
lmayencou 1:c53e766082b4 149 {
lmayencou 1:c53e766082b4 150 #ifdef PIXEL_SAFE_MODE
lmayencou 1:c53e766082b4 151 if (x < 0 || x > (WIDTH - 1) || y < 0 || y > (HEIGHT - 1))
lmayencou 1:c53e766082b4 152 {
lmayencou 1:c53e766082b4 153 return;
lmayencou 1:c53e766082b4 154 }
lmayencou 1:c53e766082b4 155 #endif
lmayencou 1:c53e766082b4 156
lmayencou 1:c53e766082b4 157 uint8_t row = (uint8_t)y / 8;
lmayencou 1:c53e766082b4 158 if (color)
lmayencou 1:c53e766082b4 159 {
lmayencou 1:c53e766082b4 160 sBuffer[(row * WIDTH) + (uint8_t)x] |= _BV((uint8_t)y % 8);
lmayencou 1:c53e766082b4 161 }
lmayencou 1:c53e766082b4 162 else
lmayencou 1:c53e766082b4 163 {
lmayencou 1:c53e766082b4 164 sBuffer[(row * WIDTH) + (uint8_t)x] &= ~ _BV((uint8_t)y % 8);
lmayencou 1:c53e766082b4 165 }
lmayencou 1:c53e766082b4 166 }
lmayencou 1:c53e766082b4 167
lmayencou 1:c53e766082b4 168 uint8_t AbstractArduboy::getPixel(uint8_t x, uint8_t y)
lmayencou 1:c53e766082b4 169 {
lmayencou 1:c53e766082b4 170 uint8_t row = y / 8;
lmayencou 1:c53e766082b4 171 uint8_t bit_position = y % 8;
lmayencou 1:c53e766082b4 172 return (sBuffer[(row * WIDTH) + x] & _BV(bit_position)) >> bit_position;
lmayencou 1:c53e766082b4 173 }
lmayencou 1:c53e766082b4 174
lmayencou 1:c53e766082b4 175 void AbstractArduboy::drawCircle(int16_t x0, int16_t y0, int16_t r, uint8_t color)
lmayencou 1:c53e766082b4 176 {
lmayencou 1:c53e766082b4 177 int16_t f = 1 - r;
lmayencou 1:c53e766082b4 178 int16_t ddF_x = 1;
lmayencou 1:c53e766082b4 179 int16_t ddF_y = -2 * r;
lmayencou 1:c53e766082b4 180 int16_t x = 0;
lmayencou 1:c53e766082b4 181 int16_t y = r;
lmayencou 1:c53e766082b4 182
lmayencou 1:c53e766082b4 183 drawPixel(x0, y0 + r, color);
lmayencou 1:c53e766082b4 184 drawPixel(x0, y0 - r, color);
lmayencou 1:c53e766082b4 185 drawPixel(x0 + r, y0, color);
lmayencou 1:c53e766082b4 186 drawPixel(x0 - r, y0, color);
lmayencou 1:c53e766082b4 187
lmayencou 1:c53e766082b4 188 while (x < y)
lmayencou 1:c53e766082b4 189 {
lmayencou 1:c53e766082b4 190 if (f >= 0)
lmayencou 1:c53e766082b4 191 {
lmayencou 1:c53e766082b4 192 y--;
lmayencou 1:c53e766082b4 193 ddF_y += 2;
lmayencou 1:c53e766082b4 194 f += ddF_y;
lmayencou 1:c53e766082b4 195 }
lmayencou 1:c53e766082b4 196
lmayencou 1:c53e766082b4 197 x++;
lmayencou 1:c53e766082b4 198 ddF_x += 2;
lmayencou 1:c53e766082b4 199 f += ddF_x;
lmayencou 1:c53e766082b4 200
lmayencou 1:c53e766082b4 201 drawPixel(x0 + x, y0 + y, color);
lmayencou 1:c53e766082b4 202 drawPixel(x0 - x, y0 + y, color);
lmayencou 1:c53e766082b4 203 drawPixel(x0 + x, y0 - y, color);
lmayencou 1:c53e766082b4 204 drawPixel(x0 - x, y0 - y, color);
lmayencou 1:c53e766082b4 205 drawPixel(x0 + y, y0 + x, color);
lmayencou 1:c53e766082b4 206 drawPixel(x0 - y, y0 + x, color);
lmayencou 1:c53e766082b4 207 drawPixel(x0 + y, y0 - x, color);
lmayencou 1:c53e766082b4 208 drawPixel(x0 - y, y0 - x, color);
lmayencou 1:c53e766082b4 209 }
lmayencou 1:c53e766082b4 210 }
lmayencou 1:c53e766082b4 211
lmayencou 1:c53e766082b4 212 void AbstractArduboy::drawCircleHelper
lmayencou 1:c53e766082b4 213 (int16_t x0, int16_t y0, int16_t r, uint8_t cornername, uint8_t color)
lmayencou 1:c53e766082b4 214 {
lmayencou 1:c53e766082b4 215 int16_t f = 1 - r;
lmayencou 1:c53e766082b4 216 int16_t ddF_x = 1;
lmayencou 1:c53e766082b4 217 int16_t ddF_y = -2 * r;
lmayencou 1:c53e766082b4 218 int16_t x = 0;
lmayencou 1:c53e766082b4 219 int16_t y = r;
lmayencou 1:c53e766082b4 220
lmayencou 1:c53e766082b4 221 while (x < y)
lmayencou 1:c53e766082b4 222 {
lmayencou 1:c53e766082b4 223 if (f >= 0)
lmayencou 1:c53e766082b4 224 {
lmayencou 1:c53e766082b4 225 y--;
lmayencou 1:c53e766082b4 226 ddF_y += 2;
lmayencou 1:c53e766082b4 227 f += ddF_y;
lmayencou 1:c53e766082b4 228 }
lmayencou 1:c53e766082b4 229
lmayencou 1:c53e766082b4 230 x++;
lmayencou 1:c53e766082b4 231 ddF_x += 2;
lmayencou 1:c53e766082b4 232 f += ddF_x;
lmayencou 1:c53e766082b4 233
lmayencou 1:c53e766082b4 234 if (cornername & 0x4)
lmayencou 1:c53e766082b4 235 {
lmayencou 1:c53e766082b4 236 drawPixel(x0 + x, y0 + y, color);
lmayencou 1:c53e766082b4 237 drawPixel(x0 + y, y0 + x, color);
lmayencou 1:c53e766082b4 238 }
lmayencou 1:c53e766082b4 239 if (cornername & 0x2)
lmayencou 1:c53e766082b4 240 {
lmayencou 1:c53e766082b4 241 drawPixel(x0 + x, y0 - y, color);
lmayencou 1:c53e766082b4 242 drawPixel(x0 + y, y0 - x, color);
lmayencou 1:c53e766082b4 243 }
lmayencou 1:c53e766082b4 244 if (cornername & 0x8)
lmayencou 1:c53e766082b4 245 {
lmayencou 1:c53e766082b4 246 drawPixel(x0 - y, y0 + x, color);
lmayencou 1:c53e766082b4 247 drawPixel(x0 - x, y0 + y, color);
lmayencou 1:c53e766082b4 248 }
lmayencou 1:c53e766082b4 249 if (cornername & 0x1)
lmayencou 1:c53e766082b4 250 {
lmayencou 1:c53e766082b4 251 drawPixel(x0 - y, y0 - x, color);
lmayencou 1:c53e766082b4 252 drawPixel(x0 - x, y0 - y, color);
lmayencou 1:c53e766082b4 253 }
lmayencou 1:c53e766082b4 254 }
lmayencou 1:c53e766082b4 255 }
lmayencou 1:c53e766082b4 256
lmayencou 1:c53e766082b4 257 void AbstractArduboy::fillCircle(int16_t x0, int16_t y0, int16_t r, uint8_t color)
lmayencou 1:c53e766082b4 258 {
lmayencou 1:c53e766082b4 259 drawFastVLine(x0, y0 - r, 2 * r + 1, color);
lmayencou 1:c53e766082b4 260 fillCircleHelper(x0, y0, r, 3, 0, color);
lmayencou 1:c53e766082b4 261 }
lmayencou 1:c53e766082b4 262
lmayencou 1:c53e766082b4 263 void AbstractArduboy::fillCircleHelper(int16_t x0, int16_t y0, int16_t r, uint8_t cornername, int16_t delta, uint8_t color)
lmayencou 1:c53e766082b4 264 {
lmayencou 1:c53e766082b4 265 // used to do circles and roundrects!
lmayencou 1:c53e766082b4 266 int16_t f = 1 - r;
lmayencou 1:c53e766082b4 267 int16_t ddF_x = 1;
lmayencou 1:c53e766082b4 268 int16_t ddF_y = -2 * r;
lmayencou 1:c53e766082b4 269 int16_t x = 0;
lmayencou 1:c53e766082b4 270 int16_t y = r;
lmayencou 1:c53e766082b4 271
lmayencou 1:c53e766082b4 272 while (x < y)
lmayencou 1:c53e766082b4 273 {
lmayencou 1:c53e766082b4 274 if (f >= 0)
lmayencou 1:c53e766082b4 275 {
lmayencou 1:c53e766082b4 276 y--;
lmayencou 1:c53e766082b4 277 ddF_y += 2;
lmayencou 1:c53e766082b4 278 f += ddF_y;
lmayencou 1:c53e766082b4 279 }
lmayencou 1:c53e766082b4 280
lmayencou 1:c53e766082b4 281 x++;
lmayencou 1:c53e766082b4 282 ddF_x += 2;
lmayencou 1:c53e766082b4 283 f += ddF_x;
lmayencou 1:c53e766082b4 284
lmayencou 1:c53e766082b4 285 if (cornername & 0x1)
lmayencou 1:c53e766082b4 286 {
lmayencou 1:c53e766082b4 287 drawFastVLine(x0 + x, y0 - y, 2 * y + 1 + delta, color);
lmayencou 1:c53e766082b4 288 drawFastVLine(x0 + y, y0 - x, 2 * x + 1 + delta, color);
lmayencou 1:c53e766082b4 289 }
lmayencou 1:c53e766082b4 290
lmayencou 1:c53e766082b4 291 if (cornername & 0x2)
lmayencou 1:c53e766082b4 292 {
lmayencou 1:c53e766082b4 293 drawFastVLine(x0 - x, y0 - y, 2 * y + 1 + delta, color);
lmayencou 1:c53e766082b4 294 drawFastVLine(x0 - y, y0 - x, 2 * x + 1 + delta, color);
lmayencou 1:c53e766082b4 295 }
lmayencou 1:c53e766082b4 296 }
lmayencou 1:c53e766082b4 297 }
lmayencou 1:c53e766082b4 298
lmayencou 1:c53e766082b4 299 void AbstractArduboy::drawLine
lmayencou 1:c53e766082b4 300 (int16_t x0, int16_t y0, int16_t x1, int16_t y1, uint8_t color)
lmayencou 1:c53e766082b4 301 {
lmayencou 1:c53e766082b4 302 // bresenham's algorithm - thx wikpedia
lmayencou 1:c53e766082b4 303 bool steep = abs(y1 - y0) > abs(x1 - x0);
lmayencou 1:c53e766082b4 304 if (steep) {
lmayencou 1:c53e766082b4 305 swap(x0, y0);
lmayencou 1:c53e766082b4 306 swap(x1, y1);
lmayencou 1:c53e766082b4 307 }
lmayencou 1:c53e766082b4 308
lmayencou 1:c53e766082b4 309 if (x0 > x1) {
lmayencou 1:c53e766082b4 310 swap(x0, x1);
lmayencou 1:c53e766082b4 311 swap(y0, y1);
lmayencou 1:c53e766082b4 312 }
lmayencou 1:c53e766082b4 313
lmayencou 1:c53e766082b4 314 int16_t dx, dy;
lmayencou 1:c53e766082b4 315 dx = x1 - x0;
lmayencou 1:c53e766082b4 316 dy = abs(y1 - y0);
lmayencou 1:c53e766082b4 317
lmayencou 1:c53e766082b4 318 int16_t err = dx / 2;
lmayencou 1:c53e766082b4 319 int8_t ystep;
lmayencou 1:c53e766082b4 320
lmayencou 1:c53e766082b4 321 if (y0 < y1)
lmayencou 1:c53e766082b4 322 {
lmayencou 1:c53e766082b4 323 ystep = 1;
lmayencou 1:c53e766082b4 324 }
lmayencou 1:c53e766082b4 325 else
lmayencou 1:c53e766082b4 326 {
lmayencou 1:c53e766082b4 327 ystep = -1;
lmayencou 1:c53e766082b4 328 }
lmayencou 1:c53e766082b4 329
lmayencou 1:c53e766082b4 330 for (; x0 <= x1; x0++)
lmayencou 1:c53e766082b4 331 {
lmayencou 1:c53e766082b4 332 if (steep)
lmayencou 1:c53e766082b4 333 {
lmayencou 1:c53e766082b4 334 drawPixel(y0, x0, color);
lmayencou 1:c53e766082b4 335 }
lmayencou 1:c53e766082b4 336 else
lmayencou 1:c53e766082b4 337 {
lmayencou 1:c53e766082b4 338 drawPixel(x0, y0, color);
lmayencou 1:c53e766082b4 339 }
lmayencou 1:c53e766082b4 340
lmayencou 1:c53e766082b4 341 err -= dy;
lmayencou 1:c53e766082b4 342 if (err < 0)
lmayencou 1:c53e766082b4 343 {
lmayencou 1:c53e766082b4 344 y0 += ystep;
lmayencou 1:c53e766082b4 345 err += dx;
lmayencou 1:c53e766082b4 346 }
lmayencou 1:c53e766082b4 347 }
lmayencou 1:c53e766082b4 348 }
lmayencou 1:c53e766082b4 349
lmayencou 1:c53e766082b4 350 void AbstractArduboy::drawRect
lmayencou 1:c53e766082b4 351 (int16_t x, int16_t y, int16_t w, int16_t h, uint8_t color)
lmayencou 1:c53e766082b4 352 {
lmayencou 1:c53e766082b4 353 drawFastHLine(x, y, w, color);
lmayencou 1:c53e766082b4 354 drawFastHLine(x, y + h - 1, w, color);
lmayencou 1:c53e766082b4 355 drawFastVLine(x, y, h, color);
lmayencou 1:c53e766082b4 356 drawFastVLine(x + w - 1, y, h, color);
lmayencou 1:c53e766082b4 357 }
lmayencou 1:c53e766082b4 358
lmayencou 1:c53e766082b4 359 void AbstractArduboy::drawFastVLine
lmayencou 1:c53e766082b4 360 (int16_t x, int16_t y, int16_t h, uint8_t color)
lmayencou 1:c53e766082b4 361 {
lmayencou 1:c53e766082b4 362 int end = y + h;
lmayencou 1:c53e766082b4 363 for (int a = max(0, y); a < min(end, HEIGHT); a++)
lmayencou 1:c53e766082b4 364 {
lmayencou 1:c53e766082b4 365 drawPixel(x, a, color);
lmayencou 1:c53e766082b4 366 }
lmayencou 1:c53e766082b4 367 }
lmayencou 1:c53e766082b4 368
lmayencou 1:c53e766082b4 369 void AbstractArduboy::drawFastHLine
lmayencou 1:c53e766082b4 370 (int16_t x, int16_t y, int16_t w, uint8_t color)
lmayencou 1:c53e766082b4 371 {
lmayencou 1:c53e766082b4 372 int end = x + w;
lmayencou 1:c53e766082b4 373 for (int a = max(0, x); a < min(end, WIDTH); a++)
lmayencou 1:c53e766082b4 374 {
lmayencou 1:c53e766082b4 375 drawPixel(a, y, color);
lmayencou 1:c53e766082b4 376 }
lmayencou 1:c53e766082b4 377 }
lmayencou 1:c53e766082b4 378
lmayencou 1:c53e766082b4 379 void AbstractArduboy::fillRect
lmayencou 1:c53e766082b4 380 (int16_t x, int16_t y, int16_t w, int16_t h, uint8_t color)
lmayencou 1:c53e766082b4 381 {
lmayencou 1:c53e766082b4 382 // stupidest version - update in subclasses if desired!
lmayencou 1:c53e766082b4 383 for (int16_t i = x; i < x + w; i++)
lmayencou 1:c53e766082b4 384 {
lmayencou 1:c53e766082b4 385 drawFastVLine(i, y, h, color);
lmayencou 1:c53e766082b4 386 }
lmayencou 1:c53e766082b4 387 }
lmayencou 1:c53e766082b4 388
lmayencou 1:c53e766082b4 389 void AbstractArduboy::fillScreen(uint8_t color)
lmayencou 1:c53e766082b4 390 {
lmayencou 1:c53e766082b4 391 // C version :
lmayencou 1:c53e766082b4 392 if(color != 0) color = 0xFF; //change any nonzero argument to b11111111 and insert into screen array.
lmayencou 1:c53e766082b4 393 for(int16_t i=0; i<1024; i++) { sBuffer[i] = color; } //sBuffer = (128*64) = 8192/8 = 1024 bytes.
lmayencou 1:c53e766082b4 394 }
lmayencou 1:c53e766082b4 395
lmayencou 1:c53e766082b4 396 void AbstractArduboy::drawRoundRect
lmayencou 1:c53e766082b4 397 (int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint8_t color)
lmayencou 1:c53e766082b4 398 {
lmayencou 1:c53e766082b4 399 // smarter version
lmayencou 1:c53e766082b4 400 drawFastHLine(x + r, y, w - 2 * r, color); // Top
lmayencou 1:c53e766082b4 401 drawFastHLine(x + r, y + h - 1, w - 2 * r, color); // Bottom
lmayencou 1:c53e766082b4 402 drawFastVLine(x, y + r, h - 2 * r, color); // Left
lmayencou 1:c53e766082b4 403 drawFastVLine(x + w - 1, y + r, h - 2 * r, color); // Right
lmayencou 1:c53e766082b4 404 // draw four corners
lmayencou 1:c53e766082b4 405 drawCircleHelper(x + r, y + r, r, 1, color);
lmayencou 1:c53e766082b4 406 drawCircleHelper(x + w - r - 1, y + r, r, 2, color);
lmayencou 1:c53e766082b4 407 drawCircleHelper(x + w - r - 1, y + h - r - 1, r, 4, color);
lmayencou 1:c53e766082b4 408 drawCircleHelper(x + r, y + h - r - 1, r, 8, color);
lmayencou 1:c53e766082b4 409 }
lmayencou 1:c53e766082b4 410
lmayencou 1:c53e766082b4 411 void AbstractArduboy::fillRoundRect
lmayencou 1:c53e766082b4 412 (int16_t x, int16_t y, int16_t w, int16_t h, int16_t r, uint8_t color)
lmayencou 1:c53e766082b4 413 {
lmayencou 1:c53e766082b4 414 // smarter version
lmayencou 1:c53e766082b4 415 fillRect(x + r, y, w - 2 * r, h, color);
lmayencou 1:c53e766082b4 416
lmayencou 1:c53e766082b4 417 // draw four corners
lmayencou 1:c53e766082b4 418 fillCircleHelper(x + w - r - 1, y + r, r, 1, h - 2 * r - 1, color);
lmayencou 1:c53e766082b4 419 fillCircleHelper(x + r, y + r, r, 2, h - 2 * r - 1, color);
lmayencou 1:c53e766082b4 420 }
lmayencou 1:c53e766082b4 421
lmayencou 1:c53e766082b4 422 void AbstractArduboy::drawBitmap(int16_t x, int16_t y, const uint8_t *bitmap, int16_t w, int16_t h, uint8_t color) {
lmayencou 1:c53e766082b4 423 // no need to dar at all of we're offscreen
lmayencou 1:c53e766082b4 424 if (x + w < 0 || x > WIDTH - 1 || y + h < 0 || y > HEIGHT - 1)
lmayencou 1:c53e766082b4 425 return;
lmayencou 1:c53e766082b4 426
lmayencou 1:c53e766082b4 427 int yOffset = abs(y) % 8;
lmayencou 1:c53e766082b4 428 int sRow = y / 8;
lmayencou 1:c53e766082b4 429 if (y < 0) {
lmayencou 1:c53e766082b4 430 sRow--;
lmayencou 1:c53e766082b4 431 yOffset = 8 - yOffset;
lmayencou 1:c53e766082b4 432 }
lmayencou 1:c53e766082b4 433 int rows = h / 8;
lmayencou 1:c53e766082b4 434 if (h % 8 != 0) rows++;
lmayencou 1:c53e766082b4 435 for (int a = 0; a < rows; a++) {
lmayencou 1:c53e766082b4 436 int bRow = sRow + a;
lmayencou 1:c53e766082b4 437 if (bRow > (HEIGHT / 8) - 1) break;
lmayencou 1:c53e766082b4 438 if (bRow > -2) {
lmayencou 1:c53e766082b4 439 for (int iCol = 0; iCol < w; iCol++) {
lmayencou 1:c53e766082b4 440 if (iCol + x > (WIDTH - 1)) break;
lmayencou 1:c53e766082b4 441 if (iCol + x >= 0) {
lmayencou 1:c53e766082b4 442 if (bRow >= 0) {
lmayencou 1:c53e766082b4 443 if (color) this->sBuffer[ (bRow * WIDTH) + x + iCol ] |= pgm_read_byte(bitmap + (a * w) + iCol) << yOffset;
lmayencou 1:c53e766082b4 444 else this->sBuffer[ (bRow * WIDTH) + x + iCol ] &= ~(pgm_read_byte(bitmap + (a * w) + iCol) << yOffset);
lmayencou 1:c53e766082b4 445 }
lmayencou 1:c53e766082b4 446 if (yOffset && bRow < (HEIGHT / 8) - 1 && bRow > -2) {
lmayencou 1:c53e766082b4 447 if (color) this->sBuffer[ ((bRow + 1)*WIDTH) + x + iCol ] |= pgm_read_byte(bitmap + (a * w) + iCol) >> (8 - yOffset);
lmayencou 1:c53e766082b4 448 else this->sBuffer[ ((bRow + 1)*WIDTH) + x + iCol ] &= ~(pgm_read_byte(bitmap + (a * w) + iCol) >> (8 - yOffset));
lmayencou 1:c53e766082b4 449 }
lmayencou 1:c53e766082b4 450 }
lmayencou 1:c53e766082b4 451 }
lmayencou 1:c53e766082b4 452 }
lmayencou 1:c53e766082b4 453 }
lmayencou 1:c53e766082b4 454 }
lmayencou 1:c53e766082b4 455
lmayencou 1:c53e766082b4 456
lmayencou 1:c53e766082b4 457
lmayencou 1:c53e766082b4 458 typedef struct CSESSION {
lmayencou 1:c53e766082b4 459 int byte;
lmayencou 1:c53e766082b4 460 int bit;
lmayencou 1:c53e766082b4 461 const uint8_t *src;
lmayencou 1:c53e766082b4 462 int src_pos;
lmayencou 1:c53e766082b4 463 } CSESSION;
lmayencou 1:c53e766082b4 464 static CSESSION cs;
lmayencou 1:c53e766082b4 465
lmayencou 1:c53e766082b4 466 static int getval(int bits)
lmayencou 1:c53e766082b4 467 {
lmayencou 1:c53e766082b4 468 int val = 0;
lmayencou 1:c53e766082b4 469 int i;
lmayencou 1:c53e766082b4 470 for (i = 0; i < bits; i++)
lmayencou 1:c53e766082b4 471 {
lmayencou 1:c53e766082b4 472 if (cs.bit == 0x100)
lmayencou 1:c53e766082b4 473 {
lmayencou 1:c53e766082b4 474 cs.bit = 0x1;
lmayencou 1:c53e766082b4 475 cs.byte = pgm_read_byte(&cs.src[cs.src_pos]);
lmayencou 1:c53e766082b4 476 cs.src_pos ++;
lmayencou 1:c53e766082b4 477 }
lmayencou 1:c53e766082b4 478 if (cs.byte & cs.bit)
lmayencou 1:c53e766082b4 479 val += (1 << i);
lmayencou 1:c53e766082b4 480 cs.bit <<= 1;
lmayencou 1:c53e766082b4 481 }
lmayencou 1:c53e766082b4 482 return val;
lmayencou 1:c53e766082b4 483 }
lmayencou 1:c53e766082b4 484
lmayencou 1:c53e766082b4 485 void AbstractArduboy::drawCompressed(int16_t sx, int16_t sy, const uint8_t *bitmap, uint8_t color)
lmayencou 1:c53e766082b4 486 {
lmayencou 1:c53e766082b4 487 int bl, len;
lmayencou 1:c53e766082b4 488 int col;
lmayencou 1:c53e766082b4 489 int i;
lmayencou 1:c53e766082b4 490 int a, iCol;
lmayencou 1:c53e766082b4 491 int x, y;
lmayencou 1:c53e766082b4 492 int byte = 0;
lmayencou 1:c53e766082b4 493 int bit = 0;
lmayencou 1:c53e766082b4 494 int w, h;
lmayencou 1:c53e766082b4 495
lmayencou 1:c53e766082b4 496 // set up decompress state
lmayencou 1:c53e766082b4 497
lmayencou 1:c53e766082b4 498 cs.src = bitmap;
lmayencou 1:c53e766082b4 499 cs.bit = 0x100;
lmayencou 1:c53e766082b4 500 cs.byte = 0;
lmayencou 1:c53e766082b4 501 cs.src_pos = 0;
lmayencou 1:c53e766082b4 502
lmayencou 1:c53e766082b4 503 // read header
lmayencou 1:c53e766082b4 504
lmayencou 1:c53e766082b4 505 w = getval(8) + 1;
lmayencou 1:c53e766082b4 506 h = getval(8) + 1;
lmayencou 1:c53e766082b4 507
lmayencou 1:c53e766082b4 508 col = getval(1); // starting colour
lmayencou 1:c53e766082b4 509
lmayencou 1:c53e766082b4 510 // no need to draw at all if we're offscreen
lmayencou 1:c53e766082b4 511 if (sx + w < 0 || sx > WIDTH - 1 || sy + h < 0 || sy > HEIGHT - 1)
lmayencou 1:c53e766082b4 512 return;
lmayencou 1:c53e766082b4 513
lmayencou 1:c53e766082b4 514 // sy = sy - (frame*h);
lmayencou 1:c53e766082b4 515
lmayencou 1:c53e766082b4 516 int yOffset = abs(sy) % 8;
lmayencou 1:c53e766082b4 517 int sRow = sy / 8;
lmayencou 1:c53e766082b4 518 if (sy < 0) {
lmayencou 1:c53e766082b4 519 sRow--;
lmayencou 1:c53e766082b4 520 yOffset = 8 - yOffset;
lmayencou 1:c53e766082b4 521 }
lmayencou 1:c53e766082b4 522 int rows = h / 8;
lmayencou 1:c53e766082b4 523 if (h % 8 != 0) rows++;
lmayencou 1:c53e766082b4 524
lmayencou 1:c53e766082b4 525 a = 0; // +(frame*rows);
lmayencou 1:c53e766082b4 526 iCol = 0;
lmayencou 1:c53e766082b4 527
lmayencou 1:c53e766082b4 528 byte = 0; bit = 1;
lmayencou 1:c53e766082b4 529 while (a < rows) // + (frame*rows))
lmayencou 1:c53e766082b4 530 {
lmayencou 1:c53e766082b4 531 bl = 1;
lmayencou 1:c53e766082b4 532 while (!getval(1))
lmayencou 1:c53e766082b4 533 bl += 2;
lmayencou 1:c53e766082b4 534
lmayencou 1:c53e766082b4 535 len = getval(bl) + 1; // span length
lmayencou 1:c53e766082b4 536
lmayencou 1:c53e766082b4 537 // draw the span
lmayencou 1:c53e766082b4 538
lmayencou 1:c53e766082b4 539
lmayencou 1:c53e766082b4 540 for (i = 0; i < len; i++)
lmayencou 1:c53e766082b4 541 {
lmayencou 1:c53e766082b4 542 if (col)
lmayencou 1:c53e766082b4 543 byte |= bit;
lmayencou 1:c53e766082b4 544 bit <<= 1;
lmayencou 1:c53e766082b4 545
lmayencou 1:c53e766082b4 546 if (bit == 0x100) // reached end of byte
lmayencou 1:c53e766082b4 547 {
lmayencou 1:c53e766082b4 548 // draw
lmayencou 1:c53e766082b4 549
lmayencou 1:c53e766082b4 550 int bRow = sRow + a;
lmayencou 1:c53e766082b4 551
lmayencou 1:c53e766082b4 552 //if (byte) // possible optimisation
lmayencou 1:c53e766082b4 553 if (bRow <= (HEIGHT / 8) - 1)
lmayencou 1:c53e766082b4 554 if (bRow > -2)
lmayencou 1:c53e766082b4 555 if (iCol + sx <= (WIDTH - 1))
lmayencou 1:c53e766082b4 556 if (iCol + sx >= 0) {
lmayencou 1:c53e766082b4 557
lmayencou 1:c53e766082b4 558 if (bRow >= 0)
lmayencou 1:c53e766082b4 559 {
lmayencou 1:c53e766082b4 560 if (color)
lmayencou 1:c53e766082b4 561 this->sBuffer[ (bRow * WIDTH) + sx + iCol] |= byte << yOffset;
lmayencou 1:c53e766082b4 562 else
lmayencou 1:c53e766082b4 563 this->sBuffer[ (bRow * WIDTH) + sx + iCol] &= ~(byte << yOffset);
lmayencou 1:c53e766082b4 564 }
lmayencou 1:c53e766082b4 565 if (yOffset && bRow < (HEIGHT / 8) - 1 && bRow > -2)
lmayencou 1:c53e766082b4 566 {
lmayencou 1:c53e766082b4 567 if (color)
lmayencou 1:c53e766082b4 568 this->sBuffer[((bRow + 1)*WIDTH) + sx + iCol] |= byte >> (8 - yOffset);
lmayencou 1:c53e766082b4 569 else
lmayencou 1:c53e766082b4 570 this->sBuffer[((bRow + 1)*WIDTH) + sx + iCol] &= ~(byte >> (8 - yOffset));
lmayencou 1:c53e766082b4 571 }
lmayencou 1:c53e766082b4 572
lmayencou 1:c53e766082b4 573 }
lmayencou 1:c53e766082b4 574
lmayencou 1:c53e766082b4 575 // iterate
lmayencou 1:c53e766082b4 576 iCol ++;
lmayencou 1:c53e766082b4 577 if (iCol >= w)
lmayencou 1:c53e766082b4 578 {
lmayencou 1:c53e766082b4 579 iCol = 0;
lmayencou 1:c53e766082b4 580 a ++;
lmayencou 1:c53e766082b4 581 }
lmayencou 1:c53e766082b4 582
lmayencou 1:c53e766082b4 583 // reset byte
lmayencou 1:c53e766082b4 584 byte = 0; bit = 1;
lmayencou 1:c53e766082b4 585 }
lmayencou 1:c53e766082b4 586 }
lmayencou 1:c53e766082b4 587
lmayencou 1:c53e766082b4 588 col = 1 - col; // toggle colour for next span
lmayencou 1:c53e766082b4 589 }
lmayencou 1:c53e766082b4 590 }
lmayencou 1:c53e766082b4 591
lmayencou 1:c53e766082b4 592 uint8_t AbstractArduboy::writeChar(uint8_t c)
lmayencou 1:c53e766082b4 593 {
lmayencou 1:c53e766082b4 594 if (c == '\n')
lmayencou 1:c53e766082b4 595 {
lmayencou 1:c53e766082b4 596 cursor_y += textsize*8;
lmayencou 1:c53e766082b4 597 cursor_x = 0;
lmayencou 1:c53e766082b4 598 }
lmayencou 1:c53e766082b4 599 else if (c == '\r')
lmayencou 1:c53e766082b4 600 cursor_x = 0;
lmayencou 1:c53e766082b4 601 else
lmayencou 1:c53e766082b4 602 {
lmayencou 1:c53e766082b4 603 drawChar(cursor_x, cursor_y, c, textcolor, textbgcolor, textsize);
lmayencou 1:c53e766082b4 604 cursor_x += textsize*6;
lmayencou 1:c53e766082b4 605 if (wrap && (cursor_x > (WIDTH - textsize*6)))
lmayencou 1:c53e766082b4 606 {
lmayencou 1:c53e766082b4 607 cursor_y += textsize*8;
lmayencou 1:c53e766082b4 608 cursor_x = 0;
lmayencou 1:c53e766082b4 609 }
lmayencou 1:c53e766082b4 610 }
lmayencou 1:c53e766082b4 611 return 1;
lmayencou 1:c53e766082b4 612 }
lmayencou 1:c53e766082b4 613
lmayencou 1:c53e766082b4 614 // draw a character
lmayencou 1:c53e766082b4 615 void AbstractArduboy::drawChar(int16_t x, int16_t y, unsigned char c, uint16_t color, uint16_t bg, uint8_t size)
lmayencou 1:c53e766082b4 616 {
lmayencou 1:c53e766082b4 617 if(
lmayencou 1:c53e766082b4 618 (x >= WIDTH) || // Clip right
lmayencou 1:c53e766082b4 619 (y >= HEIGHT) || // Clip bottom
lmayencou 1:c53e766082b4 620 ((x + 5 * size - 1) < 0) || // Clip left
lmayencou 1:c53e766082b4 621 ((y + 8 * size - 1) < 0) // Clip top
lmayencou 1:c53e766082b4 622 )
lmayencou 1:c53e766082b4 623 return;
lmayencou 1:c53e766082b4 624
lmayencou 1:c53e766082b4 625 for (int8_t i=0; i<6; i++ )
lmayencou 1:c53e766082b4 626 {
lmayencou 1:c53e766082b4 627 uint8_t line = 0;
lmayencou 1:c53e766082b4 628
lmayencou 1:c53e766082b4 629 if (i == 5)
lmayencou 1:c53e766082b4 630 line = 0x0;
lmayencou 1:c53e766082b4 631 else
lmayencou 1:c53e766082b4 632 line = font[(c*5)+i];
lmayencou 1:c53e766082b4 633
lmayencou 1:c53e766082b4 634 for (int8_t j = 0; j<8; j++)
lmayencou 1:c53e766082b4 635 {
lmayencou 1:c53e766082b4 636 if (line & 0x1)
lmayencou 1:c53e766082b4 637 {
lmayencou 1:c53e766082b4 638 #if defined(GFX_WANT_ABSTRACTS) || defined(GFX_SIZEABLE_TEXT)
lmayencou 1:c53e766082b4 639 if (size == 1) // default size
lmayencou 1:c53e766082b4 640 drawPixel(x+i, y+j, color);
lmayencou 1:c53e766082b4 641 else // big size
lmayencou 1:c53e766082b4 642 fillRect(x+(i*size), y+(j*size), size, size, color);
lmayencou 1:c53e766082b4 643 #else
lmayencou 1:c53e766082b4 644 drawPixel(x+i, y+j, color);
lmayencou 1:c53e766082b4 645 #endif
lmayencou 1:c53e766082b4 646 }
lmayencou 1:c53e766082b4 647 else if (bg != color)
lmayencou 1:c53e766082b4 648 {
lmayencou 1:c53e766082b4 649 #if defined(GFX_WANT_ABSTRACTS) || defined(GFX_SIZEABLE_TEXT)
lmayencou 1:c53e766082b4 650 if (size == 1) // default size
lmayencou 1:c53e766082b4 651 drawPixel(x+i, y+j, bg);
lmayencou 1:c53e766082b4 652 else // big size
lmayencou 1:c53e766082b4 653 fillRect(x+i*size, y+j*size, size, size, bg);
lmayencou 1:c53e766082b4 654 #else
lmayencou 1:c53e766082b4 655 drawPixel(x+i, y+j, bg);
lmayencou 1:c53e766082b4 656 #endif
lmayencou 1:c53e766082b4 657 }
lmayencou 1:c53e766082b4 658 line >>= 1;
lmayencou 1:c53e766082b4 659 }
lmayencou 1:c53e766082b4 660 }
lmayencou 1:c53e766082b4 661 }
lmayencou 1:c53e766082b4 662
lmayencou 1:c53e766082b4 663 void AbstractArduboy::swap(int16_t &a, int16_t &b)
lmayencou 1:c53e766082b4 664 {
lmayencou 1:c53e766082b4 665 int16_t t = a;
lmayencou 1:c53e766082b4 666
lmayencou 1:c53e766082b4 667 a = b;
lmayencou 1:c53e766082b4 668 b = t;
lmayencou 1:c53e766082b4 669 }
lmayencou 1:c53e766082b4 670
lmayencou 1:c53e766082b4 671 void AbstractArduboy::display()
lmayencou 1:c53e766082b4 672 {
lmayencou 1:c53e766082b4 673 this->drawScreen(sBuffer);
lmayencou 1:c53e766082b4 674 }