ELEC2645 (2019/20) / Mbed 2 deprecated ELEC2645_Project_el19zf

Zeyu Feng 201377605

Dependencies:   mbed

On Minerva

Gamepad2/N5110.cpp@22:cded0cd8e1c9, 2020-05-22 (annotated)

Committer:
el19zf
Date:
Fri May 22 16:07:02 2020 +0000
Revision:
22:cded0cd8e1c9
Parent:
1:b133934e0d45 
Final Submission. I have read and agreed with Statement of Academic Integrity.

Who changed what in which revision?

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