dd
Dependencies: Final HCSR04 TB6612FNG
oled/SSD1306-Library.cpp@97:b483e656bd14, 2019-06-16 (annotated)
- Committer:
- eunmango
- Date:
- Sun Jun 16 04:44:35 2019 +0000
- Revision:
- 97:b483e656bd14
t
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
eunmango | 97:b483e656bd14 | 1 | /* |
eunmango | 97:b483e656bd14 | 2 | * SSD1306-Library.cpp |
eunmango | 97:b483e656bd14 | 3 | * |
eunmango | 97:b483e656bd14 | 4 | * Created on: 19 Apr 2017 |
eunmango | 97:b483e656bd14 | 5 | * Author: ebj |
eunmango | 97:b483e656bd14 | 6 | * |
eunmango | 97:b483e656bd14 | 7 | * I2C version |
eunmango | 97:b483e656bd14 | 8 | * CS GND |
eunmango | 97:b483e656bd14 | 9 | * DC GND for i2c addr 0x3C, VCC for addr 0x3D |
eunmango | 97:b483e656bd14 | 10 | * RES Vcc |
eunmango | 97:b483e656bd14 | 11 | */ |
eunmango | 97:b483e656bd14 | 12 | |
eunmango | 97:b483e656bd14 | 13 | #include "mbed.h" |
eunmango | 97:b483e656bd14 | 14 | |
eunmango | 97:b483e656bd14 | 15 | #include "SSD1306-Library.h" |
eunmango | 97:b483e656bd14 | 16 | |
eunmango | 97:b483e656bd14 | 17 | extern Serial pc; |
eunmango | 97:b483e656bd14 | 18 | |
eunmango | 97:b483e656bd14 | 19 | extern "C" { |
eunmango | 97:b483e656bd14 | 20 | } |
eunmango | 97:b483e656bd14 | 21 | |
eunmango | 97:b483e656bd14 | 22 | #define NUM_ELEMENTS(x) ((sizeof x)/(sizeof x[0])) |
eunmango | 97:b483e656bd14 | 23 | |
eunmango | 97:b483e656bd14 | 24 | |
eunmango | 97:b483e656bd14 | 25 | I2C i2c(I2C_SDA, I2C_SCL); |
eunmango | 97:b483e656bd14 | 26 | DigitalOut rst(D9); //D13); //reset pin on D13 |
eunmango | 97:b483e656bd14 | 27 | |
eunmango | 97:b483e656bd14 | 28 | |
eunmango | 97:b483e656bd14 | 29 | // the memory buffer for the LCD |
eunmango | 97:b483e656bd14 | 30 | static uint8_t buffer[SSD1306_LCDHEIGHT * SSD1306_LCDWIDTH / 8]; |
eunmango | 97:b483e656bd14 | 31 | |
eunmango | 97:b483e656bd14 | 32 | volatile uint8_t dma_pause = 0; |
eunmango | 97:b483e656bd14 | 33 | |
eunmango | 97:b483e656bd14 | 34 | SSD1306::SSD1306(int16_t w, int16_t h) : Adafruit_GFX(w, h) { |
eunmango | 97:b483e656bd14 | 35 | } |
eunmango | 97:b483e656bd14 | 36 | |
eunmango | 97:b483e656bd14 | 37 | #define ssd1306_swap(a, b) { int16_t t = a; a = b; b = t; } |
eunmango | 97:b483e656bd14 | 38 | |
eunmango | 97:b483e656bd14 | 39 | void SSD1306::hw_setup() { |
eunmango | 97:b483e656bd14 | 40 | i2c.frequency(400000); |
eunmango | 97:b483e656bd14 | 41 | } |
eunmango | 97:b483e656bd14 | 42 | |
eunmango | 97:b483e656bd14 | 43 | |
eunmango | 97:b483e656bd14 | 44 | // the most basic function, set a single pixel |
eunmango | 97:b483e656bd14 | 45 | void SSD1306::drawPixel(int16_t x, int16_t y, uint16_t color) { |
eunmango | 97:b483e656bd14 | 46 | if ((x < 0) || (x >= width()) || (y < 0) || (y >= height())) |
eunmango | 97:b483e656bd14 | 47 | return; |
eunmango | 97:b483e656bd14 | 48 | |
eunmango | 97:b483e656bd14 | 49 | // check rotation, move pixel around if necessary |
eunmango | 97:b483e656bd14 | 50 | switch (rotation) { |
eunmango | 97:b483e656bd14 | 51 | case 1: |
eunmango | 97:b483e656bd14 | 52 | ssd1306_swap(x, y); |
eunmango | 97:b483e656bd14 | 53 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 54 | break; |
eunmango | 97:b483e656bd14 | 55 | case 2: |
eunmango | 97:b483e656bd14 | 56 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 57 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 58 | break; |
eunmango | 97:b483e656bd14 | 59 | case 3: |
eunmango | 97:b483e656bd14 | 60 | ssd1306_swap(x, y); |
eunmango | 97:b483e656bd14 | 61 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 62 | break; |
eunmango | 97:b483e656bd14 | 63 | } |
eunmango | 97:b483e656bd14 | 64 | |
eunmango | 97:b483e656bd14 | 65 | // x is which column |
eunmango | 97:b483e656bd14 | 66 | uint8_t *p = &buffer[x + (y/8)*SSD1306_LCDWIDTH]; |
eunmango | 97:b483e656bd14 | 67 | uint8_t v = 1 << (y & 7); |
eunmango | 97:b483e656bd14 | 68 | |
eunmango | 97:b483e656bd14 | 69 | switch (color) { |
eunmango | 97:b483e656bd14 | 70 | case WHITE: |
eunmango | 97:b483e656bd14 | 71 | *p |= v; |
eunmango | 97:b483e656bd14 | 72 | break; |
eunmango | 97:b483e656bd14 | 73 | case BLACK: |
eunmango | 97:b483e656bd14 | 74 | *p &= ~v; |
eunmango | 97:b483e656bd14 | 75 | break; |
eunmango | 97:b483e656bd14 | 76 | case INVERSE: |
eunmango | 97:b483e656bd14 | 77 | *p ^= v; |
eunmango | 97:b483e656bd14 | 78 | break; |
eunmango | 97:b483e656bd14 | 79 | } |
eunmango | 97:b483e656bd14 | 80 | |
eunmango | 97:b483e656bd14 | 81 | } |
eunmango | 97:b483e656bd14 | 82 | |
eunmango | 97:b483e656bd14 | 83 | void SSD1306::_sendData(const uint8_t *blk, uint32_t len, bool isData) { |
eunmango | 97:b483e656bd14 | 84 | const uint8_t *p = blk; |
eunmango | 97:b483e656bd14 | 85 | |
eunmango | 97:b483e656bd14 | 86 | //pc.printf("SendData...\r\n"); |
eunmango | 97:b483e656bd14 | 87 | // now send the data |
eunmango | 97:b483e656bd14 | 88 | uint8_t control = 0x00 | (isData ? 0x40 : 0x00); |
eunmango | 97:b483e656bd14 | 89 | |
eunmango | 97:b483e656bd14 | 90 | |
eunmango | 97:b483e656bd14 | 91 | if (isData) { |
eunmango | 97:b483e656bd14 | 92 | i2c.start(); |
eunmango | 97:b483e656bd14 | 93 | //pc.printf("%0.2x ", *p); |
eunmango | 97:b483e656bd14 | 94 | i2c.write(0x3C<<1); |
eunmango | 97:b483e656bd14 | 95 | |
eunmango | 97:b483e656bd14 | 96 | //control |= 0x80; |
eunmango | 97:b483e656bd14 | 97 | i2c.write(control); |
eunmango | 97:b483e656bd14 | 98 | |
eunmango | 97:b483e656bd14 | 99 | for (int32_t i=0; i<len; i++, p++) { |
eunmango | 97:b483e656bd14 | 100 | //pc.printf("%0.2x ", *p); |
eunmango | 97:b483e656bd14 | 101 | int error = i2c.write(*p); |
eunmango | 97:b483e656bd14 | 102 | //int error = 1; |
eunmango | 97:b483e656bd14 | 103 | //wait(0.1); |
eunmango | 97:b483e656bd14 | 104 | if (error != 1) |
eunmango | 97:b483e656bd14 | 105 | pc.printf("I2C error: %0.2d\r\n", error); |
eunmango | 97:b483e656bd14 | 106 | } |
eunmango | 97:b483e656bd14 | 107 | i2c.stop(); |
eunmango | 97:b483e656bd14 | 108 | |
eunmango | 97:b483e656bd14 | 109 | } else { |
eunmango | 97:b483e656bd14 | 110 | for (int32_t i=0; i<len; i++, p++) { |
eunmango | 97:b483e656bd14 | 111 | i2c.start(); |
eunmango | 97:b483e656bd14 | 112 | //pc.printf("%0.2x ", *p); |
eunmango | 97:b483e656bd14 | 113 | i2c.write(0x3C<<1); |
eunmango | 97:b483e656bd14 | 114 | i2c.write(control); |
eunmango | 97:b483e656bd14 | 115 | int error = i2c.write(*p); |
eunmango | 97:b483e656bd14 | 116 | //int error = 1; |
eunmango | 97:b483e656bd14 | 117 | //wait(0.1); |
eunmango | 97:b483e656bd14 | 118 | i2c.stop(); |
eunmango | 97:b483e656bd14 | 119 | if (error != 1) |
eunmango | 97:b483e656bd14 | 120 | pc.printf("I2C error: %0.2d\r\n", error); |
eunmango | 97:b483e656bd14 | 121 | } |
eunmango | 97:b483e656bd14 | 122 | } |
eunmango | 97:b483e656bd14 | 123 | } |
eunmango | 97:b483e656bd14 | 124 | |
eunmango | 97:b483e656bd14 | 125 | void SSD1306::sendCommands(const uint8_t *blk, uint32_t len) { |
eunmango | 97:b483e656bd14 | 126 | _sendData(blk, len, false); |
eunmango | 97:b483e656bd14 | 127 | } |
eunmango | 97:b483e656bd14 | 128 | |
eunmango | 97:b483e656bd14 | 129 | void SSD1306::sendData(const uint8_t *blk, uint32_t len) { |
eunmango | 97:b483e656bd14 | 130 | _sendData(blk, len, true); |
eunmango | 97:b483e656bd14 | 131 | } |
eunmango | 97:b483e656bd14 | 132 | |
eunmango | 97:b483e656bd14 | 133 | void SSD1306::begin(bool reset) { |
eunmango | 97:b483e656bd14 | 134 | if (reset) { //pulse the reset pin -- maybe replace with RC network |
eunmango | 97:b483e656bd14 | 135 | rst = 1; |
eunmango | 97:b483e656bd14 | 136 | wait_ms(1); |
eunmango | 97:b483e656bd14 | 137 | rst = 0; |
eunmango | 97:b483e656bd14 | 138 | wait_ms(10); |
eunmango | 97:b483e656bd14 | 139 | rst = 1; |
eunmango | 97:b483e656bd14 | 140 | } |
eunmango | 97:b483e656bd14 | 141 | |
eunmango | 97:b483e656bd14 | 142 | const uint8_t cmds[] = { |
eunmango | 97:b483e656bd14 | 143 | SSD1306_DISPLAYOFF, |
eunmango | 97:b483e656bd14 | 144 | SSD1306_SETDISPLAYCLOCKDIV, |
eunmango | 97:b483e656bd14 | 145 | 0x80, // the suggested ratio 0x80 |
eunmango | 97:b483e656bd14 | 146 | SSD1306_SETMULTIPLEX, |
eunmango | 97:b483e656bd14 | 147 | SSD1306_LCDHEIGHT - 1, |
eunmango | 97:b483e656bd14 | 148 | SSD1306_SETDISPLAYOFFSET, |
eunmango | 97:b483e656bd14 | 149 | 0x0, // no offset |
eunmango | 97:b483e656bd14 | 150 | SSD1306_SETSTARTLINE | 0x0, // line #0 |
eunmango | 97:b483e656bd14 | 151 | SSD1306_CHARGEPUMP, |
eunmango | 97:b483e656bd14 | 152 | 0x14, |
eunmango | 97:b483e656bd14 | 153 | SSD1306_MEMORYMODE, |
eunmango | 97:b483e656bd14 | 154 | 0x00, // 0x0 act like ks0108 |
eunmango | 97:b483e656bd14 | 155 | SSD1306_SEGREMAP | 0x1, |
eunmango | 97:b483e656bd14 | 156 | SSD1306_COMSCANDEC, |
eunmango | 97:b483e656bd14 | 157 | SSD1306_SETCOMPINS, |
eunmango | 97:b483e656bd14 | 158 | 0x12, |
eunmango | 97:b483e656bd14 | 159 | SSD1306_SETCONTRAST, |
eunmango | 97:b483e656bd14 | 160 | 0xCF, |
eunmango | 97:b483e656bd14 | 161 | SSD1306_SETPRECHARGE, |
eunmango | 97:b483e656bd14 | 162 | 0xF1, |
eunmango | 97:b483e656bd14 | 163 | SSD1306_SETVCOMDETECT, |
eunmango | 97:b483e656bd14 | 164 | 0x40, |
eunmango | 97:b483e656bd14 | 165 | SSD1306_DISPLAYALLON_RESUME, |
eunmango | 97:b483e656bd14 | 166 | SSD1306_NORMALDISPLAY, |
eunmango | 97:b483e656bd14 | 167 | SSD1306_DEACTIVATE_SCROLL, |
eunmango | 97:b483e656bd14 | 168 | SSD1306_DISPLAYON //--turn on oled panel |
eunmango | 97:b483e656bd14 | 169 | }; |
eunmango | 97:b483e656bd14 | 170 | |
eunmango | 97:b483e656bd14 | 171 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 172 | |
eunmango | 97:b483e656bd14 | 173 | } |
eunmango | 97:b483e656bd14 | 174 | |
eunmango | 97:b483e656bd14 | 175 | |
eunmango | 97:b483e656bd14 | 176 | void SSD1306::display(void) { |
eunmango | 97:b483e656bd14 | 177 | const uint8_t cmds[] = { |
eunmango | 97:b483e656bd14 | 178 | SSD1306_COLUMNADDR, |
eunmango | 97:b483e656bd14 | 179 | 0, // Column start address (0 = reset) |
eunmango | 97:b483e656bd14 | 180 | SSD1306_LCDWIDTH - 1, // Column end address (127 = reset) |
eunmango | 97:b483e656bd14 | 181 | SSD1306_PAGEADDR, |
eunmango | 97:b483e656bd14 | 182 | 0, // Page start address (0 = reset) |
eunmango | 97:b483e656bd14 | 183 | 7 // Page end address |
eunmango | 97:b483e656bd14 | 184 | }; |
eunmango | 97:b483e656bd14 | 185 | |
eunmango | 97:b483e656bd14 | 186 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 187 | //now send the screen image |
eunmango | 97:b483e656bd14 | 188 | sendData(buffer, NUM_ELEMENTS(buffer)); |
eunmango | 97:b483e656bd14 | 189 | } |
eunmango | 97:b483e656bd14 | 190 | |
eunmango | 97:b483e656bd14 | 191 | void SSD1306::invertDisplay(uint8_t i) { |
eunmango | 97:b483e656bd14 | 192 | const uint8_t normalCmd[] = { SSD1306_NORMALDISPLAY }; |
eunmango | 97:b483e656bd14 | 193 | const uint8_t invertCmd[] = { SSD1306_INVERTDISPLAY }; |
eunmango | 97:b483e656bd14 | 194 | sendCommands( i ? invertCmd : normalCmd, 1); |
eunmango | 97:b483e656bd14 | 195 | } |
eunmango | 97:b483e656bd14 | 196 | |
eunmango | 97:b483e656bd14 | 197 | |
eunmango | 97:b483e656bd14 | 198 | void SSD1306::_scroll(uint8_t mode, uint8_t start, uint8_t stop) { |
eunmango | 97:b483e656bd14 | 199 | uint8_t cmds[] = { mode, 0, start, 0, stop, 0, 0xFF, SSD1306_ACTIVATE_SCROLL }; |
eunmango | 97:b483e656bd14 | 200 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 201 | } |
eunmango | 97:b483e656bd14 | 202 | // startscrollright |
eunmango | 97:b483e656bd14 | 203 | // Activate a right handed scroll for rows start through stop |
eunmango | 97:b483e656bd14 | 204 | // Hint, the display is 16 rows tall. To scroll the whole display, run: |
eunmango | 97:b483e656bd14 | 205 | // display.scrollright(0x00, 0x0F) |
eunmango | 97:b483e656bd14 | 206 | void SSD1306::startscrollright(uint8_t start, uint8_t stop) { |
eunmango | 97:b483e656bd14 | 207 | _scroll(SSD1306_RIGHT_HORIZONTAL_SCROLL, start, stop); |
eunmango | 97:b483e656bd14 | 208 | } |
eunmango | 97:b483e656bd14 | 209 | |
eunmango | 97:b483e656bd14 | 210 | // startscrollleft |
eunmango | 97:b483e656bd14 | 211 | // Activate a right handed scroll for rows start through stop |
eunmango | 97:b483e656bd14 | 212 | // Hint, the display is 16 rows tall. To scroll the whole display, run: |
eunmango | 97:b483e656bd14 | 213 | // display.scrollright(0x00, 0x0F) |
eunmango | 97:b483e656bd14 | 214 | void SSD1306::startscrollleft(uint8_t start, uint8_t stop) { |
eunmango | 97:b483e656bd14 | 215 | _scroll(SSD1306_LEFT_HORIZONTAL_SCROLL, start, stop); |
eunmango | 97:b483e656bd14 | 216 | } |
eunmango | 97:b483e656bd14 | 217 | |
eunmango | 97:b483e656bd14 | 218 | // startscrolldiagright |
eunmango | 97:b483e656bd14 | 219 | // Activate a diagonal scroll for rows start through stop |
eunmango | 97:b483e656bd14 | 220 | // Hint, the display is 16 rows tall. To scroll the whole display, run: |
eunmango | 97:b483e656bd14 | 221 | // display.scrollright(0x00, 0x0F) |
eunmango | 97:b483e656bd14 | 222 | void SSD1306::startscrolldiagright(uint8_t start, uint8_t stop) { |
eunmango | 97:b483e656bd14 | 223 | uint8_t cmds[] = { |
eunmango | 97:b483e656bd14 | 224 | SSD1306_SET_VERTICAL_SCROLL_AREA, |
eunmango | 97:b483e656bd14 | 225 | 0X00, |
eunmango | 97:b483e656bd14 | 226 | SSD1306_LCDHEIGHT, |
eunmango | 97:b483e656bd14 | 227 | SSD1306_VERTICAL_AND_RIGHT_HORIZONTAL_SCROLL, |
eunmango | 97:b483e656bd14 | 228 | 0X00, |
eunmango | 97:b483e656bd14 | 229 | start, |
eunmango | 97:b483e656bd14 | 230 | 0X00, |
eunmango | 97:b483e656bd14 | 231 | stop, |
eunmango | 97:b483e656bd14 | 232 | 0X01, |
eunmango | 97:b483e656bd14 | 233 | SSD1306_ACTIVATE_SCROLL |
eunmango | 97:b483e656bd14 | 234 | }; |
eunmango | 97:b483e656bd14 | 235 | |
eunmango | 97:b483e656bd14 | 236 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 237 | } |
eunmango | 97:b483e656bd14 | 238 | |
eunmango | 97:b483e656bd14 | 239 | // startscrolldiagleft |
eunmango | 97:b483e656bd14 | 240 | // Activate a diagonal scroll for rows start through stop |
eunmango | 97:b483e656bd14 | 241 | // Hint, the display is 16 rows tall. To scroll the whole display, run: |
eunmango | 97:b483e656bd14 | 242 | // display.scrollright(0x00, 0x0F) |
eunmango | 97:b483e656bd14 | 243 | void SSD1306::startscrolldiagleft(uint8_t start, uint8_t stop) { |
eunmango | 97:b483e656bd14 | 244 | uint8_t cmds[] = { |
eunmango | 97:b483e656bd14 | 245 | SSD1306_SET_VERTICAL_SCROLL_AREA, |
eunmango | 97:b483e656bd14 | 246 | 0X00, |
eunmango | 97:b483e656bd14 | 247 | SSD1306_LCDHEIGHT, |
eunmango | 97:b483e656bd14 | 248 | SSD1306_VERTICAL_AND_LEFT_HORIZONTAL_SCROLL, |
eunmango | 97:b483e656bd14 | 249 | 0X00, |
eunmango | 97:b483e656bd14 | 250 | start, |
eunmango | 97:b483e656bd14 | 251 | 0X00, |
eunmango | 97:b483e656bd14 | 252 | stop, |
eunmango | 97:b483e656bd14 | 253 | 0X01, |
eunmango | 97:b483e656bd14 | 254 | SSD1306_ACTIVATE_SCROLL |
eunmango | 97:b483e656bd14 | 255 | }; |
eunmango | 97:b483e656bd14 | 256 | |
eunmango | 97:b483e656bd14 | 257 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 258 | } |
eunmango | 97:b483e656bd14 | 259 | |
eunmango | 97:b483e656bd14 | 260 | |
eunmango | 97:b483e656bd14 | 261 | void SSD1306::stopscroll(void) { |
eunmango | 97:b483e656bd14 | 262 | const uint8_t cmds[] = { SSD1306_DEACTIVATE_SCROLL }; |
eunmango | 97:b483e656bd14 | 263 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 264 | } |
eunmango | 97:b483e656bd14 | 265 | |
eunmango | 97:b483e656bd14 | 266 | // Dim the display |
eunmango | 97:b483e656bd14 | 267 | // dim = true: display is dimmed |
eunmango | 97:b483e656bd14 | 268 | // dim = false: display is normal |
eunmango | 97:b483e656bd14 | 269 | void SSD1306::dim(bool dim) { |
eunmango | 97:b483e656bd14 | 270 | // the range of contrast to too small to be really useful |
eunmango | 97:b483e656bd14 | 271 | // it is useful to dim the display |
eunmango | 97:b483e656bd14 | 272 | uint8_t cmds[] = {SSD1306_SETCONTRAST, dim ? 0 : 0xCF}; |
eunmango | 97:b483e656bd14 | 273 | sendCommands(cmds, NUM_ELEMENTS(cmds)); |
eunmango | 97:b483e656bd14 | 274 | } |
eunmango | 97:b483e656bd14 | 275 | |
eunmango | 97:b483e656bd14 | 276 | // clear everything |
eunmango | 97:b483e656bd14 | 277 | void SSD1306::clearDisplay(void) { |
eunmango | 97:b483e656bd14 | 278 | memset(buffer, 0, (SSD1306_LCDWIDTH * SSD1306_LCDHEIGHT / 8)); |
eunmango | 97:b483e656bd14 | 279 | } |
eunmango | 97:b483e656bd14 | 280 | |
eunmango | 97:b483e656bd14 | 281 | #if 1 |
eunmango | 97:b483e656bd14 | 282 | void SSD1306::drawFastHLine(int16_t x, int16_t y, int16_t w, uint16_t color) { |
eunmango | 97:b483e656bd14 | 283 | bool bSwap = false; |
eunmango | 97:b483e656bd14 | 284 | switch (rotation) { |
eunmango | 97:b483e656bd14 | 285 | case 0: |
eunmango | 97:b483e656bd14 | 286 | // 0 degree rotation, do nothing |
eunmango | 97:b483e656bd14 | 287 | break; |
eunmango | 97:b483e656bd14 | 288 | case 1: |
eunmango | 97:b483e656bd14 | 289 | // 90 degree rotation, swap x & y for rotation, then invert x |
eunmango | 97:b483e656bd14 | 290 | bSwap = true; |
eunmango | 97:b483e656bd14 | 291 | ssd1306_swap(x, y); |
eunmango | 97:b483e656bd14 | 292 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 293 | break; |
eunmango | 97:b483e656bd14 | 294 | case 2: |
eunmango | 97:b483e656bd14 | 295 | // 180 degree rotation, invert x and y - then shift y around for height. |
eunmango | 97:b483e656bd14 | 296 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 297 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 298 | x -= (w - 1); |
eunmango | 97:b483e656bd14 | 299 | break; |
eunmango | 97:b483e656bd14 | 300 | case 3: |
eunmango | 97:b483e656bd14 | 301 | // 270 degree rotation, swap x & y for rotation, then invert y and adjust y for w (not to become h) |
eunmango | 97:b483e656bd14 | 302 | bSwap = true; |
eunmango | 97:b483e656bd14 | 303 | ssd1306_swap(x, y); |
eunmango | 97:b483e656bd14 | 304 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 305 | y -= (w - 1); |
eunmango | 97:b483e656bd14 | 306 | break; |
eunmango | 97:b483e656bd14 | 307 | } |
eunmango | 97:b483e656bd14 | 308 | |
eunmango | 97:b483e656bd14 | 309 | if (bSwap) { |
eunmango | 97:b483e656bd14 | 310 | drawFastVLineInternal(x, y, w, color); |
eunmango | 97:b483e656bd14 | 311 | } else { |
eunmango | 97:b483e656bd14 | 312 | drawFastHLineInternal(x, y, w, color); |
eunmango | 97:b483e656bd14 | 313 | } |
eunmango | 97:b483e656bd14 | 314 | } |
eunmango | 97:b483e656bd14 | 315 | #endif |
eunmango | 97:b483e656bd14 | 316 | |
eunmango | 97:b483e656bd14 | 317 | |
eunmango | 97:b483e656bd14 | 318 | void SSD1306::drawFastHLineInternal(int16_t x, int16_t y, int16_t w, |
eunmango | 97:b483e656bd14 | 319 | uint16_t color) { |
eunmango | 97:b483e656bd14 | 320 | // Do bounds/limit checks |
eunmango | 97:b483e656bd14 | 321 | if (y < 0 || y >= HEIGHT) { |
eunmango | 97:b483e656bd14 | 322 | return; |
eunmango | 97:b483e656bd14 | 323 | } |
eunmango | 97:b483e656bd14 | 324 | |
eunmango | 97:b483e656bd14 | 325 | // make sure we don't try to draw below 0 |
eunmango | 97:b483e656bd14 | 326 | if (x < 0) { |
eunmango | 97:b483e656bd14 | 327 | w += x; |
eunmango | 97:b483e656bd14 | 328 | x = 0; |
eunmango | 97:b483e656bd14 | 329 | } |
eunmango | 97:b483e656bd14 | 330 | |
eunmango | 97:b483e656bd14 | 331 | // make sure we don't go off the edge of the display |
eunmango | 97:b483e656bd14 | 332 | if ((x + w) > WIDTH) { |
eunmango | 97:b483e656bd14 | 333 | w = (WIDTH - x); |
eunmango | 97:b483e656bd14 | 334 | } |
eunmango | 97:b483e656bd14 | 335 | |
eunmango | 97:b483e656bd14 | 336 | // if our width is now negative, punt |
eunmango | 97:b483e656bd14 | 337 | if (w <= 0) { |
eunmango | 97:b483e656bd14 | 338 | return; |
eunmango | 97:b483e656bd14 | 339 | } |
eunmango | 97:b483e656bd14 | 340 | |
eunmango | 97:b483e656bd14 | 341 | // set up the pointer for movement through the buffer |
eunmango | 97:b483e656bd14 | 342 | register uint8_t *pBuf = buffer; |
eunmango | 97:b483e656bd14 | 343 | // adjust the buffer pointer for the current row |
eunmango | 97:b483e656bd14 | 344 | pBuf += ((y / 8) * SSD1306_LCDWIDTH); |
eunmango | 97:b483e656bd14 | 345 | // and offset x columns in |
eunmango | 97:b483e656bd14 | 346 | pBuf += x; |
eunmango | 97:b483e656bd14 | 347 | |
eunmango | 97:b483e656bd14 | 348 | register uint8_t mask = 1 << (y & 7); |
eunmango | 97:b483e656bd14 | 349 | |
eunmango | 97:b483e656bd14 | 350 | switch (color) { |
eunmango | 97:b483e656bd14 | 351 | case WHITE: |
eunmango | 97:b483e656bd14 | 352 | while (w--) |
eunmango | 97:b483e656bd14 | 353 | *pBuf++ |= mask; |
eunmango | 97:b483e656bd14 | 354 | break; |
eunmango | 97:b483e656bd14 | 355 | case BLACK: |
eunmango | 97:b483e656bd14 | 356 | mask = ~mask; |
eunmango | 97:b483e656bd14 | 357 | while (w--) |
eunmango | 97:b483e656bd14 | 358 | *pBuf++ &= mask; |
eunmango | 97:b483e656bd14 | 359 | break; |
eunmango | 97:b483e656bd14 | 360 | case INVERSE: |
eunmango | 97:b483e656bd14 | 361 | while (w--) |
eunmango | 97:b483e656bd14 | 362 | *pBuf++ ^= mask; |
eunmango | 97:b483e656bd14 | 363 | break; |
eunmango | 97:b483e656bd14 | 364 | } |
eunmango | 97:b483e656bd14 | 365 | } |
eunmango | 97:b483e656bd14 | 366 | |
eunmango | 97:b483e656bd14 | 367 | void SSD1306::drawFastVLine(int16_t x, int16_t y, int16_t h, uint16_t color) { |
eunmango | 97:b483e656bd14 | 368 | bool bSwap = false; |
eunmango | 97:b483e656bd14 | 369 | switch (rotation) { |
eunmango | 97:b483e656bd14 | 370 | case 0: |
eunmango | 97:b483e656bd14 | 371 | break; |
eunmango | 97:b483e656bd14 | 372 | case 1: |
eunmango | 97:b483e656bd14 | 373 | // 90 degree rotation, swap x & y for rotation, then invert x and adjust x for h (now to become w) |
eunmango | 97:b483e656bd14 | 374 | bSwap = true; |
eunmango | 97:b483e656bd14 | 375 | ssd1306_swap(x, y) |
eunmango | 97:b483e656bd14 | 376 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 377 | x -= (h - 1); |
eunmango | 97:b483e656bd14 | 378 | break; |
eunmango | 97:b483e656bd14 | 379 | case 2: |
eunmango | 97:b483e656bd14 | 380 | // 180 degree rotation, invert x and y - then shift y around for height. |
eunmango | 97:b483e656bd14 | 381 | x = WIDTH - x - 1; |
eunmango | 97:b483e656bd14 | 382 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 383 | y -= (h - 1); |
eunmango | 97:b483e656bd14 | 384 | break; |
eunmango | 97:b483e656bd14 | 385 | case 3: |
eunmango | 97:b483e656bd14 | 386 | // 270 degree rotation, swap x & y for rotation, then invert y |
eunmango | 97:b483e656bd14 | 387 | bSwap = true; |
eunmango | 97:b483e656bd14 | 388 | ssd1306_swap(x, y) |
eunmango | 97:b483e656bd14 | 389 | y = HEIGHT - y - 1; |
eunmango | 97:b483e656bd14 | 390 | break; |
eunmango | 97:b483e656bd14 | 391 | } |
eunmango | 97:b483e656bd14 | 392 | |
eunmango | 97:b483e656bd14 | 393 | if (bSwap) { |
eunmango | 97:b483e656bd14 | 394 | drawFastHLineInternal(x, y, h, color); |
eunmango | 97:b483e656bd14 | 395 | } else { |
eunmango | 97:b483e656bd14 | 396 | drawFastVLineInternal(x, y, h, color); |
eunmango | 97:b483e656bd14 | 397 | } |
eunmango | 97:b483e656bd14 | 398 | } |
eunmango | 97:b483e656bd14 | 399 | |
eunmango | 97:b483e656bd14 | 400 | void SSD1306::drawFastVLineInternal(int16_t x, int16_t __y, int16_t __h, uint16_t color) { |
eunmango | 97:b483e656bd14 | 401 | |
eunmango | 97:b483e656bd14 | 402 | // do nothing if we're off the left or right side of the screen |
eunmango | 97:b483e656bd14 | 403 | if (x < 0 || x >= WIDTH) { |
eunmango | 97:b483e656bd14 | 404 | return; |
eunmango | 97:b483e656bd14 | 405 | } |
eunmango | 97:b483e656bd14 | 406 | |
eunmango | 97:b483e656bd14 | 407 | // make sure we don't try to draw below 0 |
eunmango | 97:b483e656bd14 | 408 | if (__y < 0) { |
eunmango | 97:b483e656bd14 | 409 | // __y is negative, this will subtract enough from __h to account for __y being 0 |
eunmango | 97:b483e656bd14 | 410 | __h += __y; |
eunmango | 97:b483e656bd14 | 411 | __y = 0; |
eunmango | 97:b483e656bd14 | 412 | |
eunmango | 97:b483e656bd14 | 413 | } |
eunmango | 97:b483e656bd14 | 414 | |
eunmango | 97:b483e656bd14 | 415 | // make sure we don't go past the height of the display |
eunmango | 97:b483e656bd14 | 416 | if ((__y + __h) > HEIGHT) { |
eunmango | 97:b483e656bd14 | 417 | __h = (HEIGHT - __y); |
eunmango | 97:b483e656bd14 | 418 | } |
eunmango | 97:b483e656bd14 | 419 | |
eunmango | 97:b483e656bd14 | 420 | // if our height is now negative, punt |
eunmango | 97:b483e656bd14 | 421 | if (__h <= 0) { |
eunmango | 97:b483e656bd14 | 422 | return; |
eunmango | 97:b483e656bd14 | 423 | } |
eunmango | 97:b483e656bd14 | 424 | |
eunmango | 97:b483e656bd14 | 425 | // this display doesn't need ints for coordinates, use local byte registers for faster juggling |
eunmango | 97:b483e656bd14 | 426 | register uint8_t y = __y; |
eunmango | 97:b483e656bd14 | 427 | register uint8_t h = __h; |
eunmango | 97:b483e656bd14 | 428 | |
eunmango | 97:b483e656bd14 | 429 | // set up the pointer for fast movement through the buffer |
eunmango | 97:b483e656bd14 | 430 | register uint8_t *pBuf = buffer; |
eunmango | 97:b483e656bd14 | 431 | // adjust the buffer pointer for the current row |
eunmango | 97:b483e656bd14 | 432 | pBuf += ((y / 8) * SSD1306_LCDWIDTH); |
eunmango | 97:b483e656bd14 | 433 | // and offset x columns in |
eunmango | 97:b483e656bd14 | 434 | pBuf += x; |
eunmango | 97:b483e656bd14 | 435 | |
eunmango | 97:b483e656bd14 | 436 | // do the first partial byte, if necessary - this requires some masking |
eunmango | 97:b483e656bd14 | 437 | register uint8_t mod = (y & 7); |
eunmango | 97:b483e656bd14 | 438 | if (mod) { |
eunmango | 97:b483e656bd14 | 439 | // mask off the high n bits we want to set |
eunmango | 97:b483e656bd14 | 440 | mod = 8 - mod; |
eunmango | 97:b483e656bd14 | 441 | |
eunmango | 97:b483e656bd14 | 442 | // note - lookup table results in a nearly 10% performance improvement in fill* functions |
eunmango | 97:b483e656bd14 | 443 | // register uint8_t mask = ~(0xFF >> (mod)); |
eunmango | 97:b483e656bd14 | 444 | static uint8_t premask[8] = { 0x00, 0x80, 0xC0, 0xE0, 0xF0, 0xF8, 0xFC, |
eunmango | 97:b483e656bd14 | 445 | 0xFE }; |
eunmango | 97:b483e656bd14 | 446 | register uint8_t mask = premask[mod]; |
eunmango | 97:b483e656bd14 | 447 | |
eunmango | 97:b483e656bd14 | 448 | // adjust the mask if we're not going to reach the end of this byte |
eunmango | 97:b483e656bd14 | 449 | if (h < mod) { |
eunmango | 97:b483e656bd14 | 450 | mask &= (0XFF >> (mod - h)); |
eunmango | 97:b483e656bd14 | 451 | } |
eunmango | 97:b483e656bd14 | 452 | |
eunmango | 97:b483e656bd14 | 453 | switch (color) { |
eunmango | 97:b483e656bd14 | 454 | case WHITE: |
eunmango | 97:b483e656bd14 | 455 | *pBuf |= mask; |
eunmango | 97:b483e656bd14 | 456 | break; |
eunmango | 97:b483e656bd14 | 457 | case BLACK: |
eunmango | 97:b483e656bd14 | 458 | *pBuf &= ~mask; |
eunmango | 97:b483e656bd14 | 459 | break; |
eunmango | 97:b483e656bd14 | 460 | case INVERSE: |
eunmango | 97:b483e656bd14 | 461 | *pBuf ^= mask; |
eunmango | 97:b483e656bd14 | 462 | break; |
eunmango | 97:b483e656bd14 | 463 | } |
eunmango | 97:b483e656bd14 | 464 | |
eunmango | 97:b483e656bd14 | 465 | // fast exit if we're done here! |
eunmango | 97:b483e656bd14 | 466 | if (h < mod) { |
eunmango | 97:b483e656bd14 | 467 | return; |
eunmango | 97:b483e656bd14 | 468 | } |
eunmango | 97:b483e656bd14 | 469 | |
eunmango | 97:b483e656bd14 | 470 | h -= mod; |
eunmango | 97:b483e656bd14 | 471 | |
eunmango | 97:b483e656bd14 | 472 | pBuf += SSD1306_LCDWIDTH; |
eunmango | 97:b483e656bd14 | 473 | } |
eunmango | 97:b483e656bd14 | 474 | |
eunmango | 97:b483e656bd14 | 475 | // write solid bytes while we can - effectively doing 8 rows at a time |
eunmango | 97:b483e656bd14 | 476 | if (h >= 8) { |
eunmango | 97:b483e656bd14 | 477 | if (color == INVERSE) { // separate copy of the code so we don't impact performance of the black/white write version with an extra comparison per loop |
eunmango | 97:b483e656bd14 | 478 | do { |
eunmango | 97:b483e656bd14 | 479 | *pBuf = ~(*pBuf); |
eunmango | 97:b483e656bd14 | 480 | |
eunmango | 97:b483e656bd14 | 481 | // adjust the buffer forward 8 rows worth of data |
eunmango | 97:b483e656bd14 | 482 | pBuf += SSD1306_LCDWIDTH; |
eunmango | 97:b483e656bd14 | 483 | |
eunmango | 97:b483e656bd14 | 484 | // adjust h & y (there's got to be a faster way for me to do this, but this should still help a fair bit for now) |
eunmango | 97:b483e656bd14 | 485 | h -= 8; |
eunmango | 97:b483e656bd14 | 486 | } while (h >= 8); |
eunmango | 97:b483e656bd14 | 487 | } else { |
eunmango | 97:b483e656bd14 | 488 | // store a local value to work with |
eunmango | 97:b483e656bd14 | 489 | register uint8_t val = (color == WHITE) ? 255 : 0; |
eunmango | 97:b483e656bd14 | 490 | |
eunmango | 97:b483e656bd14 | 491 | do { |
eunmango | 97:b483e656bd14 | 492 | // write our value in |
eunmango | 97:b483e656bd14 | 493 | *pBuf = val; |
eunmango | 97:b483e656bd14 | 494 | |
eunmango | 97:b483e656bd14 | 495 | // adjust the buffer forward 8 rows worth of data |
eunmango | 97:b483e656bd14 | 496 | pBuf += SSD1306_LCDWIDTH; |
eunmango | 97:b483e656bd14 | 497 | |
eunmango | 97:b483e656bd14 | 498 | // adjust h & y (there's got to be a faster way for me to do this, but this should still help a fair bit for now) |
eunmango | 97:b483e656bd14 | 499 | h -= 8; |
eunmango | 97:b483e656bd14 | 500 | } while (h >= 8); |
eunmango | 97:b483e656bd14 | 501 | } |
eunmango | 97:b483e656bd14 | 502 | } |
eunmango | 97:b483e656bd14 | 503 | |
eunmango | 97:b483e656bd14 | 504 | // now do the final partial byte, if necessary |
eunmango | 97:b483e656bd14 | 505 | if (h) { |
eunmango | 97:b483e656bd14 | 506 | mod = h & 7; |
eunmango | 97:b483e656bd14 | 507 | // this time we want to mask the low bits of the byte, vs the high bits we did above |
eunmango | 97:b483e656bd14 | 508 | // register uint8_t mask = (1 << mod) - 1; |
eunmango | 97:b483e656bd14 | 509 | // note - lookup table results in a nearly 10% performance improvement in fill* functions |
eunmango | 97:b483e656bd14 | 510 | static uint8_t postmask[8] = { 0x00, 0x01, 0x03, 0x07, 0x0F, 0x1F, 0x3F, |
eunmango | 97:b483e656bd14 | 511 | 0x7F }; |
eunmango | 97:b483e656bd14 | 512 | register uint8_t mask = postmask[mod]; |
eunmango | 97:b483e656bd14 | 513 | switch (color) { |
eunmango | 97:b483e656bd14 | 514 | case WHITE: |
eunmango | 97:b483e656bd14 | 515 | *pBuf |= mask; |
eunmango | 97:b483e656bd14 | 516 | break; |
eunmango | 97:b483e656bd14 | 517 | case BLACK: |
eunmango | 97:b483e656bd14 | 518 | *pBuf &= ~mask; |
eunmango | 97:b483e656bd14 | 519 | break; |
eunmango | 97:b483e656bd14 | 520 | case INVERSE: |
eunmango | 97:b483e656bd14 | 521 | *pBuf ^= mask; |
eunmango | 97:b483e656bd14 | 522 | break; |
eunmango | 97:b483e656bd14 | 523 | } |
eunmango | 97:b483e656bd14 | 524 | } |
eunmango | 97:b483e656bd14 | 525 | } |