My code work about accelerometer MMA8452
Dependencies: Beep MMA8452 mbed
main.cpp@0:ef370734cc1a, 2015-05-09 (annotated)
- Committer:
- lssyczy
- Date:
- Sat May 09 11:55:51 2015 +0000
- Revision:
- 0:ef370734cc1a
my code submit
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lssyczy | 0:ef370734cc1a | 1 | /** |
lssyczy | 0:ef370734cc1a | 2 | @file N5110.cpp |
lssyczy | 0:ef370734cc1a | 3 | |
lssyczy | 0:ef370734cc1a | 4 | @brief Member functions implementations |
lssyczy | 0:ef370734cc1a | 5 | |
lssyczy | 0:ef370734cc1a | 6 | */ |
lssyczy | 0:ef370734cc1a | 7 | #include "mbed.h" |
lssyczy | 0:ef370734cc1a | 8 | #include "N5110.h" |
lssyczy | 0:ef370734cc1a | 9 | #include "MMA8452.h" |
lssyczy | 0:ef370734cc1a | 10 | #include "Beep.h" |
lssyczy | 0:ef370734cc1a | 11 | |
lssyczy | 0:ef370734cc1a | 12 | |
lssyczy | 0:ef370734cc1a | 13 | N5110::N5110(PinName pwrPin, PinName scePin, PinName rstPin, PinName dcPin, PinName mosiPin, PinName sclkPin, PinName ledPin) |
lssyczy | 0:ef370734cc1a | 14 | { |
lssyczy | 0:ef370734cc1a | 15 | |
lssyczy | 0:ef370734cc1a | 16 | spi = new SPI(mosiPin,NC,sclkPin); // create new SPI instance and initialise |
lssyczy | 0:ef370734cc1a | 17 | initSPI(); |
lssyczy | 0:ef370734cc1a | 18 | |
lssyczy | 0:ef370734cc1a | 19 | // set up pins as required |
lssyczy | 0:ef370734cc1a | 20 | led = new PwmOut(ledPin); |
lssyczy | 0:ef370734cc1a | 21 | pwr = new DigitalOut(pwrPin); |
lssyczy | 0:ef370734cc1a | 22 | sce = new DigitalOut(scePin); |
lssyczy | 0:ef370734cc1a | 23 | rst = new DigitalOut(rstPin); |
lssyczy | 0:ef370734cc1a | 24 | dc = new DigitalOut(dcPin); |
lssyczy | 0:ef370734cc1a | 25 | |
lssyczy | 0:ef370734cc1a | 26 | } |
lssyczy | 0:ef370734cc1a | 27 | |
lssyczy | 0:ef370734cc1a | 28 | // initialise function - powers up and sends the initialisation commands |
lssyczy | 0:ef370734cc1a | 29 | void N5110::init() |
lssyczy | 0:ef370734cc1a | 30 | { |
lssyczy | 0:ef370734cc1a | 31 | turnOn(); // power up |
lssyczy | 0:ef370734cc1a | 32 | wait_ms(10); // small delay seems to prevent spurious pixels during mbed reset |
lssyczy | 0:ef370734cc1a | 33 | reset(); // reset LCD - must be done within 100 ms |
lssyczy | 0:ef370734cc1a | 34 | |
lssyczy | 0:ef370734cc1a | 35 | // function set - extended |
lssyczy | 0:ef370734cc1a | 36 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_EXTENDED_MODE); |
lssyczy | 0:ef370734cc1a | 37 | // Don't completely understand these parameters - they seem to work as they are |
lssyczy | 0:ef370734cc1a | 38 | // Consult the datasheet if you need to change them |
lssyczy | 0:ef370734cc1a | 39 | sendCommand(CMD_VOP_7V38); // operating voltage - these values are from Chris Yan's Library |
lssyczy | 0:ef370734cc1a | 40 | sendCommand(CMD_TC_TEMP_2); // temperature control |
lssyczy | 0:ef370734cc1a | 41 | sendCommand(CMD_BI_MUX_48); // bias |
lssyczy | 0:ef370734cc1a | 42 | |
lssyczy | 0:ef370734cc1a | 43 | // function set - basic |
lssyczy | 0:ef370734cc1a | 44 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_BASIC_MODE); |
lssyczy | 0:ef370734cc1a | 45 | normalMode(); // normal video mode by default |
lssyczy | 0:ef370734cc1a | 46 | sendCommand(CMD_DC_NORMAL_MODE); // black on white |
lssyczy | 0:ef370734cc1a | 47 | |
lssyczy | 0:ef370734cc1a | 48 | // RAM is undefined at power-up so clear |
lssyczy | 0:ef370734cc1a | 49 | clearRAM(); |
lssyczy | 0:ef370734cc1a | 50 | |
lssyczy | 0:ef370734cc1a | 51 | } |
lssyczy | 0:ef370734cc1a | 52 | |
lssyczy | 0:ef370734cc1a | 53 | // sets normal video mode (black on white) |
lssyczy | 0:ef370734cc1a | 54 | void N5110::normalMode() |
lssyczy | 0:ef370734cc1a | 55 | { |
lssyczy | 0:ef370734cc1a | 56 | sendCommand(CMD_DC_NORMAL_MODE); |
lssyczy | 0:ef370734cc1a | 57 | |
lssyczy | 0:ef370734cc1a | 58 | } |
lssyczy | 0:ef370734cc1a | 59 | |
lssyczy | 0:ef370734cc1a | 60 | // sets normal video mode (white on black) |
lssyczy | 0:ef370734cc1a | 61 | void N5110::inverseMode() |
lssyczy | 0:ef370734cc1a | 62 | { |
lssyczy | 0:ef370734cc1a | 63 | sendCommand(CMD_DC_INVERT_VIDEO); |
lssyczy | 0:ef370734cc1a | 64 | } |
lssyczy | 0:ef370734cc1a | 65 | |
lssyczy | 0:ef370734cc1a | 66 | // function to power up the LCD and backlight |
lssyczy | 0:ef370734cc1a | 67 | void N5110::turnOn() |
lssyczy | 0:ef370734cc1a | 68 | { |
lssyczy | 0:ef370734cc1a | 69 | // set brightness of LED - 0.0 to 1.0 - default is 50% |
lssyczy | 0:ef370734cc1a | 70 | setBrightness(0.5); |
lssyczy | 0:ef370734cc1a | 71 | pwr->write(1); // apply power |
lssyczy | 0:ef370734cc1a | 72 | } |
lssyczy | 0:ef370734cc1a | 73 | |
lssyczy | 0:ef370734cc1a | 74 | // function to power down LCD |
lssyczy | 0:ef370734cc1a | 75 | void N5110::turnOff() |
lssyczy | 0:ef370734cc1a | 76 | { |
lssyczy | 0:ef370734cc1a | 77 | setBrightness(0.0); // turn backlight off |
lssyczy | 0:ef370734cc1a | 78 | clearRAM(); // clear RAM to ensure specified current consumption |
lssyczy | 0:ef370734cc1a | 79 | // send command to ensure we are in basic mode |
lssyczy | 0:ef370734cc1a | 80 | sendCommand(0x20 | CMD_FS_ACTIVE_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_BASIC_MODE); |
lssyczy | 0:ef370734cc1a | 81 | // clear the display |
lssyczy | 0:ef370734cc1a | 82 | sendCommand(CMD_DC_CLEAR_DISPLAY); |
lssyczy | 0:ef370734cc1a | 83 | // enter the extended mode and power down |
lssyczy | 0:ef370734cc1a | 84 | sendCommand(0x20 | CMD_FS_POWER_DOWN_MODE | CMD_FS_HORIZONTAL_MODE | CMD_FS_EXTENDED_MODE); |
lssyczy | 0:ef370734cc1a | 85 | // small delay and then turn off the power pin |
lssyczy | 0:ef370734cc1a | 86 | wait_ms(10); |
lssyczy | 0:ef370734cc1a | 87 | pwr->write(0); |
lssyczy | 0:ef370734cc1a | 88 | |
lssyczy | 0:ef370734cc1a | 89 | } |
lssyczy | 0:ef370734cc1a | 90 | |
lssyczy | 0:ef370734cc1a | 91 | // function to change LED backlight brightness |
lssyczy | 0:ef370734cc1a | 92 | void N5110::setBrightness(float brightness) |
lssyczy | 0:ef370734cc1a | 93 | { |
lssyczy | 0:ef370734cc1a | 94 | // check whether brightness is within range |
lssyczy | 0:ef370734cc1a | 95 | if (brightness < 0.0) |
lssyczy | 0:ef370734cc1a | 96 | brightness = 0.0; |
lssyczy | 0:ef370734cc1a | 97 | if (brightness > 1.0) |
lssyczy | 0:ef370734cc1a | 98 | brightness = 1.0; |
lssyczy | 0:ef370734cc1a | 99 | // set PWM duty cycle |
lssyczy | 0:ef370734cc1a | 100 | led->write(brightness); |
lssyczy | 0:ef370734cc1a | 101 | } |
lssyczy | 0:ef370734cc1a | 102 | |
lssyczy | 0:ef370734cc1a | 103 | |
lssyczy | 0:ef370734cc1a | 104 | // pulse the active low reset line |
lssyczy | 0:ef370734cc1a | 105 | void N5110::reset() |
lssyczy | 0:ef370734cc1a | 106 | { |
lssyczy | 0:ef370734cc1a | 107 | rst->write(0); // reset the LCD |
lssyczy | 0:ef370734cc1a | 108 | rst->write(1); |
lssyczy | 0:ef370734cc1a | 109 | } |
lssyczy | 0:ef370734cc1a | 110 | |
lssyczy | 0:ef370734cc1a | 111 | // function to initialise SPI peripheral |
lssyczy | 0:ef370734cc1a | 112 | void N5110::initSPI() |
lssyczy | 0:ef370734cc1a | 113 | { |
lssyczy | 0:ef370734cc1a | 114 | 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 |
lssyczy | 0:ef370734cc1a | 115 | spi->frequency(4000000); // maximum of screen is 4 MHz |
lssyczy | 0:ef370734cc1a | 116 | } |
lssyczy | 0:ef370734cc1a | 117 | |
lssyczy | 0:ef370734cc1a | 118 | // send a command to the display |
lssyczy | 0:ef370734cc1a | 119 | void N5110::sendCommand(unsigned char command) |
lssyczy | 0:ef370734cc1a | 120 | { |
lssyczy | 0:ef370734cc1a | 121 | dc->write(0); // set DC low for command |
lssyczy | 0:ef370734cc1a | 122 | sce->write(0); // set CE low to begin frame |
lssyczy | 0:ef370734cc1a | 123 | spi->write(command); // send command |
lssyczy | 0:ef370734cc1a | 124 | dc->write(1); // turn back to data by default |
lssyczy | 0:ef370734cc1a | 125 | sce->write(1); // set CE high to end frame (expected for transmission of single byte) |
lssyczy | 0:ef370734cc1a | 126 | |
lssyczy | 0:ef370734cc1a | 127 | } |
lssyczy | 0:ef370734cc1a | 128 | |
lssyczy | 0:ef370734cc1a | 129 | // send data to the display at the current XY address |
lssyczy | 0:ef370734cc1a | 130 | // dc is set to 1 (i.e. data) after sending a command and so should |
lssyczy | 0:ef370734cc1a | 131 | // be the default mode. |
lssyczy | 0:ef370734cc1a | 132 | void N5110::sendData(unsigned char data) |
lssyczy | 0:ef370734cc1a | 133 | { |
lssyczy | 0:ef370734cc1a | 134 | sce->write(0); // set CE low to begin frame |
lssyczy | 0:ef370734cc1a | 135 | spi->write(data); |
lssyczy | 0:ef370734cc1a | 136 | sce->write(1); // set CE high to end frame (expected for transmission of single byte) |
lssyczy | 0:ef370734cc1a | 137 | } |
lssyczy | 0:ef370734cc1a | 138 | |
lssyczy | 0:ef370734cc1a | 139 | // this function writes 0 to the 504 bytes to clear the RAM |
lssyczy | 0:ef370734cc1a | 140 | void N5110::clearRAM() |
lssyczy | 0:ef370734cc1a | 141 | { |
lssyczy | 0:ef370734cc1a | 142 | int i; |
lssyczy | 0:ef370734cc1a | 143 | sce->write(0); //set CE low to begin frame |
lssyczy | 0:ef370734cc1a | 144 | for(i = 0; i < WIDTH * HEIGHT; i++) { // 48 x 84 bits = 504 bytes |
lssyczy | 0:ef370734cc1a | 145 | spi->write(0x00); // send 0's |
lssyczy | 0:ef370734cc1a | 146 | } |
lssyczy | 0:ef370734cc1a | 147 | sce->write(1); // set CE high to end frame |
lssyczy | 0:ef370734cc1a | 148 | |
lssyczy | 0:ef370734cc1a | 149 | } |
lssyczy | 0:ef370734cc1a | 150 | |
lssyczy | 0:ef370734cc1a | 151 | // function to set the XY address in RAM for subsequenct data write |
lssyczy | 0:ef370734cc1a | 152 | void N5110::setXYAddress(int x, int y) |
lssyczy | 0:ef370734cc1a | 153 | { |
lssyczy | 0:ef370734cc1a | 154 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
lssyczy | 0:ef370734cc1a | 155 | sendCommand(0x80 | x); // send addresses to display with relevant mask |
lssyczy | 0:ef370734cc1a | 156 | sendCommand(0x40 | y); |
lssyczy | 0:ef370734cc1a | 157 | } |
lssyczy | 0:ef370734cc1a | 158 | } |
lssyczy | 0:ef370734cc1a | 159 | |
lssyczy | 0:ef370734cc1a | 160 | // These functions are used to set, clear and get the value of pixels in the display |
lssyczy | 0:ef370734cc1a | 161 | // Pixels are addressed in the range of 0 to 47 (y) and 0 to 83 (x). The refresh() |
lssyczy | 0:ef370734cc1a | 162 | // function must be called after set and clear in order to update the display |
lssyczy | 0:ef370734cc1a | 163 | void N5110::setPixel(int x, int y) |
lssyczy | 0:ef370734cc1a | 164 | { |
lssyczy | 0:ef370734cc1a | 165 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
lssyczy | 0:ef370734cc1a | 166 | // calculate bank and shift 1 to required position in the data byte |
lssyczy | 0:ef370734cc1a | 167 | buffer[x][y/8] |= (1 << y%8); |
lssyczy | 0:ef370734cc1a | 168 | } |
lssyczy | 0:ef370734cc1a | 169 | } |
lssyczy | 0:ef370734cc1a | 170 | |
lssyczy | 0:ef370734cc1a | 171 | void N5110::clearPixel(int x, int y) |
lssyczy | 0:ef370734cc1a | 172 | { |
lssyczy | 0:ef370734cc1a | 173 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
lssyczy | 0:ef370734cc1a | 174 | // calculate bank and shift 1 to required position (using bit clear) |
lssyczy | 0:ef370734cc1a | 175 | buffer[x][y/8] &= ~(1 << y%8); |
lssyczy | 0:ef370734cc1a | 176 | } |
lssyczy | 0:ef370734cc1a | 177 | } |
lssyczy | 0:ef370734cc1a | 178 | |
lssyczy | 0:ef370734cc1a | 179 | int N5110::getPixel(int x, int y) |
lssyczy | 0:ef370734cc1a | 180 | { |
lssyczy | 0:ef370734cc1a | 181 | if (x>=0 && x<WIDTH && y>=0 && y<HEIGHT) { // check within range |
lssyczy | 0:ef370734cc1a | 182 | // return relevant bank and mask required bit |
lssyczy | 0:ef370734cc1a | 183 | return (int) buffer[x][y/8] & (1 << y%8); |
lssyczy | 0:ef370734cc1a | 184 | // note this does not necessarily return 1 - a non-zero number represents a pixel |
lssyczy | 0:ef370734cc1a | 185 | } else { |
lssyczy | 0:ef370734cc1a | 186 | return 0; |
lssyczy | 0:ef370734cc1a | 187 | } |
lssyczy | 0:ef370734cc1a | 188 | } |
lssyczy | 0:ef370734cc1a | 189 | |
lssyczy | 0:ef370734cc1a | 190 | // function to refresh the display |
lssyczy | 0:ef370734cc1a | 191 | void N5110::refresh() |
lssyczy | 0:ef370734cc1a | 192 | { |
lssyczy | 0:ef370734cc1a | 193 | int i,j; |
lssyczy | 0:ef370734cc1a | 194 | |
lssyczy | 0:ef370734cc1a | 195 | setXYAddress(0,0); // important to set address back to 0,0 before refreshing display |
lssyczy | 0:ef370734cc1a | 196 | // address auto increments after printing string, so buffer[0][0] will not coincide |
lssyczy | 0:ef370734cc1a | 197 | // with top-left pixel after priting string |
lssyczy | 0:ef370734cc1a | 198 | |
lssyczy | 0:ef370734cc1a | 199 | sce->write(0); //set CE low to begin frame |
lssyczy | 0:ef370734cc1a | 200 | |
lssyczy | 0:ef370734cc1a | 201 | for(j = 0; j < BANKS; j++) { // be careful to use correct order (j,i) for horizontal addressing |
lssyczy | 0:ef370734cc1a | 202 | for(i = 0; i < WIDTH; i++) { |
lssyczy | 0:ef370734cc1a | 203 | spi->write(buffer[i][j]); // send buffer |
lssyczy | 0:ef370734cc1a | 204 | } |
lssyczy | 0:ef370734cc1a | 205 | } |
lssyczy | 0:ef370734cc1a | 206 | sce->write(1); // set CE high to end frame |
lssyczy | 0:ef370734cc1a | 207 | |
lssyczy | 0:ef370734cc1a | 208 | } |
lssyczy | 0:ef370734cc1a | 209 | |
lssyczy | 0:ef370734cc1a | 210 | // fills the buffer with random bytes. Can be used to test the display. |
lssyczy | 0:ef370734cc1a | 211 | // The rand() function isn't seeded so it probably creates the same pattern everytime |
lssyczy | 0:ef370734cc1a | 212 | void N5110::randomiseBuffer() |
lssyczy | 0:ef370734cc1a | 213 | { |
lssyczy | 0:ef370734cc1a | 214 | int i,j; |
lssyczy | 0:ef370734cc1a | 215 | for(j = 0; j < BANKS; j++) { // be careful to use correct order (j,i) for horizontal addressing |
lssyczy | 0:ef370734cc1a | 216 | for(i = 0; i < WIDTH; i++) { |
lssyczy | 0:ef370734cc1a | 217 | buffer[i][j] = rand()%256; // generate random byte |
lssyczy | 0:ef370734cc1a | 218 | } |
lssyczy | 0:ef370734cc1a | 219 | } |
lssyczy | 0:ef370734cc1a | 220 | |
lssyczy | 0:ef370734cc1a | 221 | } |
lssyczy | 0:ef370734cc1a | 222 | |
lssyczy | 0:ef370734cc1a | 223 | // function to print 5x7 font |
lssyczy | 0:ef370734cc1a | 224 | void N5110::printChar(char c,int x,int y) |
lssyczy | 0:ef370734cc1a | 225 | { |
lssyczy | 0:ef370734cc1a | 226 | if (y>=0 && y<BANKS) { // check if printing in range of y banks |
lssyczy | 0:ef370734cc1a | 227 | |
lssyczy | 0:ef370734cc1a | 228 | for (int i = 0; i < 5 ; i++ ) { |
lssyczy | 0:ef370734cc1a | 229 | int pixel_x = x+i; |
lssyczy | 0:ef370734cc1a | 230 | if (pixel_x > WIDTH-1) // ensure pixel isn't outside the buffer size (0 - 83) |
lssyczy | 0:ef370734cc1a | 231 | break; |
lssyczy | 0:ef370734cc1a | 232 | buffer[pixel_x][y] = font5x7[(c - 32)*5 + i]; |
lssyczy | 0:ef370734cc1a | 233 | // array is offset by 32 relative to ASCII, each character is 5 pixels wide |
lssyczy | 0:ef370734cc1a | 234 | } |
lssyczy | 0:ef370734cc1a | 235 | |
lssyczy | 0:ef370734cc1a | 236 | refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0 |
lssyczy | 0:ef370734cc1a | 237 | } |
lssyczy | 0:ef370734cc1a | 238 | } |
lssyczy | 0:ef370734cc1a | 239 | |
lssyczy | 0:ef370734cc1a | 240 | // function to print string at specified position |
lssyczy | 0:ef370734cc1a | 241 | void N5110::printString(const char * str,int x,int y) |
lssyczy | 0:ef370734cc1a | 242 | { |
lssyczy | 0:ef370734cc1a | 243 | if (y>=0 && y<BANKS) { // check if printing in range of y banks |
lssyczy | 0:ef370734cc1a | 244 | |
lssyczy | 0:ef370734cc1a | 245 | int n = 0 ; // counter for number of characters in string |
lssyczy | 0:ef370734cc1a | 246 | // loop through string and print character |
lssyczy | 0:ef370734cc1a | 247 | while(*str) { |
lssyczy | 0:ef370734cc1a | 248 | |
lssyczy | 0:ef370734cc1a | 249 | // writes the character bitmap data to the buffer, so that |
lssyczy | 0:ef370734cc1a | 250 | // text and pixels can be displayed at the same time |
lssyczy | 0:ef370734cc1a | 251 | for (int i = 0; i < 5 ; i++ ) { |
lssyczy | 0:ef370734cc1a | 252 | int pixel_x = x+i+n*6; |
lssyczy | 0:ef370734cc1a | 253 | if (pixel_x > WIDTH-1) // ensure pixel isn't outside the buffer size (0 - 83) |
lssyczy | 0:ef370734cc1a | 254 | break; |
lssyczy | 0:ef370734cc1a | 255 | buffer[pixel_x][y] = font5x7[(*str - 32)*5 + i]; |
lssyczy | 0:ef370734cc1a | 256 | } |
lssyczy | 0:ef370734cc1a | 257 | |
lssyczy | 0:ef370734cc1a | 258 | str++; // go to next character in string |
lssyczy | 0:ef370734cc1a | 259 | |
lssyczy | 0:ef370734cc1a | 260 | n++; // increment index |
lssyczy | 0:ef370734cc1a | 261 | |
lssyczy | 0:ef370734cc1a | 262 | } |
lssyczy | 0:ef370734cc1a | 263 | |
lssyczy | 0:ef370734cc1a | 264 | refresh(); // this sends the buffer to the display and sets address (cursor) back to 0,0 |
lssyczy | 0:ef370734cc1a | 265 | } |
lssyczy | 0:ef370734cc1a | 266 | } |
lssyczy | 0:ef370734cc1a | 267 | |
lssyczy | 0:ef370734cc1a | 268 | // function to clear the screen |
lssyczy | 0:ef370734cc1a | 269 | void N5110::clear() |
lssyczy | 0:ef370734cc1a | 270 | { |
lssyczy | 0:ef370734cc1a | 271 | clearBuffer(); // clear the buffer then call the refresh function |
lssyczy | 0:ef370734cc1a | 272 | refresh(); |
lssyczy | 0:ef370734cc1a | 273 | } |
lssyczy | 0:ef370734cc1a | 274 | |
lssyczy | 0:ef370734cc1a | 275 | // function to clear the buffer |
lssyczy | 0:ef370734cc1a | 276 | void N5110::clearBuffer() |
lssyczy | 0:ef370734cc1a | 277 | { |
lssyczy | 0:ef370734cc1a | 278 | int i,j; |
lssyczy | 0:ef370734cc1a | 279 | for (i=0; i<WIDTH; i++) { // loop through the banks and set the buffer to 0 |
lssyczy | 0:ef370734cc1a | 280 | for (j=0; j<BANKS; j++) { |
lssyczy | 0:ef370734cc1a | 281 | buffer[i][j]=0; |
lssyczy | 0:ef370734cc1a | 282 | } |
lssyczy | 0:ef370734cc1a | 283 | } |
lssyczy | 0:ef370734cc1a | 284 | } |
lssyczy | 0:ef370734cc1a | 285 | |
lssyczy | 0:ef370734cc1a | 286 | // function to plot array on display |
lssyczy | 0:ef370734cc1a | 287 | void N5110::plotArray(float array[]) |
lssyczy | 0:ef370734cc1a | 288 | { |
lssyczy | 0:ef370734cc1a | 289 | |
lssyczy | 0:ef370734cc1a | 290 | int i; |
lssyczy | 0:ef370734cc1a | 291 | |
lssyczy | 0:ef370734cc1a | 292 | for (i=0; i<WIDTH; i++) { // loop through array |
lssyczy | 0:ef370734cc1a | 293 | // elements are normalised from 0.0 to 1.0, so multiply |
lssyczy | 0:ef370734cc1a | 294 | // by 47 to convert to pixel range, and subtract from 47 |
lssyczy | 0:ef370734cc1a | 295 | // since top-left is 0,0 in the display geometry |
lssyczy | 0:ef370734cc1a | 296 | setPixel(i,47 - int(array[i]*47.0)); |
lssyczy | 0:ef370734cc1a | 297 | } |
lssyczy | 0:ef370734cc1a | 298 | |
lssyczy | 0:ef370734cc1a | 299 | refresh(); |
lssyczy | 0:ef370734cc1a | 300 | |
lssyczy | 0:ef370734cc1a | 301 | } |
lssyczy | 0:ef370734cc1a | 302 | |
lssyczy | 0:ef370734cc1a | 303 | // function to draw circle |
lssyczy | 0:ef370734cc1a | 304 | void N5110:: drawCircle(int x0,int y0,int radius,int fill) |
lssyczy | 0:ef370734cc1a | 305 | { |
lssyczy | 0:ef370734cc1a | 306 | // from http://en.wikipedia.org/wiki/Midpoint_circle_algorithm |
lssyczy | 0:ef370734cc1a | 307 | int x = radius; |
lssyczy | 0:ef370734cc1a | 308 | int y = 0; |
lssyczy | 0:ef370734cc1a | 309 | int radiusError = 1-x; |
lssyczy | 0:ef370734cc1a | 310 | |
lssyczy | 0:ef370734cc1a | 311 | while(x >= y) { |
lssyczy | 0:ef370734cc1a | 312 | |
lssyczy | 0:ef370734cc1a | 313 | // if transparent, just draw outline |
lssyczy | 0:ef370734cc1a | 314 | if (fill == 0) { |
lssyczy | 0:ef370734cc1a | 315 | setPixel( x + x0, y + y0); |
lssyczy | 0:ef370734cc1a | 316 | setPixel(-x + x0, y + y0); |
lssyczy | 0:ef370734cc1a | 317 | setPixel( y + x0, x + y0); |
lssyczy | 0:ef370734cc1a | 318 | setPixel(-y + x0, x + y0); |
lssyczy | 0:ef370734cc1a | 319 | setPixel(-y + x0, -x + y0); |
lssyczy | 0:ef370734cc1a | 320 | setPixel( y + x0, -x + y0); |
lssyczy | 0:ef370734cc1a | 321 | setPixel( x + x0, -y + y0); |
lssyczy | 0:ef370734cc1a | 322 | setPixel(-x + x0, -y + y0); |
lssyczy | 0:ef370734cc1a | 323 | } else { // drawing filled circle, so draw lines between points at same y value |
lssyczy | 0:ef370734cc1a | 324 | |
lssyczy | 0:ef370734cc1a | 325 | int type = (fill==1) ? 1:0; // black or white fill |
lssyczy | 0:ef370734cc1a | 326 | |
lssyczy | 0:ef370734cc1a | 327 | drawLine(x+x0,y+y0,-x+x0,y+y0,type); |
lssyczy | 0:ef370734cc1a | 328 | drawLine(y+x0,x+y0,-y+x0,x+y0,type); |
lssyczy | 0:ef370734cc1a | 329 | drawLine(y+x0,-x+y0,-y+x0,-x+y0,type); |
lssyczy | 0:ef370734cc1a | 330 | drawLine(x+x0,-y+y0,-x+x0,-y+y0,type); |
lssyczy | 0:ef370734cc1a | 331 | } |
lssyczy | 0:ef370734cc1a | 332 | |
lssyczy | 0:ef370734cc1a | 333 | |
lssyczy | 0:ef370734cc1a | 334 | y++; |
lssyczy | 0:ef370734cc1a | 335 | if (radiusError<0) { |
lssyczy | 0:ef370734cc1a | 336 | radiusError += 2 * y + 1; |
lssyczy | 0:ef370734cc1a | 337 | } else { |
lssyczy | 0:ef370734cc1a | 338 | x--; |
lssyczy | 0:ef370734cc1a | 339 | radiusError += 2 * (y - x) + 1; |
lssyczy | 0:ef370734cc1a | 340 | } |
lssyczy | 0:ef370734cc1a | 341 | } |
lssyczy | 0:ef370734cc1a | 342 | |
lssyczy | 0:ef370734cc1a | 343 | } |
lssyczy | 0:ef370734cc1a | 344 | |
lssyczy | 0:ef370734cc1a | 345 | void N5110::drawLine(int x0,int y0,int x1,int y1,int type) |
lssyczy | 0:ef370734cc1a | 346 | { |
lssyczy | 0:ef370734cc1a | 347 | int y_range = y1-y0; // calc range of y and x |
lssyczy | 0:ef370734cc1a | 348 | int x_range = x1-x0; |
lssyczy | 0:ef370734cc1a | 349 | int start,stop,step; |
lssyczy | 0:ef370734cc1a | 350 | |
lssyczy | 0:ef370734cc1a | 351 | // if dotted line, set step to 2, else step is 1 |
lssyczy | 0:ef370734cc1a | 352 | step = (type==2) ? 2:1; |
lssyczy | 0:ef370734cc1a | 353 | |
lssyczy | 0:ef370734cc1a | 354 | // make sure we loop over the largest range to get the most pixels on the display |
lssyczy | 0:ef370734cc1a | 355 | // for instance, if drawing a vertical line (x_range = 0), we need to loop down the y pixels |
lssyczy | 0:ef370734cc1a | 356 | // or else we'll only end up with 1 pixel in the x column |
lssyczy | 0:ef370734cc1a | 357 | if ( abs(x_range) > abs(y_range) ) { |
lssyczy | 0:ef370734cc1a | 358 | |
lssyczy | 0:ef370734cc1a | 359 | // ensure we loop from smallest to largest or else for-loop won't run as expected |
lssyczy | 0:ef370734cc1a | 360 | start = x1>x0 ? x0:x1; |
lssyczy | 0:ef370734cc1a | 361 | stop = x1>x0 ? x1:x0; |
lssyczy | 0:ef370734cc1a | 362 | |
lssyczy | 0:ef370734cc1a | 363 | // loop between x pixels |
lssyczy | 0:ef370734cc1a | 364 | for (int x = start; x<= stop ; x+=step) { |
lssyczy | 0:ef370734cc1a | 365 | // do linear interpolation |
lssyczy | 0:ef370734cc1a | 366 | int y = y0 + (y1-y0)*(x-x0)/(x1-x0); |
lssyczy | 0:ef370734cc1a | 367 | |
lssyczy | 0:ef370734cc1a | 368 | if (type == 0) // if 'white' line, turn off pixel |
lssyczy | 0:ef370734cc1a | 369 | clearPixel(x,y); |
lssyczy | 0:ef370734cc1a | 370 | else |
lssyczy | 0:ef370734cc1a | 371 | setPixel(x,y); // else if 'black' or 'dotted' turn on pixel |
lssyczy | 0:ef370734cc1a | 372 | } |
lssyczy | 0:ef370734cc1a | 373 | } else { |
lssyczy | 0:ef370734cc1a | 374 | |
lssyczy | 0:ef370734cc1a | 375 | // ensure we loop from smallest to largest or else for-loop won't run as expected |
lssyczy | 0:ef370734cc1a | 376 | start = y1>y0 ? y0:y1; |
lssyczy | 0:ef370734cc1a | 377 | stop = y1>y0 ? y1:y0; |
lssyczy | 0:ef370734cc1a | 378 | |
lssyczy | 0:ef370734cc1a | 379 | for (int y = start; y<= stop ; y+=step) { |
lssyczy | 0:ef370734cc1a | 380 | // do linear interpolation |
lssyczy | 0:ef370734cc1a | 381 | int x = x0 + (x1-x0)*(y-y0)/(y1-y0); |
lssyczy | 0:ef370734cc1a | 382 | |
lssyczy | 0:ef370734cc1a | 383 | if (type == 0) // if 'white' line, turn off pixel |
lssyczy | 0:ef370734cc1a | 384 | clearPixel(x,y); |
lssyczy | 0:ef370734cc1a | 385 | else |
lssyczy | 0:ef370734cc1a | 386 | setPixel(x,y); // else if 'black' or 'dotted' turn on pixel |
lssyczy | 0:ef370734cc1a | 387 | |
lssyczy | 0:ef370734cc1a | 388 | } |
lssyczy | 0:ef370734cc1a | 389 | } |
lssyczy | 0:ef370734cc1a | 390 | |
lssyczy | 0:ef370734cc1a | 391 | } |
lssyczy | 0:ef370734cc1a | 392 | |
lssyczy | 0:ef370734cc1a | 393 | void N5110::drawRect(int x0,int y0,int width,int height,int fill) |
lssyczy | 0:ef370734cc1a | 394 | { |
lssyczy | 0:ef370734cc1a | 395 | |
lssyczy | 0:ef370734cc1a | 396 | if (fill == 0) { // transparent, just outline |
lssyczy | 0:ef370734cc1a | 397 | drawLine(x0,y0,x0+width,y0,1); // top |
lssyczy | 0:ef370734cc1a | 398 | drawLine(x0,y0+height,x0+width,y0+height,1); // bottom |
lssyczy | 0:ef370734cc1a | 399 | drawLine(x0,y0,x0,y0+height,1); // left |
lssyczy | 0:ef370734cc1a | 400 | drawLine(x0+width,y0,x0+width,y0+height,1); // right |
lssyczy | 0:ef370734cc1a | 401 | } else { // filled rectangle |
lssyczy | 0:ef370734cc1a | 402 | int type = (fill==1) ? 1:0; // black or white fill |
lssyczy | 0:ef370734cc1a | 403 | for (int y = y0; y<= y0+height; y++) { // loop through rows of rectangle |
lssyczy | 0:ef370734cc1a | 404 | drawLine(x0,y,x0+width,y,type); // draw line across screen |
lssyczy | 0:ef370734cc1a | 405 | } |
lssyczy | 0:ef370734cc1a | 406 | } |
lssyczy | 0:ef370734cc1a | 407 | |
lssyczy | 0:ef370734cc1a | 408 | } |
lssyczy | 0:ef370734cc1a | 409 | |
lssyczy | 0:ef370734cc1a | 410 | |
lssyczy | 0:ef370734cc1a | 411 | |
lssyczy | 0:ef370734cc1a | 412 | |
lssyczy | 0:ef370734cc1a | 413 | N5110 lcd(p7,p8,p9,p10,p11,p13,p26); |
lssyczy | 0:ef370734cc1a | 414 | BusOut leds(LED4,LED3,LED2,LED1); |
lssyczy | 0:ef370734cc1a | 415 | MMA8452 mma8452(p28,p27); |
lssyczy | 0:ef370734cc1a | 416 | Beep buzzer(p21); |
lssyczy | 0:ef370734cc1a | 417 | DigitalOut led(p24); |
lssyczy | 0:ef370734cc1a | 418 | InterruptIn button(p29); |
lssyczy | 0:ef370734cc1a | 419 | |
lssyczy | 0:ef370734cc1a | 420 | int buttonFlag = 0; |
lssyczy | 0:ef370734cc1a | 421 | |
lssyczy | 0:ef370734cc1a | 422 | void buttonPressed() |
lssyczy | 0:ef370734cc1a | 423 | { |
lssyczy | 0:ef370734cc1a | 424 | buttonFlag = 1; |
lssyczy | 0:ef370734cc1a | 425 | } |
lssyczy | 0:ef370734cc1a | 426 | |
lssyczy | 0:ef370734cc1a | 427 | int main() |
lssyczy | 0:ef370734cc1a | 428 | { |
lssyczy | 0:ef370734cc1a | 429 | lcd.init(); |
lssyczy | 0:ef370734cc1a | 430 | mma8452.init(); // 100 Hz update rate, ±4g scale |
lssyczy | 0:ef370734cc1a | 431 | lcd.normalMode(); // normal colour mode |
lssyczy | 0:ef370734cc1a | 432 | lcd.setBrightness(0.5); |
lssyczy | 0:ef370734cc1a | 433 | button.rise(&buttonPressed); |
lssyczy | 0:ef370734cc1a | 434 | |
lssyczy | 0:ef370734cc1a | 435 | |
lssyczy | 0:ef370734cc1a | 436 | Acceleration acceleration; |
lssyczy | 0:ef370734cc1a | 437 | |
lssyczy | 0:ef370734cc1a | 438 | while(1) |
lssyczy | 0:ef370734cc1a | 439 | { |
lssyczy | 0:ef370734cc1a | 440 | lcd.printString("Direction",0,3); |
lssyczy | 0:ef370734cc1a | 441 | acceleration = mma8452.readValues(); |
lssyczy | 0:ef370734cc1a | 442 | |
lssyczy | 0:ef370734cc1a | 443 | char Acce_X[14]; |
lssyczy | 0:ef370734cc1a | 444 | int a=sprintf(Acce_X,"x = %.2f g",acceleration.x); |
lssyczy | 0:ef370734cc1a | 445 | lcd.printString(Acce_X,0,0); |
lssyczy | 0:ef370734cc1a | 446 | |
lssyczy | 0:ef370734cc1a | 447 | char Acce_Y[14]; |
lssyczy | 0:ef370734cc1a | 448 | int b=sprintf(Acce_Y,"y = %.2f g",acceleration.y); |
lssyczy | 0:ef370734cc1a | 449 | lcd.printString(Acce_Y,0,1); |
lssyczy | 0:ef370734cc1a | 450 | |
lssyczy | 0:ef370734cc1a | 451 | char Acce_Z[14]; |
lssyczy | 0:ef370734cc1a | 452 | int c=sprintf(Acce_Z,"z = %.2f g",acceleration.z); |
lssyczy | 0:ef370734cc1a | 453 | lcd.printString(Acce_Z,0,2); |
lssyczy | 0:ef370734cc1a | 454 | |
lssyczy | 0:ef370734cc1a | 455 | if (acceleration.x<0){ |
lssyczy | 0:ef370734cc1a | 456 | |
lssyczy | 0:ef370734cc1a | 457 | led = 1; |
lssyczy | 0:ef370734cc1a | 458 | } |
lssyczy | 0:ef370734cc1a | 459 | |
lssyczy | 0:ef370734cc1a | 460 | |
lssyczy | 0:ef370734cc1a | 461 | if (acceleration.x>0){ |
lssyczy | 0:ef370734cc1a | 462 | |
lssyczy | 0:ef370734cc1a | 463 | led = 0; |
lssyczy | 0:ef370734cc1a | 464 | } |
lssyczy | 0:ef370734cc1a | 465 | |
lssyczy | 0:ef370734cc1a | 466 | |
lssyczy | 0:ef370734cc1a | 467 | |
lssyczy | 0:ef370734cc1a | 468 | if (buttonFlag){ |
lssyczy | 0:ef370734cc1a | 469 | buttonFlag = 0; |
lssyczy | 0:ef370734cc1a | 470 | |
lssyczy | 0:ef370734cc1a | 471 | if (acceleration.x<0){ |
lssyczy | 0:ef370734cc1a | 472 | lcd.printString("Left",0,4); |
lssyczy | 0:ef370734cc1a | 473 | |
lssyczy | 0:ef370734cc1a | 474 | } |
lssyczy | 0:ef370734cc1a | 475 | |
lssyczy | 0:ef370734cc1a | 476 | |
lssyczy | 0:ef370734cc1a | 477 | if (acceleration.x>0){ |
lssyczy | 0:ef370734cc1a | 478 | lcd.printString("Right",42,4); |
lssyczy | 0:ef370734cc1a | 479 | |
lssyczy | 0:ef370734cc1a | 480 | } |
lssyczy | 0:ef370734cc1a | 481 | |
lssyczy | 0:ef370734cc1a | 482 | if (acceleration.y>0){ |
lssyczy | 0:ef370734cc1a | 483 | lcd.printString("Up",0,5); |
lssyczy | 0:ef370734cc1a | 484 | |
lssyczy | 0:ef370734cc1a | 485 | } |
lssyczy | 0:ef370734cc1a | 486 | |
lssyczy | 0:ef370734cc1a | 487 | if (acceleration.y<0){ |
lssyczy | 0:ef370734cc1a | 488 | lcd.printString("Down",42,5); |
lssyczy | 0:ef370734cc1a | 489 | |
lssyczy | 0:ef370734cc1a | 490 | } |
lssyczy | 0:ef370734cc1a | 491 | |
lssyczy | 0:ef370734cc1a | 492 | wait (1.5); |
lssyczy | 0:ef370734cc1a | 493 | lcd.refresh(); |
lssyczy | 0:ef370734cc1a | 494 | if (acceleration.x<0){ |
lssyczy | 0:ef370734cc1a | 495 | |
lssyczy | 0:ef370734cc1a | 496 | |
lssyczy | 0:ef370734cc1a | 497 | |
lssyczy | 0:ef370734cc1a | 498 | buzzer.beep(4000,0.5); |
lssyczy | 0:ef370734cc1a | 499 | |
lssyczy | 0:ef370734cc1a | 500 | } |
lssyczy | 0:ef370734cc1a | 501 | else { |
lssyczy | 0:ef370734cc1a | 502 | buzzer.nobeep(); |
lssyczy | 0:ef370734cc1a | 503 | } |
lssyczy | 0:ef370734cc1a | 504 | wait (1.5); |
lssyczy | 0:ef370734cc1a | 505 | lcd.refresh(); |
lssyczy | 0:ef370734cc1a | 506 | |
lssyczy | 0:ef370734cc1a | 507 | lcd.clear(); |
lssyczy | 0:ef370734cc1a | 508 | } |
lssyczy | 0:ef370734cc1a | 509 | } |
lssyczy | 0:ef370734cc1a | 510 | |
lssyczy | 0:ef370734cc1a | 511 | |
lssyczy | 0:ef370734cc1a | 512 | |
lssyczy | 0:ef370734cc1a | 513 | |
lssyczy | 0:ef370734cc1a | 514 | } |