Craig Evans / N5110

Library for interfacing to Nokia 5110 LCD display (as found on the SparkFun website).

Dependents:   LV7_LCDtest LV7_Grupa5_Tim003_Zadatak1 lv7_Grupa5_Tim008_zad1 LV7_PAI_Grupa5_tim10_Zadatak1 ... more

This library is designed to make it easy to interface an mbed with a Nokia 5110 LCD display.

These can be found at Sparkfun (https://www.sparkfun.com/products/10168) and Adafruit (http://www.adafruit.com/product/338).

The library uses the SPI peripheral on the mbed which means it is much faster sending data to the display than other libraries available on other platforms that use software SPI.

The library can print strings as well as controlling individual pixels, meaning that both text and primitive graphics can be displayed.

N5110.cpp@18:1af393359298, 2015-04-22 (annotated)

Committer:
eencae
Date:
Wed Apr 22 12:41:45 2015 +0000
Revision:
18:1af393359298
Parent:
17:780a542d5f8b
Child:
19:ba8addc061ea
printString() and printChar() updated so that strings/chars are cut-off after the 83rd pixel and fit on the display. Previously this would cause the buffer array to go out of bounds and cause a crash.

Who changed what in which revision?

UserRevisionLine numberNew 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 18:1af393359298 223 if (y>=0 && y<6) { // check if printing in range of y banks
eencae 18:1af393359298 224
eencae 18:1af393359298 225 for (int i = 0; i < 5 ; i++ ) {
eencae 18:1af393359298 226 int pixel_x = x+i;
eencae 18:1af393359298 227 if (pixel_x > 83) // ensure pixel isn't outside the buffer size (0 - 83)
eencae 18:1af393359298 228 break;
eencae 18:1af393359298 229 buffer[pixel_x][y] = font5x7[(c - 32)*5 + i];
eencae 18:1af393359298 230 // array is offset by 32 relative to ASCII, each character is 5 pixels wide
eencae 18:1af393359298 231 }
eencae 18:1af393359298 232
eencae 18:1af393359298 233 refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0
eencae 0:d563e74f0ae9 234 }
eencae 0:d563e74f0ae9 235 }
eencae 0:d563e74f0ae9 236
eencae 0:d563e74f0ae9 237 // function to print string at specified position
eencae 0:d563e74f0ae9 238 void N5110::printString(const char * str,int x,int y)
eencae 0:d563e74f0ae9 239 {
eencae 18:1af393359298 240 if (y>=0 && y<6) { // check if printing in range of y banks
eencae 18:1af393359298 241
eencae 18:1af393359298 242 int n = 0 ; // counter for number of characters in string
eencae 18:1af393359298 243 // loop through string and print character
eencae 18:1af393359298 244 while(*str) {
eencae 0:d563e74f0ae9 245
eencae 18:1af393359298 246 // writes the character bitmap data to the buffer, so that
eencae 18:1af393359298 247 // text and pixels can be displayed at the same time
eencae 18:1af393359298 248 for (int i = 0; i < 5 ; i++ ) {
eencae 18:1af393359298 249 int pixel_x = x+i+n*6;
eencae 18:1af393359298 250 if (pixel_x > 83) // ensure pixel isn't outside the buffer size (0 - 83)
eencae 18:1af393359298 251 break;
eencae 18:1af393359298 252 buffer[pixel_x][y] = font5x7[(*str - 32)*5 + i];
eencae 18:1af393359298 253 }
eencae 18:1af393359298 254
eencae 18:1af393359298 255 str++; // go to next character in string
eencae 18:1af393359298 256
eencae 18:1af393359298 257 n++; // increment index
eencae 18:1af393359298 258
eencae 9:7701f0126ba7 259 }
eencae 13:908644099648 260
eencae 18:1af393359298 261 refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0
eencae 0:d563e74f0ae9 262 }
eencae 0:d563e74f0ae9 263 }
eencae 0:d563e74f0ae9 264
eencae 6:adb79338d40f 265 // function to clear the screen
eencae 0:d563e74f0ae9 266 void N5110::clear()
eencae 0:d563e74f0ae9 267 {
eencae 6:adb79338d40f 268 clearBuffer(); // clear the buffer then call the refresh function
eencae 6:adb79338d40f 269 refresh();
eencae 0:d563e74f0ae9 270 }
eencae 0:d563e74f0ae9 271
eencae 6:adb79338d40f 272 // function to clear the buffer
eencae 0:d563e74f0ae9 273 void N5110::clearBuffer()
eencae 0:d563e74f0ae9 274 {
eencae 0:d563e74f0ae9 275 int i,j;
eencae 17:780a542d5f8b 276 for (i=0; i<WIDTH; i++) { // loop through the banks and set the buffer to 0
eencae 17:780a542d5f8b 277 for (j=0; j<BANKS; j++) {
eencae 0:d563e74f0ae9 278 buffer[i][j]=0;
eencae 0:d563e74f0ae9 279 }
eencae 0:d563e74f0ae9 280 }
eencae 8:40abe5736eca 281 }
eencae 8:40abe5736eca 282
eencae 8:40abe5736eca 283 // function to plot array on display
eencae 13:908644099648 284 void N5110::plotArray(float array[])
eencae 13:908644099648 285 {
eencae 13:908644099648 286
eencae 8:40abe5736eca 287 int i;
eencae 13:908644099648 288
eencae 17:780a542d5f8b 289 for (i=0; i<WIDTH; i++) { // loop through array
eencae 8:40abe5736eca 290 // elements are normalised from 0.0 to 1.0, so multiply
eencae 8:40abe5736eca 291 // by 47 to convert to pixel range, and subtract from 47
eencae 8:40abe5736eca 292 // since top-left is 0,0 in the display geometry
eencae 9:7701f0126ba7 293 setPixel(i,47 - int(array[i]*47.0));
eencae 13:908644099648 294 }
eencae 13:908644099648 295
eencae 8:40abe5736eca 296 refresh();
eencae 13:908644099648 297
eencae 17:780a542d5f8b 298 }
eencae 13:908644099648 299
eencae 17:780a542d5f8b 300 // function to draw circle
eencae 17:780a542d5f8b 301 void N5110:: drawCircle(int x0,int y0,int radius,int fill)
eencae 17:780a542d5f8b 302 {
eencae 17:780a542d5f8b 303 // from http://en.wikipedia.org/wiki/Midpoint_circle_algorithm
eencae 17:780a542d5f8b 304 int x = radius;
eencae 17:780a542d5f8b 305 int y = 0;
eencae 17:780a542d5f8b 306 int radiusError = 1-x;
eencae 17:780a542d5f8b 307
eencae 17:780a542d5f8b 308 while(x >= y) {
eencae 17:780a542d5f8b 309
eencae 17:780a542d5f8b 310 // if transparent, just draw outline
eencae 17:780a542d5f8b 311 if (fill == 0) {
eencae 17:780a542d5f8b 312 setPixel( x + x0, y + y0);
eencae 17:780a542d5f8b 313 setPixel(-x + x0, y + y0);
eencae 17:780a542d5f8b 314 setPixel( y + x0, x + y0);
eencae 17:780a542d5f8b 315 setPixel(-y + x0, x + y0);
eencae 17:780a542d5f8b 316 setPixel(-y + x0, -x + y0);
eencae 17:780a542d5f8b 317 setPixel( y + x0, -x + y0);
eencae 17:780a542d5f8b 318 setPixel( x + x0, -y + y0);
eencae 17:780a542d5f8b 319 setPixel(-x + x0, -y + y0);
eencae 17:780a542d5f8b 320 } else { // drawing filled circle, so draw lines between points at same y value
eencae 17:780a542d5f8b 321
eencae 17:780a542d5f8b 322 int type = (fill==1) ? 1:0; // black or white fill
eencae 17:780a542d5f8b 323
eencae 17:780a542d5f8b 324 drawLine(x+x0,y+y0,-x+x0,y+y0,type);
eencae 17:780a542d5f8b 325 drawLine(y+x0,x+y0,-y+x0,x+y0,type);
eencae 17:780a542d5f8b 326 drawLine(y+x0,-x+y0,-y+x0,-x+y0,type);
eencae 17:780a542d5f8b 327 drawLine(x+x0,-y+y0,-x+x0,-y+y0,type);
eencae 17:780a542d5f8b 328 }
eencae 17:780a542d5f8b 329
eencae 17:780a542d5f8b 330
eencae 17:780a542d5f8b 331 y++;
eencae 17:780a542d5f8b 332 if (radiusError<0) {
eencae 17:780a542d5f8b 333 radiusError += 2 * y + 1;
eencae 17:780a542d5f8b 334 } else {
eencae 17:780a542d5f8b 335 x--;
eencae 17:780a542d5f8b 336 radiusError += 2 * (y - x) + 1;
eencae 17:780a542d5f8b 337 }
eencae 17:780a542d5f8b 338 }
eencae 17:780a542d5f8b 339
eencae 17:780a542d5f8b 340 refresh();
eencae 17:780a542d5f8b 341 }
eencae 17:780a542d5f8b 342
eencae 17:780a542d5f8b 343 void N5110::drawLine(int x0,int y0,int x1,int y1,int type)
eencae 17:780a542d5f8b 344 {
eencae 17:780a542d5f8b 345 int y_range = y1-y0; // calc range of y and x
eencae 17:780a542d5f8b 346 int x_range = x1-x0;
eencae 17:780a542d5f8b 347 int start,stop,step;
eencae 17:780a542d5f8b 348
eencae 17:780a542d5f8b 349 // if dotted line, set step to 2, else step is 1
eencae 17:780a542d5f8b 350 step = (type==2) ? 2:1;
eencae 17:780a542d5f8b 351
eencae 17:780a542d5f8b 352 // make sure we loop over the largest range to get the most pixels on the display
eencae 17:780a542d5f8b 353 // for instance, if drawing a vertical line (x_range = 0), we need to loop down the y pixels
eencae 17:780a542d5f8b 354 // or else we'll only end up with 1 pixel in the x column
eencae 17:780a542d5f8b 355 if ( abs(x_range) > abs(y_range) ) {
eencae 17:780a542d5f8b 356
eencae 17:780a542d5f8b 357 // ensure we loop from smallest to largest or else for-loop won't run as expected
eencae 17:780a542d5f8b 358 start = x1>x0 ? x0:x1;
eencae 17:780a542d5f8b 359 stop = x1>x0 ? x1:x0;
eencae 17:780a542d5f8b 360
eencae 17:780a542d5f8b 361 // loop between x pixels
eencae 17:780a542d5f8b 362 for (int x = start; x<= stop ; x+=step) {
eencae 17:780a542d5f8b 363 // do linear interpolation
eencae 17:780a542d5f8b 364 int y = y0 + (y1-y0)*(x-x0)/(x1-x0);
eencae 17:780a542d5f8b 365
eencae 17:780a542d5f8b 366 if (type == 0) // if 'white' line, turn off pixel
eencae 17:780a542d5f8b 367 clearPixel(x,y);
eencae 17:780a542d5f8b 368 else
eencae 17:780a542d5f8b 369 setPixel(x,y); // else if 'black' or 'dotted' turn on pixel
eencae 17:780a542d5f8b 370 }
eencae 17:780a542d5f8b 371 } else {
eencae 17:780a542d5f8b 372
eencae 17:780a542d5f8b 373 // ensure we loop from smallest to largest or else for-loop won't run as expected
eencae 17:780a542d5f8b 374 start = y1>y0 ? y0:y1;
eencae 17:780a542d5f8b 375 stop = y1>y0 ? y1:y0;
eencae 17:780a542d5f8b 376
eencae 17:780a542d5f8b 377 for (int y = start; y<= stop ; y+=step) {
eencae 17:780a542d5f8b 378 // do linear interpolation
eencae 17:780a542d5f8b 379 int x = x0 + (x1-x0)*(y-y0)/(y1-y0);
eencae 17:780a542d5f8b 380
eencae 17:780a542d5f8b 381 if (type == 0) // if 'white' line, turn off pixel
eencae 17:780a542d5f8b 382 clearPixel(x,y);
eencae 17:780a542d5f8b 383 else
eencae 17:780a542d5f8b 384 setPixel(x,y); // else if 'black' or 'dotted' turn on pixel
eencae 17:780a542d5f8b 385
eencae 17:780a542d5f8b 386 }
eencae 17:780a542d5f8b 387 }
eencae 17:780a542d5f8b 388
eencae 17:780a542d5f8b 389 refresh();
eencae 17:780a542d5f8b 390 }
eencae 17:780a542d5f8b 391
eencae 17:780a542d5f8b 392 void N5110::drawRect(int x0,int y0,int width,int height,int fill)
eencae 17:780a542d5f8b 393 {
eencae 17:780a542d5f8b 394
eencae 17:780a542d5f8b 395 if (fill == 0) { // transparent, just outline
eencae 17:780a542d5f8b 396 drawLine(x0,y0,x0+width,y0,1); // top
eencae 17:780a542d5f8b 397 drawLine(x0,y0+height,x0+width,y0+height,1); // bottom
eencae 17:780a542d5f8b 398 drawLine(x0,y0,x0,y0+height,1); // left
eencae 17:780a542d5f8b 399 drawLine(x0+width,y0,x0+width,y0+height,1); // right
eencae 17:780a542d5f8b 400 } else { // filled rectangle
eencae 17:780a542d5f8b 401 int type = (fill==1) ? 1:0; // black or white fill
eencae 17:780a542d5f8b 402 for (int y = y0; y<= y0+height; y++) { // loop through rows of rectangle
eencae 17:780a542d5f8b 403 drawLine(x0,y,x0+width,y,type); // draw line across screen
eencae 17:780a542d5f8b 404 }
eencae 17:780a542d5f8b 405 }
eencae 17:780a542d5f8b 406
eencae 17:780a542d5f8b 407 }