Here
Dependencies: Hexi_KW40Z Hexi_OLED_SSD1351 nRF24L01 FXOS8700
main.cpp@5:09837d22b28f, 2017-03-13 (annotated)
- Committer:
- tdh50
- Date:
- Mon Mar 13 15:54:10 2017 +0000
- Revision:
- 5:09837d22b28f
- Parent:
- 3:065e8a7824d4
- Child:
- 7:46729d931f26
Accelerometer
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 1 | #include "mbed.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 2 | #include "Hexi_KW40Z.h" |
tdh50 | 5:09837d22b28f | 3 | #include "FXOS8700.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 4 | #include "Hexi_OLED_SSD1351.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 5 | #include "OLED_types.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 6 | #include "OpenSans_Font.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 7 | #include "nRF24L01P.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 8 | #include "string.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 9 | #include "images.h" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 10 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 11 | #define NAME "RB" |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 12 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 13 | #define LED_ON 0 |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 14 | #define LED_OFF 1 |
tdh50 | 3:065e8a7824d4 | 15 | #define NUM_OF_SCREENS 4 |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 16 | #define TRANSFER_SIZE 4 |
tdh50 | 3:065e8a7824d4 | 17 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 18 | void StartHaptic(void); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 19 | void StopHaptic(void const *n); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 20 | void txTask(void); |
tdh50 | 5:09837d22b28f | 21 | void accelero(void); |
tdh50 | 3:065e8a7824d4 | 22 | void displayHome(); |
tdh50 | 3:065e8a7824d4 | 23 | void screenHandler(uint8_t screen); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 24 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 25 | DigitalOut redLed(LED1,1); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 26 | DigitalOut greenLed(LED2,1); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 27 | DigitalOut blueLed(LED3,1); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 28 | DigitalOut haptic(PTB9); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 29 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 30 | /* Define timer for haptic feedback */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 31 | RtosTimer hapticTimer(StopHaptic, osTimerOnce); |
tdh50 | 5:09837d22b28f | 32 | /* */ |
tdh50 | 5:09837d22b28f | 33 | FXOS8700 accel(PTC11, PTC10); |
tdh50 | 3:065e8a7824d4 | 34 | /* Instantiate the Hexi KW40Z Driver (UART TX, UART RX) */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 35 | KW40Z kw40z_device(PTE24, PTE25); |
tdh50 | 5:09837d22b28f | 36 | Serial pc(USBTX, USBRX); // Serial interface |
tdh50 | 3:065e8a7824d4 | 37 | /* Instantiate the SSD1351 OLED Driver */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 38 | SSD1351 oled(PTB22,PTB21,PTC13,PTB20,PTE6, PTD15); /* (MOSI,SCLK,POWER,CS,RST,DC) */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 39 | oled_text_properties_t textProperties = {0}; |
tdh50 | 3:065e8a7824d4 | 40 | /* Instantiate the nRF24L01P Driver */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 41 | nRF24L01P my_nrf24l01p(PTC6,PTC7,PTC5,PTC4,PTB2,NC); // mosi, miso, sck, csn, ce, irq |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 42 | |
tdh50 | 3:065e8a7824d4 | 43 | /* Text Buffer */ |
tdh50 | 5:09837d22b28f | 44 | char text1[20]; // Text Buffer for dynamic value displayed |
tdh50 | 5:09837d22b28f | 45 | char text2[20]; // Text Buffer for dynamic value displayed |
tdh50 | 5:09837d22b28f | 46 | char text3[20]; // Text Buffer for dynamic value displayed |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 47 | |
tdh50 | 5:09837d22b28f | 48 | float accel_data[3]; // Storage for the data from the sensor |
tdh50 | 5:09837d22b28f | 49 | float accel_rms=0.0; // RMS value from the sensor |
tdh50 | 5:09837d22b28f | 50 | float ax, ay, az; // Integer value from the sensor to be displayed |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 51 | uint8_t screenNum=0; |
tdh50 | 3:065e8a7824d4 | 52 | bool prefix=0; |
tdh50 | 5:09837d22b28f | 53 | bool accelerometer = false; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 54 | bool sentMessageDisplayedFlag=0; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 55 | char rxData[TRANSFER_SIZE]; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 56 | char txData[TRANSFER_SIZE]; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 57 | |
tdh50 | 3:065e8a7824d4 | 58 | /* Pointer for the image to be displayed */ |
DeanBritt | 2:172492c41c48 | 59 | const uint8_t *SafeBMP = HexiSafe96_bmp; |
tdh50 | 3:065e8a7824d4 | 60 | const uint8_t *HeartBMP = HeartRate_bmp; |
tdh50 | 3:065e8a7824d4 | 61 | const uint8_t *FallBMP = FallDet_bmp; |
tdh50 | 3:065e8a7824d4 | 62 | const uint8_t *FallPageBMP = FallDetPage_bmp; |
tdh50 | 3:065e8a7824d4 | 63 | const uint8_t *HomeBMP = Home_bmp; |
tdh50 | 3:065e8a7824d4 | 64 | const uint8_t *HeartPageBMP = HeartRatePage_bmp; |
DeanBritt | 2:172492c41c48 | 65 | |
tdh50 | 3:065e8a7824d4 | 66 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 67 | /****************************Call Back Functions*******************************/ |
tdh50 | 3:065e8a7824d4 | 68 | /*Enter Button */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 69 | void ButtonRight(void) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 70 | { |
tdh50 | 3:065e8a7824d4 | 71 | // All screens other than 1 have either and enter button |
tdh50 | 3:065e8a7824d4 | 72 | // or a home buttom. |
tdh50 | 3:065e8a7824d4 | 73 | if(screenNum != 1) { |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 74 | StartHaptic(); |
tdh50 | 3:065e8a7824d4 | 75 | switch(screenNum) { |
tdh50 | 3:065e8a7824d4 | 76 | case 0: { |
tdh50 | 3:065e8a7824d4 | 77 | screenNum++; |
tdh50 | 3:065e8a7824d4 | 78 | screenHandler(screenNum); |
tdh50 | 3:065e8a7824d4 | 79 | break; |
tdh50 | 3:065e8a7824d4 | 80 | } |
tdh50 | 3:065e8a7824d4 | 81 | case 2: { |
tdh50 | 3:065e8a7824d4 | 82 | screenNum = screenNum + 2; |
tdh50 | 3:065e8a7824d4 | 83 | screenHandler(screenNum); |
tdh50 | 3:065e8a7824d4 | 84 | break; |
tdh50 | 3:065e8a7824d4 | 85 | } |
tdh50 | 3:065e8a7824d4 | 86 | case 3: { |
tdh50 | 3:065e8a7824d4 | 87 | screenNum = screenNum + 2; |
tdh50 | 3:065e8a7824d4 | 88 | screenHandler(screenNum); |
tdh50 | 3:065e8a7824d4 | 89 | break; |
tdh50 | 3:065e8a7824d4 | 90 | } |
tdh50 | 3:065e8a7824d4 | 91 | case 4: |
tdh50 | 3:065e8a7824d4 | 92 | case 5: { |
tdh50 | 5:09837d22b28f | 93 | accelerometer = false; |
tdh50 | 3:065e8a7824d4 | 94 | screenNum = 0; |
tdh50 | 3:065e8a7824d4 | 95 | break; |
tdh50 | 3:065e8a7824d4 | 96 | } |
tdh50 | 3:065e8a7824d4 | 97 | default: { |
tdh50 | 3:065e8a7824d4 | 98 | break; |
tdh50 | 3:065e8a7824d4 | 99 | } |
tdh50 | 3:065e8a7824d4 | 100 | } |
tdh50 | 5:09837d22b28f | 101 | screenHandler(screenNum); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 102 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 103 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 104 | |
tdh50 | 3:065e8a7824d4 | 105 | /*Back Button */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 106 | void ButtonLeft(void) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 107 | { |
tdh50 | 3:065e8a7824d4 | 108 | if(screenNum > 0) { |
tdh50 | 3:065e8a7824d4 | 109 | StartHaptic(); |
tdh50 | 3:065e8a7824d4 | 110 | //Allow user to go back to correct screen based on srceen number |
tdh50 | 3:065e8a7824d4 | 111 | //Refer to screenHandler for screen numbers |
tdh50 | 3:065e8a7824d4 | 112 | if(screenNum == 3 || screenNum == 4 || screenNum == 5) { |
tdh50 | 3:065e8a7824d4 | 113 | screenNum = screenNum - 2; |
tdh50 | 5:09837d22b28f | 114 | accelerometer = false; |
tdh50 | 5:09837d22b28f | 115 | } |
tdh50 | 5:09837d22b28f | 116 | else { |
tdh50 | 3:065e8a7824d4 | 117 | screenNum--; |
tdh50 | 3:065e8a7824d4 | 118 | } |
tdh50 | 3:065e8a7824d4 | 119 | screenHandler(screenNum); |
tdh50 | 3:065e8a7824d4 | 120 | } |
tdh50 | 3:065e8a7824d4 | 121 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 122 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 123 | |
tdh50 | 3:065e8a7824d4 | 124 | /*Advances to Heartrate only when user |
tdh50 | 3:065e8a7824d4 | 125 | is on Hexisafe screen */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 126 | void ButtonUp(void) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 127 | { |
tdh50 | 3:065e8a7824d4 | 128 | if (screenNum == 1) { |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 129 | StartHaptic(); |
tdh50 | 3:065e8a7824d4 | 130 | screenNum++; |
tdh50 | 3:065e8a7824d4 | 131 | screenHandler(screenNum); |
tdh50 | 3:065e8a7824d4 | 132 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 133 | |
tdh50 | 3:065e8a7824d4 | 134 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 135 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 136 | |
tdh50 | 3:065e8a7824d4 | 137 | /*Advances to Fall Detection only when user |
tdh50 | 3:065e8a7824d4 | 138 | is on Hexisafe screen */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 139 | void ButtonDown(void) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 140 | { |
tdh50 | 3:065e8a7824d4 | 141 | if (screenNum == 1) { |
tdh50 | 3:065e8a7824d4 | 142 | StartHaptic(); |
tdh50 | 3:065e8a7824d4 | 143 | screenNum= screenNum + 2; |
tdh50 | 3:065e8a7824d4 | 144 | screenHandler(screenNum); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 145 | } |
tdh50 | 3:065e8a7824d4 | 146 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 147 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 148 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 149 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 150 | /***********************End of Call Back Functions*****************************/ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 151 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 152 | /********************************Main******************************************/ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 153 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 154 | int main() |
tdh50 | 3:065e8a7824d4 | 155 | { |
tdh50 | 3:065e8a7824d4 | 156 | /* Wait Sequence in the beginning for board to be reset then placed in mini docking station*/ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 157 | blueLed=1; |
tdh50 | 3:065e8a7824d4 | 158 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 159 | |
tdh50 | 3:065e8a7824d4 | 160 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 161 | /* Get OLED Class Default Text Properties */ |
tdh50 | 3:065e8a7824d4 | 162 | oled.GetTextProperties(&textProperties); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 163 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 164 | /* Register callbacks to application functions */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 165 | kw40z_device.attach_buttonLeft(&ButtonLeft); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 166 | kw40z_device.attach_buttonRight(&ButtonRight); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 167 | kw40z_device.attach_buttonUp(&ButtonUp); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 168 | kw40z_device.attach_buttonDown(&ButtonDown); |
tdh50 | 3:065e8a7824d4 | 169 | |
tdh50 | 3:065e8a7824d4 | 170 | /* Change font color to white */ |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 171 | textProperties.fontColor = COLOR_WHITE; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 172 | textProperties.alignParam = OLED_TEXT_ALIGN_CENTER; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 173 | oled.SetTextProperties(&textProperties); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 174 | |
tdh50 | 3:065e8a7824d4 | 175 | /*Displays the Home Screen*/ |
tdh50 | 3:065e8a7824d4 | 176 | displayHome(); |
tdh50 | 3:065e8a7824d4 | 177 | |
tdh50 | 3:065e8a7824d4 | 178 | while (true) { |
tdh50 | 5:09837d22b28f | 179 | if(accelerometer ==true) |
tdh50 | 5:09837d22b28f | 180 | { |
tdh50 | 5:09837d22b28f | 181 | accelero(); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 182 | } |
tdh50 | 5:09837d22b28f | 183 | redLed = 1 ; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 184 | Thread::wait(50); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 185 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 186 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 187 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 188 | /******************************End of Main*************************************/ |
tdh50 | 3:065e8a7824d4 | 189 | //Intiates Vibration |
tdh50 | 3:065e8a7824d4 | 190 | void StartHaptic(void) |
tdh50 | 3:065e8a7824d4 | 191 | { |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 192 | hapticTimer.start(50); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 193 | haptic = 1; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 194 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 195 | |
tdh50 | 3:065e8a7824d4 | 196 | void StopHaptic(void const *n) |
tdh50 | 3:065e8a7824d4 | 197 | { |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 198 | haptic = 0; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 199 | hapticTimer.stop(); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 200 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 201 | |
tdh50 | 3:065e8a7824d4 | 202 | void displayHome(void) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 203 | { |
tdh50 | 3:065e8a7824d4 | 204 | oled.DrawImage(HomeBMP,0,0); |
tdh50 | 3:065e8a7824d4 | 205 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 206 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 207 | |
tdh50 | 3:065e8a7824d4 | 208 | void screenHandler(uint8_t screen) |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 209 | { |
tdh50 | 3:065e8a7824d4 | 210 | //Switching screens |
tdh50 | 3:065e8a7824d4 | 211 | switch(screen) { |
tdh50 | 3:065e8a7824d4 | 212 | case 0: { |
tdh50 | 3:065e8a7824d4 | 213 | displayHome(); |
tdh50 | 3:065e8a7824d4 | 214 | break; |
tdh50 | 3:065e8a7824d4 | 215 | } |
tdh50 | 3:065e8a7824d4 | 216 | case 1: { |
tdh50 | 3:065e8a7824d4 | 217 | //Switching to SafeBMP |
tdh50 | 3:065e8a7824d4 | 218 | oled.DrawImage(SafeBMP,0,0); |
tdh50 | 3:065e8a7824d4 | 219 | break; |
tdh50 | 3:065e8a7824d4 | 220 | } |
tdh50 | 3:065e8a7824d4 | 221 | case 2: { |
tdh50 | 3:065e8a7824d4 | 222 | //Switching to HeartBMP |
tdh50 | 3:065e8a7824d4 | 223 | oled.DrawImage(HeartBMP,0,0); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 224 | break; |
tdh50 | 3:065e8a7824d4 | 225 | } |
tdh50 | 3:065e8a7824d4 | 226 | case 3: { |
tdh50 | 3:065e8a7824d4 | 227 | //Switching to FallBMP |
tdh50 | 3:065e8a7824d4 | 228 | oled.DrawImage(FallBMP,0,0); |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 229 | break; |
tdh50 | 3:065e8a7824d4 | 230 | } |
tdh50 | 3:065e8a7824d4 | 231 | case 4: { |
tdh50 | 3:065e8a7824d4 | 232 | //Switching to HeartPageBMP |
tdh50 | 3:065e8a7824d4 | 233 | oled.DrawImage(HeartPageBMP,0,0); |
tdh50 | 3:065e8a7824d4 | 234 | break; |
tdh50 | 3:065e8a7824d4 | 235 | } |
tdh50 | 3:065e8a7824d4 | 236 | case 5: { |
tdh50 | 3:065e8a7824d4 | 237 | //Switching to FallPageBMP |
tdh50 | 5:09837d22b28f | 238 | accelerometer = true; |
tdh50 | 3:065e8a7824d4 | 239 | break; |
tdh50 | 3:065e8a7824d4 | 240 | } |
tdh50 | 3:065e8a7824d4 | 241 | default: { |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 242 | break; |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 243 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 244 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 245 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 246 | |
tdh50 | 3:065e8a7824d4 | 247 | //Append Initials to txData[2:3]. |
tdh50 | 3:065e8a7824d4 | 248 | //strcat(txData,NAME); |
tdh50 | 3:065e8a7824d4 | 249 | |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 250 | } |
group-Hexiwear-Alert-System | 0:6384ad26fe6c | 251 | |
tdh50 | 5:09837d22b28f | 252 | void accelero(void){ |
tdh50 | 5:09837d22b28f | 253 | // Configure Accelerometer FXOS8700, Magnetometer FXOS8700 |
tdh50 | 5:09837d22b28f | 254 | accel.accel_config(); |
tdh50 | 5:09837d22b28f | 255 | oled.DrawImage(FallPageBMP,0,0); |
tdh50 | 5:09837d22b28f | 256 | // Fill 96px by 96px Screen with 96px by 96px Image starting at x=0,y=0 |
tdh50 | 5:09837d22b28f | 257 | while (screenNum == 5) |
tdh50 | 5:09837d22b28f | 258 | { |
tdh50 | 5:09837d22b28f | 259 | |
tdh50 | 5:09837d22b28f | 260 | accel.acquire_accel_data_g(accel_data); |
tdh50 | 5:09837d22b28f | 261 | accel_rms = sqrt(((accel_data[0]*accel_data[0])+(accel_data[1]*accel_data[1])+(accel_data[2]*accel_data[2]))/3); |
tdh50 | 5:09837d22b28f | 262 | printf("Accelerometer \tX-Axis %4.2f \tY-Axis %4.2f \tZ-Axis %4.2f \tRMS %4.2f\n\r",accel_data[0],accel_data[1],accel_data[2],accel_rms); |
tdh50 | 5:09837d22b28f | 263 | wait(0.01); |
tdh50 | 5:09837d22b28f | 264 | ax = accel_data[0]; |
tdh50 | 5:09837d22b28f | 265 | ay = accel_data[1]; |
tdh50 | 5:09837d22b28f | 266 | az = accel_data[2]; |
tdh50 | 5:09837d22b28f | 267 | /* Get OLED Class Default Text Properties */ |
tdh50 | 5:09837d22b28f | 268 | oled_text_properties_t textProperties = {0}; |
tdh50 | 5:09837d22b28f | 269 | oled.GetTextProperties(&textProperties); |
tdh50 | 5:09837d22b28f | 270 | |
tdh50 | 5:09837d22b28f | 271 | /* Set text properties to white and right aligned for the dynamic text */ |
tdh50 | 5:09837d22b28f | 272 | textProperties.fontColor = COLOR_BLUE; |
tdh50 | 5:09837d22b28f | 273 | textProperties.alignParam = OLED_TEXT_ALIGN_LEFT; |
tdh50 | 5:09837d22b28f | 274 | oled.SetTextProperties(&textProperties); |
tdh50 | 5:09837d22b28f | 275 | |
tdh50 | 5:09837d22b28f | 276 | /* Display Legends */ |
tdh50 | 5:09837d22b28f | 277 | strcpy((char *) text1,"X-Axis (g):"); |
tdh50 | 5:09837d22b28f | 278 | oled.Label((uint8_t *)text1,5,26); |
tdh50 | 5:09837d22b28f | 279 | |
tdh50 | 5:09837d22b28f | 280 | /* Format the value */ |
tdh50 | 5:09837d22b28f | 281 | sprintf(text1,"%4.2f",ax); |
tdh50 | 5:09837d22b28f | 282 | /* Display time reading in 35px by 15px textbox at(x=55, y=40) */ |
tdh50 | 5:09837d22b28f | 283 | oled.TextBox((uint8_t *)text1,70,26,20,15); //Increase textbox for more digits |
tdh50 | 5:09837d22b28f | 284 | |
tdh50 | 5:09837d22b28f | 285 | /* Set text properties to white and right aligned for the dynamic text */ |
tdh50 | 5:09837d22b28f | 286 | textProperties.fontColor = COLOR_GREEN; |
tdh50 | 5:09837d22b28f | 287 | textProperties.alignParam = OLED_TEXT_ALIGN_LEFT; |
tdh50 | 5:09837d22b28f | 288 | oled.SetTextProperties(&textProperties); |
tdh50 | 5:09837d22b28f | 289 | |
tdh50 | 5:09837d22b28f | 290 | /* Display Legends */ |
tdh50 | 5:09837d22b28f | 291 | strcpy((char *) text2,"Y-Axis (g):"); |
tdh50 | 5:09837d22b28f | 292 | oled.Label((uint8_t *)text2,5,43); |
tdh50 | 5:09837d22b28f | 293 | |
tdh50 | 5:09837d22b28f | 294 | /* Format the value */ |
tdh50 | 5:09837d22b28f | 295 | sprintf(text2,"%4.2f",ay); |
tdh50 | 5:09837d22b28f | 296 | /* Display time reading in 35px by 15px textbox at(x=55, y=40) */ |
tdh50 | 5:09837d22b28f | 297 | oled.TextBox((uint8_t *)text2,70,43,20,15); //Increase textbox for more digits |
tdh50 | 5:09837d22b28f | 298 | |
tdh50 | 5:09837d22b28f | 299 | /* Set text properties to white and right aligned for the dynamic text */ |
tdh50 | 5:09837d22b28f | 300 | textProperties.fontColor = COLOR_RED; |
tdh50 | 5:09837d22b28f | 301 | textProperties.alignParam = OLED_TEXT_ALIGN_LEFT; |
tdh50 | 5:09837d22b28f | 302 | oled.SetTextProperties(&textProperties); |
tdh50 | 5:09837d22b28f | 303 | |
tdh50 | 5:09837d22b28f | 304 | /* Display Legends */ |
tdh50 | 5:09837d22b28f | 305 | strcpy((char *) text3,"Z-Axis (g):"); |
tdh50 | 5:09837d22b28f | 306 | oled.Label((uint8_t *)text3,5,60); |
tdh50 | 5:09837d22b28f | 307 | |
tdh50 | 5:09837d22b28f | 308 | /* Format the value */ |
tdh50 | 5:09837d22b28f | 309 | sprintf(text3,"%4.2f",az); |
tdh50 | 5:09837d22b28f | 310 | /* Display time reading in 35px by 15px textbox at(x=55, y=40) */ |
tdh50 | 5:09837d22b28f | 311 | oled.TextBox((uint8_t *)text3,70,60,20,15); //Increase textbox for more digits |
tdh50 | 5:09837d22b28f | 312 | |
tdh50 | 5:09837d22b28f | 313 | redLed = !redLed ; |
tdh50 | 5:09837d22b28f | 314 | Thread::wait(1000); |
tdh50 | 5:09837d22b28f | 315 | } |
tdh50 | 5:09837d22b28f | 316 | } |
tdh50 | 5:09837d22b28f | 317 |