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