Saad Tayyab / N5110-Modded

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

N5110.cpp@31:8a0c21042f82, 2017-02-16 (annotated)

Committer:
valavanisalex
Date:
Thu Feb 16 15:36:44 2017 +0000
Revision:
31:8a0c21042f82
Parent:
29:5bc91bd44c77
Child:
32:c9643726edca
Add a destructor to free allocated memory

Who changed what in which revision?

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