(DA) Internet of Things and Smart Electronics- ELE3006M2122 / Mbed 2 deprecated Project-Target-Localization

Resit Target Localisation Ciaran Kane 18689005

Dependencies:   mbed

N5110/N5110.cpp@7:acf82069b794, 23 months ago (annotated)

Committer:
ciarankane123
Date:
Thu Aug 25 13:50:39 2022 +0000
Revision:
7:acf82069b794
Final Code;

Who changed what in which revision?

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