Max Houghton / N5110

Class used to interface with the Nokia N5110 LCD.

Fork of N5110 by Craig Evans

N5110.cpp@24:342bdb6679a1, 2017-02-07 (annotated)

Committer:
eencae
Date:
Tue Feb 07 10:21:43 2017 +0000
Revision:
24:342bdb6679a1
Parent:
23:eb7e6632fc9e
Child:
26:36be85c20ef4
Moved refresh() out of clear/printString/printChar methods. ; ; At every frame update, the buffer should be cleared using 'clear', then the frame constructed using printString/draw methods etc. Finally a call to refresh() will update the display.

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