Jeremy Ogus
Updated for mbed: Simple library for interfacing to Nokia 5110 LCD display (as found on the SparkFun website).
Fork of
N5110
by 
Craig Evans
N5110.cpp@17:780a542d5f8b, 2015-03-17 (annotated)
- Committer:
- eencae
- Date:
- Tue Mar 17 12:56:03 2015 +0000
- Revision:
- 17:780a542d5f8b
- Parent:
- 15:ee645611ff94
- Child:
- 18:1af393359298
Added functions for drawing primitive shapes (lines, circles and rectangles). Can draw white, black and dotted lines. Can draw transparent (with outline), black fill and white fill circles and rectangles.
Who changed what in which revision?
| User | Revision | Line number | New contents of line |
|---|---|---|---|
| eencae | 5:6ea180eef702 | 1 | /** |
| eencae | 5:6ea180eef702 | 2 | @file N5110.cpp |
| eencae | 5:6ea180eef702 | 3 | |
| eencae | 5:6ea180eef702 | 4 | @brief Member functions implementations |
| eencae | 5:6ea180eef702 | 5 | |
| eencae | 5:6ea180eef702 | 6 | */ |
| eencae | 0:d563e74f0ae9 | 7 | #include "mbed.h" |
| eencae | 0:d563e74f0ae9 | 8 | #include "N5110.h" |
| eencae | 0:d563e74f0ae9 | 9 | |
| eencae | 2:e93021cfb0a9 | 10 | |
| eencae | 1:df68f34cd32d | 11 | N5110::N5110(PinName pwrPin, PinName scePin, PinName rstPin, PinName dcPin, PinName mosiPin, PinName sclkPin, PinName ledPin) |
| eencae | 0:d563e74f0ae9 | 12 | { |
| eencae | 13:908644099648 | 13 | |
| eencae | 0:d563e74f0ae9 | 14 | spi = new SPI(mosiPin,NC,sclkPin); // create new SPI instance and initialise |
| eencae | 13:908644099648 | 15 | initSPI(); |
| eencae | 13:908644099648 | 16 | |
| eencae | 6:adb79338d40f | 17 | // set up pins as required |
| eencae | 0:d563e74f0ae9 | 18 | led = new PwmOut(ledPin); |
| eencae | 0:d563e74f0ae9 | 19 | pwr = new DigitalOut(pwrPin); |
| eencae | 0:d563e74f0ae9 | 20 | sce = new DigitalOut(scePin); |
| eencae | 0:d563e74f0ae9 | 21 | rst = new DigitalOut(rstPin); |
| eencae | 0:d563e74f0ae9 | 22 | dc = new DigitalOut(dcPin); |
| eencae | 0:d563e74f0ae9 | 23 | |
| eencae | 0:d563e74f0ae9 | 24 | } |
| eencae | 0:d563e74f0ae9 | 25 | |
| eencae | 6:adb79338d40f | 26 | // initialise function - powers up and sends the initialisation commands |
| eencae | 0:d563e74f0ae9 | 27 | void N5110::init() |
| eencae | 0:d563e74f0ae9 | 28 | { |
| eencae | 6:adb79338d40f | 29 | turnOn(); // power up |
| eencae | 6:adb79338d40f | 30 | wait_ms(10); // small delay seems to prevent spurious pixels during mbed reset |
| eencae | 6:adb79338d40f | 31 | reset(); // reset LCD - must be done within 100 ms |
| eencae | 0:d563e74f0ae9 | 32 | |
| eencae | 0:d563e74f0ae9 | 33 | // function set - extended |
| eencae | 0:d563e74f0ae9 | 34 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_EXTENDED_MODE); |
| eencae | 6:adb79338d40f | 35 | // Don't completely understand these parameters - they seem to work as they are |
| eencae | 6:adb79338d40f | 36 | // Consult the datasheet if you need to change them |
| eencae | 1:df68f34cd32d | 37 | sendCommand(CMD_VOP_7V38); // operating voltage - these values are from Chris Yan's Library |
| eencae | 0:d563e74f0ae9 | 38 | sendCommand(CMD_TC_TEMP_2); // temperature control |
| eencae | 0:d563e74f0ae9 | 39 | sendCommand(CMD_BI_MUX_48); // bias |
| eencae | 0:d563e74f0ae9 | 40 | |
| eencae | 0:d563e74f0ae9 | 41 | // function set - basic |
| eencae | 0:d563e74f0ae9 | 42 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_BASIC_MODE); |
| eencae | 1:df68f34cd32d | 43 | normalMode(); // normal video mode by default |
| eencae | 0:d563e74f0ae9 | 44 | sendCommand(CMD_DC_NORMAL_MODE); // black on white |
| eencae | 0:d563e74f0ae9 | 45 | |
| eencae | 0:d563e74f0ae9 | 46 | // RAM is undefined at power-up so clear |
| eencae | 0:d563e74f0ae9 | 47 | clearRAM(); |
| eencae | 0:d563e74f0ae9 | 48 | |
| eencae | 0:d563e74f0ae9 | 49 | } |
| eencae | 13:908644099648 | 50 | |
| eencae | 13:908644099648 | 51 | // sets normal video mode (black on white) |
| eencae | 13:908644099648 | 52 | void N5110::normalMode() |
| eencae | 13:908644099648 | 53 | { |
| eencae | 13:908644099648 | 54 | sendCommand(CMD_DC_NORMAL_MODE); |
| eencae | 13:908644099648 | 55 | |
| eencae | 1:df68f34cd32d | 56 | } |
| eencae | 1:df68f34cd32d | 57 | |
| eencae | 13:908644099648 | 58 | // sets normal video mode (white on black) |
| eencae | 13:908644099648 | 59 | void N5110::inverseMode() |
| eencae | 13:908644099648 | 60 | { |
| eencae | 13:908644099648 | 61 | sendCommand(CMD_DC_INVERT_VIDEO); |
| eencae | 1:df68f34cd32d | 62 | } |
| eencae | 0:d563e74f0ae9 | 63 | |
| eencae | 0:d563e74f0ae9 | 64 | // function to power up the LCD and backlight |
| eencae | 0:d563e74f0ae9 | 65 | void N5110::turnOn() |
| eencae | 0:d563e74f0ae9 | 66 | { |
| eencae | 0:d563e74f0ae9 | 67 | // set brightness of LED - 0.0 to 1.0 - default is 50% |
| eencae | 0:d563e74f0ae9 | 68 | setBrightness(0.5); |
| eencae | 0:d563e74f0ae9 | 69 | pwr->write(1); // apply power |
| eencae | 0:d563e74f0ae9 | 70 | } |
| eencae | 0:d563e74f0ae9 | 71 | |
| eencae | 0:d563e74f0ae9 | 72 | // function to power down LCD |
| eencae | 0:d563e74f0ae9 | 73 | void N5110::turnOff() |
| eencae | 0:d563e74f0ae9 | 74 | { |
| eencae | 0:d563e74f0ae9 | 75 | setBrightness(0.0); // turn backlight off |
| eencae | 0:d563e74f0ae9 | 76 | clearRAM(); // clear RAM to ensure specified current consumption |
| eencae | 10:6f3abb40202b | 77 | // send command to ensure we are in basic mode |
| eencae | 0:d563e74f0ae9 | 78 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_BASIC_MODE); |
| eencae | 6:adb79338d40f | 79 | // clear the display |
| eencae | 0:d563e74f0ae9 | 80 | sendCommand(CMD_DC_CLEAR_DISPLAY); |
| eencae | 6:adb79338d40f | 81 | // enter the extended mode and power down |
| eencae | 0:d563e74f0ae9 | 82 | sendCommand(0x20 | CMD_FS_POWER_DOWN_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_EXTENDED_MODE); |
| eencae | 6:adb79338d40f | 83 | // small delay and then turn off the power pin |
| eencae | 6:adb79338d40f | 84 | wait_ms(10); |
| eencae | 0:d563e74f0ae9 | 85 | pwr->write(0); |
| eencae | 0:d563e74f0ae9 | 86 | |
| eencae | 0:d563e74f0ae9 | 87 | } |
| eencae | 0:d563e74f0ae9 | 88 | |
| eencae | 0:d563e74f0ae9 | 89 | // function to change LED backlight brightness |
| eencae | 0:d563e74f0ae9 | 90 | void N5110::setBrightness(float brightness) |
| eencae | 0:d563e74f0ae9 | 91 | { |
| eencae | 0:d563e74f0ae9 | 92 | // check whether brightness is within range |
| eencae | 0:d563e74f0ae9 | 93 | if (brightness < 0.0) |
| eencae | 0:d563e74f0ae9 | 94 | brightness = 0.0; |
| eencae | 0:d563e74f0ae9 | 95 | if (brightness > 1.0) |
| eencae | 0:d563e74f0ae9 | 96 | brightness = 1.0; |
| eencae | 0:d563e74f0ae9 | 97 | // set PWM duty cycle |
| eencae | 0:d563e74f0ae9 | 98 | led->write(brightness); |
| eencae | 0:d563e74f0ae9 | 99 | } |
| eencae | 0:d563e74f0ae9 | 100 | |
| eencae | 0:d563e74f0ae9 | 101 | |
| eencae | 0:d563e74f0ae9 | 102 | // pulse the active low reset line |
| eencae | 0:d563e74f0ae9 | 103 | void N5110::reset() |
| eencae | 0:d563e74f0ae9 | 104 | { |
| eencae | 0:d563e74f0ae9 | 105 | rst->write(0); // reset the LCD |
| eencae | 0:d563e74f0ae9 | 106 | rst->write(1); |
| eencae | 0:d563e74f0ae9 | 107 | } |
| eencae | 0:d563e74f0ae9 | 108 | |
| eencae | 0:d563e74f0ae9 | 109 | // function to initialise SPI peripheral |
| eencae | 0:d563e74f0ae9 | 110 | void N5110::initSPI() |
| eencae | 0:d563e74f0ae9 | 111 | { |
| eencae | 0:d563e74f0ae9 | 112 | spi->format(8,1); // 8 bits, Mode 1 - polarity 0, phase 1 - base value of clock is 0, data captured on falling edge/propagated on rising edge |
| eencae | 0:d563e74f0ae9 | 113 | spi->frequency(4000000); // maximum of screen is 4 MHz |
| eencae | 0:d563e74f0ae9 | 114 | } |
| eencae | 0:d563e74f0ae9 | 115 | |
| eencae | 6:adb79338d40f | 116 | // send a command to the display |
| eencae | 0:d563e74f0ae9 | 117 | void N5110::sendCommand(unsigned char command) |
| eencae | 0:d563e74f0ae9 | 118 | { |
| eencae | 0:d563e74f0ae9 | 119 | dc->write(0); // set DC low for command |
| eencae | 0:d563e74f0ae9 | 120 | sce->write(0); // set CE low to begin frame |
| eencae | 0:d563e74f0ae9 | 121 | spi->write(command); // send command |
| eencae | 0:d563e74f0ae9 | 122 | dc->write(1); // turn back to data by default |
| eencae | 0:d563e74f0ae9 | 123 | sce->write(1); // set CE high to end frame (expected for transmission of single byte) |
| eencae | 0:d563e74f0ae9 | 124 | |
| eencae | 0:d563e74f0ae9 | 125 | } |
| eencae | 0:d563e74f0ae9 | 126 | |
| eencae | 6:adb79338d40f | 127 | // send data to the display at the current XY address |
| eencae | 6:adb79338d40f | 128 | // dc is set to 1 (i.e. data) after sending a command and so should |
| eencae | 6:adb79338d40f | 129 | // be the default mode. |
| eencae | 0:d563e74f0ae9 | 130 | void N5110::sendData(unsigned char data) |
| eencae | 0:d563e74f0ae9 | 131 | { |
| eencae | 0:d563e74f0ae9 | 132 | sce->write(0); // set CE low to begin frame |
| eencae | 0:d563e74f0ae9 | 133 | spi->write(data); |
| eencae | 0:d563e74f0ae9 | 134 | sce->write(1); // set CE high to end frame (expected for transmission of single byte) |
| eencae | 0:d563e74f0ae9 | 135 | } |
| eencae | 0:d563e74f0ae9 | 136 | |
| eencae | 0:d563e74f0ae9 | 137 | // this function writes 0 to the 504 bytes to clear the RAM |
| eencae | 0:d563e74f0ae9 | 138 | void N5110::clearRAM() |
| eencae | 0:d563e74f0ae9 | 139 | { |
| eencae | 0:d563e74f0ae9 | 140 | int i; |
| eencae | 0:d563e74f0ae9 | 141 | sce->write(0); //set CE low to begin frame |
| eencae | 17:780a542d5f8b | 142 | for(i = 0; i < WIDTH * HEIGHT; i++) { // 48 x 84 bits = 504 bytes |
| eencae | 0:d563e74f0ae9 | 143 | spi->write(0x00); // send 0's |
| eencae | 0:d563e74f0ae9 | 144 | } |
| eencae | 0:d563e74f0ae9 | 145 | sce->write(1); // set CE high to end frame |
| eencae | 0:d563e74f0ae9 | 146 | |
| eencae | 0:d563e74f0ae9 | 147 | } |
| eencae | 0:d563e74f0ae9 | 148 | |
| eencae | 13:908644099648 | 149 | // function to set the XY address in RAM for subsequenct data write |
| eencae | 0:d563e74f0ae9 | 150 | void N5110::setXYAddress(int x, int y) |
| eencae | 0:d563e74f0ae9 | 151 | { |
| eencae | 17:780a542d5f8b | 152 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
| eencae | 17:780a542d5f8b | 153 | sendCommand(0x80 | x); // send addresses to display with relevant mask |
| eencae | 17:780a542d5f8b | 154 | sendCommand(0x40 | y); |
| eencae | 17:780a542d5f8b | 155 | } |
| eencae | 0:d563e74f0ae9 | 156 | } |
| eencae | 0:d563e74f0ae9 | 157 | |
| eencae | 6:adb79338d40f | 158 | // These functions are used to set, clear and get the value of pixels in the display |
| eencae | 6:adb79338d40f | 159 | // Pixels are addressed in the range of 0 to 47 (y) and 0 to 83 (x). The refresh() |
| eencae | 6:adb79338d40f | 160 | // function must be called after set and clear in order to update the display |
| eencae | 0:d563e74f0ae9 | 161 | void N5110::setPixel(int x, int y) |
| eencae | 0:d563e74f0ae9 | 162 | { |
| eencae | 17:780a542d5f8b | 163 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
| eencae | 17:780a542d5f8b | 164 | // calculate bank and shift 1 to required position in the data byte |
| eencae | 17:780a542d5f8b | 165 | buffer[x][y/8] |= (1 << y%8); |
| eencae | 17:780a542d5f8b | 166 | } |
| eencae | 0:d563e74f0ae9 | 167 | } |
| eencae | 0:d563e74f0ae9 | 168 | |
| eencae | 0:d563e74f0ae9 | 169 | void N5110::clearPixel(int x, int y) |
| eencae | 0:d563e74f0ae9 | 170 | { |
| eencae | 17:780a542d5f8b | 171 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
| eencae | 17:780a542d5f8b | 172 | // calculate bank and shift 1 to required position (using bit clear) |
| eencae | 17:780a542d5f8b | 173 | buffer[x][y/8] &= ~(1 << y%8); |
| eencae | 17:780a542d5f8b | 174 | } |
| eencae | 0:d563e74f0ae9 | 175 | } |
| eencae | 0:d563e74f0ae9 | 176 | |
| eencae | 7:3010f24e0a81 | 177 | int N5110::getPixel(int x, int y) |
| eencae | 0:d563e74f0ae9 | 178 | { |
| eencae | 17:780a542d5f8b | 179 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
| eencae | 17:780a542d5f8b | 180 | // return relevant bank and mask required bit |
| eencae | 17:780a542d5f8b | 181 | return (int) buffer[x][y/8] & (1 << y%8); |
| eencae | 17:780a542d5f8b | 182 | } else { |
| eencae | 17:780a542d5f8b | 183 | return 0; |
| eencae | 17:780a542d5f8b | 184 | } |
| eencae | 0:d563e74f0ae9 | 185 | } |
| eencae | 0:d563e74f0ae9 | 186 | |
| eencae | 6:adb79338d40f | 187 | // function to refresh the display |
| eencae | 6:adb79338d40f | 188 | void N5110::refresh() |
| eencae | 0:d563e74f0ae9 | 189 | { |
| eencae | 0:d563e74f0ae9 | 190 | int i,j; |
| eencae | 13:908644099648 | 191 | |
| eencae | 7:3010f24e0a81 | 192 | setXYAddress(0,0); // important to set address back to 0,0 before refreshing display |
| eencae | 7:3010f24e0a81 | 193 | // address auto increments after printing string, so buffer[0][0] will not coincide |
| eencae | 7:3010f24e0a81 | 194 | // with top-left pixel after priting string |
| eencae | 13:908644099648 | 195 | |
| eencae | 0:d563e74f0ae9 | 196 | sce->write(0); //set CE low to begin frame |
| eencae | 0:d563e74f0ae9 | 197 | |
| eencae | 17:780a542d5f8b | 198 | for(j = 0; j < BANKS; j++) { // be careful to use correct order (j,i) for horizontal addressing |
| eencae | 17:780a542d5f8b | 199 | for(i = 0; i < WIDTH; i++) { |
| eencae | 0:d563e74f0ae9 | 200 | spi->write(buffer[i][j]); // send buffer |
| eencae | 0:d563e74f0ae9 | 201 | } |
| eencae | 0:d563e74f0ae9 | 202 | } |
| eencae | 0:d563e74f0ae9 | 203 | sce->write(1); // set CE high to end frame |
| eencae | 0:d563e74f0ae9 | 204 | |
| eencae | 0:d563e74f0ae9 | 205 | } |
| eencae | 0:d563e74f0ae9 | 206 | |
| eencae | 6:adb79338d40f | 207 | // fills the buffer with random bytes. Can be used to test the display. |
| eencae | 6:adb79338d40f | 208 | // The rand() function isn't seeded so it probably creates the same pattern everytime |
| eencae | 0:d563e74f0ae9 | 209 | void N5110::randomiseBuffer() |
| eencae | 0:d563e74f0ae9 | 210 | { |
| eencae | 0:d563e74f0ae9 | 211 | int i,j; |
| eencae | 17:780a542d5f8b | 212 | for(j = 0; j < BANKS; j++) { // be careful to use correct order (j,i) for horizontal addressing |
| eencae | 17:780a542d5f8b | 213 | for(i = 0; i < WIDTH; i++) { |
| eencae | 0:d563e74f0ae9 | 214 | buffer[i][j] = rand()%256; // generate random byte |
| eencae | 0:d563e74f0ae9 | 215 | } |
| eencae | 0:d563e74f0ae9 | 216 | } |
| eencae | 0:d563e74f0ae9 | 217 | |
| eencae | 0:d563e74f0ae9 | 218 | } |
| eencae | 0:d563e74f0ae9 | 219 | |
| eencae | 0:d563e74f0ae9 | 220 | // function to print 5x7 font |
| eencae | 13:908644099648 | 221 | void N5110::printChar(char c,int x,int y) |
| eencae | 0:d563e74f0ae9 | 222 | { |
| eencae | 13:908644099648 | 223 | for (int i = 0; i < 5 ; i++ ) { |
| eencae | 13:908644099648 | 224 | buffer[x+i][y] = font5x7[(c - 32)*5 + i]; |
| eencae | 17:780a542d5f8b | 225 | // array is offset by 32 relative to ASCII, each character is 5 pixels wide |
| eencae | 0:d563e74f0ae9 | 226 | } |
| eencae | 17:780a542d5f8b | 227 | |
| eencae | 17:780a542d5f8b | 228 | refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0 |
| eencae | 0:d563e74f0ae9 | 229 | } |
| eencae | 0:d563e74f0ae9 | 230 | |
| eencae | 0:d563e74f0ae9 | 231 | // function to print string at specified position |
| eencae | 0:d563e74f0ae9 | 232 | void N5110::printString(const char * str,int x,int y) |
| eencae | 0:d563e74f0ae9 | 233 | { |
| eencae | 0:d563e74f0ae9 | 234 | int n = 0 ; // counter for number of characters in string |
| eencae | 0:d563e74f0ae9 | 235 | // loop through string and print character |
| eencae | 0:d563e74f0ae9 | 236 | while(*str) { |
| eencae | 0:d563e74f0ae9 | 237 | |
| eencae | 13:908644099648 | 238 | // writes the character bitmap data to the buffer, so that |
| eencae | 9:7701f0126ba7 | 239 | // text and pixels can be displayed at the same time |
| eencae | 9:7701f0126ba7 | 240 | for (int i = 0; i < 5 ; i++ ) { |
| eencae | 9:7701f0126ba7 | 241 | buffer[x+i+n*6][y] = font5x7[(*str - 32)*5 + i]; |
| eencae | 9:7701f0126ba7 | 242 | } |
| eencae | 13:908644099648 | 243 | |
| eencae | 0:d563e74f0ae9 | 244 | str++; // go to next character in string |
| eencae | 0:d563e74f0ae9 | 245 | n++; // increment index |
| eencae | 0:d563e74f0ae9 | 246 | } |
| eencae | 13:908644099648 | 247 | |
| eencae | 9:7701f0126ba7 | 248 | refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0 |
| eencae | 0:d563e74f0ae9 | 249 | |
| eencae | 0:d563e74f0ae9 | 250 | } |
| eencae | 0:d563e74f0ae9 | 251 | |
| eencae | 6:adb79338d40f | 252 | // function to clear the screen |
| eencae | 0:d563e74f0ae9 | 253 | void N5110::clear() |
| eencae | 0:d563e74f0ae9 | 254 | { |
| eencae | 6:adb79338d40f | 255 | clearBuffer(); // clear the buffer then call the refresh function |
| eencae | 6:adb79338d40f | 256 | refresh(); |
| eencae | 0:d563e74f0ae9 | 257 | } |
| eencae | 0:d563e74f0ae9 | 258 | |
| eencae | 6:adb79338d40f | 259 | // function to clear the buffer |
| eencae | 0:d563e74f0ae9 | 260 | void N5110::clearBuffer() |
| eencae | 0:d563e74f0ae9 | 261 | { |
| eencae | 0:d563e74f0ae9 | 262 | int i,j; |
| eencae | 17:780a542d5f8b | 263 | for (i=0; i<WIDTH; i++) { // loop through the banks and set the buffer to 0 |
| eencae | 17:780a542d5f8b | 264 | for (j=0; j<BANKS; j++) { |
| eencae | 0:d563e74f0ae9 | 265 | buffer[i][j]=0; |
| eencae | 0:d563e74f0ae9 | 266 | } |
| eencae | 0:d563e74f0ae9 | 267 | } |
| eencae | 8:40abe5736eca | 268 | } |
| eencae | 8:40abe5736eca | 269 | |
| eencae | 8:40abe5736eca | 270 | // function to plot array on display |
| eencae | 13:908644099648 | 271 | void N5110::plotArray(float array[]) |
| eencae | 13:908644099648 | 272 | { |
| eencae | 13:908644099648 | 273 | |
| eencae | 8:40abe5736eca | 274 | int i; |
| eencae | 13:908644099648 | 275 | |
| eencae | 17:780a542d5f8b | 276 | for (i=0; i<WIDTH; i++) { // loop through array |
| eencae | 8:40abe5736eca | 277 | // elements are normalised from 0.0 to 1.0, so multiply |
| eencae | 8:40abe5736eca | 278 | // by 47 to convert to pixel range, and subtract from 47 |
| eencae | 8:40abe5736eca | 279 | // since top-left is 0,0 in the display geometry |
| eencae | 9:7701f0126ba7 | 280 | setPixel(i,47 - int(array[i]*47.0)); |
| eencae | 13:908644099648 | 281 | } |
| eencae | 13:908644099648 | 282 | |
| eencae | 8:40abe5736eca | 283 | refresh(); |
| eencae | 13:908644099648 | 284 | |
| eencae | 17:780a542d5f8b | 285 | } |
| eencae | 13:908644099648 | 286 | |
| eencae | 17:780a542d5f8b | 287 | // function to draw circle |
| eencae | 17:780a542d5f8b | 288 | void N5110:: drawCircle(int x0,int y0,int radius,int fill) |
| eencae | 17:780a542d5f8b | 289 | { |
| eencae | 17:780a542d5f8b | 290 | // from http://en.wikipedia.org/wiki/Midpoint_circle_algorithm |
| eencae | 17:780a542d5f8b | 291 | int x = radius; |
| eencae | 17:780a542d5f8b | 292 | int y = 0; |
| eencae | 17:780a542d5f8b | 293 | int radiusError = 1-x; |
| eencae | 17:780a542d5f8b | 294 | |
| eencae | 17:780a542d5f8b | 295 | while(x >= y) { |
| eencae | 17:780a542d5f8b | 296 | |
| eencae | 17:780a542d5f8b | 297 | // if transparent, just draw outline |
| eencae | 17:780a542d5f8b | 298 | if (fill == 0) { |
| eencae | 17:780a542d5f8b | 299 | setPixel( x + x0, y + y0); |
| eencae | 17:780a542d5f8b | 300 | setPixel(-x + x0, y + y0); |
| eencae | 17:780a542d5f8b | 301 | setPixel( y + x0, x + y0); |
| eencae | 17:780a542d5f8b | 302 | setPixel(-y + x0, x + y0); |
| eencae | 17:780a542d5f8b | 303 | setPixel(-y + x0, -x + y0); |
| eencae | 17:780a542d5f8b | 304 | setPixel( y + x0, -x + y0); |
| eencae | 17:780a542d5f8b | 305 | setPixel( x + x0, -y + y0); |
| eencae | 17:780a542d5f8b | 306 | setPixel(-x + x0, -y + y0); |
| eencae | 17:780a542d5f8b | 307 | } else { // drawing filled circle, so draw lines between points at same y value |
| eencae | 17:780a542d5f8b | 308 | |
| eencae | 17:780a542d5f8b | 309 | int type = (fill==1) ? 1:0; // black or white fill |
| eencae | 17:780a542d5f8b | 310 | |
| eencae | 17:780a542d5f8b | 311 | drawLine(x+x0,y+y0,-x+x0,y+y0,type); |
| eencae | 17:780a542d5f8b | 312 | drawLine(y+x0,x+y0,-y+x0,x+y0,type); |
| eencae | 17:780a542d5f8b | 313 | drawLine(y+x0,-x+y0,-y+x0,-x+y0,type); |
| eencae | 17:780a542d5f8b | 314 | drawLine(x+x0,-y+y0,-x+x0,-y+y0,type); |
| eencae | 17:780a542d5f8b | 315 | } |
| eencae | 17:780a542d5f8b | 316 | |
| eencae | 17:780a542d5f8b | 317 | |
| eencae | 17:780a542d5f8b | 318 | y++; |
| eencae | 17:780a542d5f8b | 319 | if (radiusError<0) { |
| eencae | 17:780a542d5f8b | 320 | radiusError += 2 * y + 1; |
| eencae | 17:780a542d5f8b | 321 | } else { |
| eencae | 17:780a542d5f8b | 322 | x--; |
| eencae | 17:780a542d5f8b | 323 | radiusError += 2 * (y - x) + 1; |
| eencae | 17:780a542d5f8b | 324 | } |
| eencae | 17:780a542d5f8b | 325 | } |
| eencae | 17:780a542d5f8b | 326 | |
| eencae | 17:780a542d5f8b | 327 | refresh(); |
| eencae | 17:780a542d5f8b | 328 | } |
| eencae | 17:780a542d5f8b | 329 | |
| eencae | 17:780a542d5f8b | 330 | void N5110::drawLine(int x0,int y0,int x1,int y1,int type) |
| eencae | 17:780a542d5f8b | 331 | { |
| eencae | 17:780a542d5f8b | 332 | int y_range = y1-y0; // calc range of y and x |
| eencae | 17:780a542d5f8b | 333 | int x_range = x1-x0; |
| eencae | 17:780a542d5f8b | 334 | int start,stop,step; |
| eencae | 17:780a542d5f8b | 335 | |
| eencae | 17:780a542d5f8b | 336 | // if dotted line, set step to 2, else step is 1 |
| eencae | 17:780a542d5f8b | 337 | step = (type==2) ? 2:1; |
| eencae | 17:780a542d5f8b | 338 | |
| eencae | 17:780a542d5f8b | 339 | // make sure we loop over the largest range to get the most pixels on the display |
| eencae | 17:780a542d5f8b | 340 | // for instance, if drawing a vertical line (x_range = 0), we need to loop down the y pixels |
| eencae | 17:780a542d5f8b | 341 | // or else we'll only end up with 1 pixel in the x column |
| eencae | 17:780a542d5f8b | 342 | if ( abs(x_range) > abs(y_range) ) { |
| eencae | 17:780a542d5f8b | 343 | |
| eencae | 17:780a542d5f8b | 344 | // ensure we loop from smallest to largest or else for-loop won't run as expected |
| eencae | 17:780a542d5f8b | 345 | start = x1>x0 ? x0:x1; |
| eencae | 17:780a542d5f8b | 346 | stop = x1>x0 ? x1:x0; |
| eencae | 17:780a542d5f8b | 347 | |
| eencae | 17:780a542d5f8b | 348 | // loop between x pixels |
| eencae | 17:780a542d5f8b | 349 | for (int x = start; x<= stop ; x+=step) { |
| eencae | 17:780a542d5f8b | 350 | // do linear interpolation |
| eencae | 17:780a542d5f8b | 351 | int y = y0 + (y1-y0)*(x-x0)/(x1-x0); |
| eencae | 17:780a542d5f8b | 352 | |
| eencae | 17:780a542d5f8b | 353 | if (type == 0) // if 'white' line, turn off pixel |
| eencae | 17:780a542d5f8b | 354 | clearPixel(x,y); |
| eencae | 17:780a542d5f8b | 355 | else |
| eencae | 17:780a542d5f8b | 356 | setPixel(x,y); // else if 'black' or 'dotted' turn on pixel |
| eencae | 17:780a542d5f8b | 357 | } |
| eencae | 17:780a542d5f8b | 358 | } else { |
| eencae | 17:780a542d5f8b | 359 | |
| eencae | 17:780a542d5f8b | 360 | // ensure we loop from smallest to largest or else for-loop won't run as expected |
| eencae | 17:780a542d5f8b | 361 | start = y1>y0 ? y0:y1; |
| eencae | 17:780a542d5f8b | 362 | stop = y1>y0 ? y1:y0; |
| eencae | 17:780a542d5f8b | 363 | |
| eencae | 17:780a542d5f8b | 364 | for (int y = start; y<= stop ; y+=step) { |
| eencae | 17:780a542d5f8b | 365 | // do linear interpolation |
| eencae | 17:780a542d5f8b | 366 | int x = x0 + (x1-x0)*(y-y0)/(y1-y0); |
| eencae | 17:780a542d5f8b | 367 | |
| eencae | 17:780a542d5f8b | 368 | if (type == 0) // if 'white' line, turn off pixel |
| eencae | 17:780a542d5f8b | 369 | clearPixel(x,y); |
| eencae | 17:780a542d5f8b | 370 | else |
| eencae | 17:780a542d5f8b | 371 | setPixel(x,y); // else if 'black' or 'dotted' turn on pixel |
| eencae | 17:780a542d5f8b | 372 | |
| eencae | 17:780a542d5f8b | 373 | } |
| eencae | 17:780a542d5f8b | 374 | } |
| eencae | 17:780a542d5f8b | 375 | |
| eencae | 17:780a542d5f8b | 376 | refresh(); |
| eencae | 17:780a542d5f8b | 377 | } |
| eencae | 17:780a542d5f8b | 378 | |
| eencae | 17:780a542d5f8b | 379 | void N5110::drawRect(int x0,int y0,int width,int height,int fill) |
| eencae | 17:780a542d5f8b | 380 | { |
| eencae | 17:780a542d5f8b | 381 | |
| eencae | 17:780a542d5f8b | 382 | if (fill == 0) { // transparent, just outline |
| eencae | 17:780a542d5f8b | 383 | drawLine(x0,y0,x0+width,y0,1); // top |
| eencae | 17:780a542d5f8b | 384 | drawLine(x0,y0+height,x0+width,y0+height,1); // bottom |
| eencae | 17:780a542d5f8b | 385 | drawLine(x0,y0,x0,y0+height,1); // left |
| eencae | 17:780a542d5f8b | 386 | drawLine(x0+width,y0,x0+width,y0+height,1); // right |
| eencae | 17:780a542d5f8b | 387 | } else { // filled rectangle |
| eencae | 17:780a542d5f8b | 388 | int type = (fill==1) ? 1:0; // black or white fill |
| eencae | 17:780a542d5f8b | 389 | for (int y = y0; y<= y0+height; y++) { // loop through rows of rectangle |
| eencae | 17:780a542d5f8b | 390 | drawLine(x0,y,x0+width,y,type); // draw line across screen |
| eencae | 17:780a542d5f8b | 391 | } |
| eencae | 17:780a542d5f8b | 392 | } |
| eencae | 17:780a542d5f8b | 393 | |
| eencae | 17:780a542d5f8b | 394 | } |