Code based on the original version from http://developer.mbed.org/users/eencae

Dependents:   Pedometer

Fork of N5110 by Craig Evans

Committer:
ml13emds
Date:
Mon May 11 03:38:01 2015 +0000
Revision:
18:c37d9269bbbd
Parent:
17:780a542d5f8b
Original function imported from Craig Evans

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