Vaibhav Murali / Mbed OS Hexi_BLE_Example_Modified_Ped

Pedometer to BT

Dependencies:   FXOS8700 Hexi_KW40Z Hexi_OLED_SSD1351

Fork of Hexi_BLE_Example_Modified by Xi Han

main.cpp@5:de39081e1aaf, 2018-06-05 (annotated)

Committer:
catchvibes95
Date:
Tue Jun 05 01:58:28 2018 +0000
Revision:
5:de39081e1aaf
Parent:
4:20d4eebfa986 
Ped_Blue;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
khuang 0:c80666325948 1 #include "mbed.h"
khuang 0:c80666325948 2 #include "Hexi_KW40Z.h"
khuang 0:c80666325948 3 #include "Hexi_OLED_SSD1351.h"
khuang 0:c80666325948 4 #include "OLED_types.h"
khuang 0:c80666325948 5 #include "OpenSans_Font.h"
khuang 0:c80666325948 6 #include "string.h"
catchvibes95 5:de39081e1aaf 7 #include "FXOS8700.h"
khuang 0:c80666325948 8
khuang 0:c80666325948 9 #define LED_ON 0
khuang 0:c80666325948 10 #define LED_OFF 1
cotigac 3:c2ab3a0de448 11
cotigac 3:c2ab3a0de448 12 void UpdateSensorData(void);
khuang 0:c80666325948 13 void StartHaptic(void);
khuang 0:c80666325948 14 void StopHaptic(void const *n);
khuang 1:a0d9eeedb771 15 void txTask(void);
khuang 0:c80666325948 16
catchvibes95 5:de39081e1aaf 17 DigitalOut led1(LED_GREEN); // RGB LED
catchvibes95 5:de39081e1aaf 18 Serial pc(USBTX, USBRX); // Serial interface
catchvibes95 5:de39081e1aaf 19 FXOS8700 accel(PTC11, PTC10);
xihan94 4:20d4eebfa986 20
khuang 0:c80666325948 21 DigitalOut redLed(LED1,1);
khuang 0:c80666325948 22 DigitalOut greenLed(LED2,1);
khuang 0:c80666325948 23 DigitalOut blueLed(LED3,1);
khuang 0:c80666325948 24 DigitalOut haptic(PTB9);
khuang 0:c80666325948 25
khuang 0:c80666325948 26 /* Define timer for haptic feedback */
khuang 0:c80666325948 27 RtosTimer hapticTimer(StopHaptic, osTimerOnce);
khuang 0:c80666325948 28
khuang 0:c80666325948 29 /* Instantiate the Hexi KW40Z Driver (UART TX, UART RX) */
khuang 0:c80666325948 30 KW40Z kw40z_device(PTE24, PTE25);
khuang 0:c80666325948 31
khuang 0:c80666325948 32 /* Instantiate the SSD1351 OLED Driver */
khuang 0:c80666325948 33 SSD1351 oled(PTB22,PTB21,PTC13,PTB20,PTE6, PTD15); /* (MOSI,SCLK,POWER,CS,RST,DC) */
khuang 0:c80666325948 34
khuang 1:a0d9eeedb771 35 /*Create a Thread to handle sending BLE Sensor Data */
khuang 1:a0d9eeedb771 36 Thread txThread;
khuang 0:c80666325948 37
catchvibes95 5:de39081e1aaf 38 Ticker flipper;
catchvibes95 5:de39081e1aaf 39
catchvibes95 5:de39081e1aaf 40
khuang 1:a0d9eeedb771 41 /* Text Buffer */
khuang 1:a0d9eeedb771 42 char text[20];
khuang 1:a0d9eeedb771 43
cotigac 3:c2ab3a0de448 44 uint8_t battery = 100;
cotigac 3:c2ab3a0de448 45 uint8_t light = 0;
cotigac 3:c2ab3a0de448 46 uint16_t humidity = 4500;
cotigac 3:c2ab3a0de448 47 uint16_t temperature = 2000;
cotigac 3:c2ab3a0de448 48 uint16_t pressure = 9000;
cotigac 3:c2ab3a0de448 49 uint16_t x = 0;
cotigac 3:c2ab3a0de448 50 uint16_t y = 5000;
cotigac 3:c2ab3a0de448 51 uint16_t z = 10000;
cotigac 3:c2ab3a0de448 52
catchvibes95 5:de39081e1aaf 53 // Variables
catchvibes95 5:de39081e1aaf 54 float accel_data[3]; // Storage for the data from the sensor
catchvibes95 5:de39081e1aaf 55 float accel_rms=0.0; // RMS value from the sensor
catchvibes95 5:de39081e1aaf 56 float ax, ay, az; // Integer value from the sensor to be displayed
catchvibes95 5:de39081e1aaf 57 const uint8_t *image1; // Pointer for the image1 to be displayed
catchvibes95 5:de39081e1aaf 58 char text1[20]; // Text Buffer for dynamic value displayed
catchvibes95 5:de39081e1aaf 59 char text2[20]; // Text Buffer for dynamic value displayed
catchvibes95 5:de39081e1aaf 60 char text3[20]; // Text Buffer for dynamic value displayed
catchvibes95 5:de39081e1aaf 61 float dot;
catchvibes95 5:de39081e1aaf 62 float old_acc=0;
catchvibes95 5:de39081e1aaf 63 float new_acc=0;
catchvibes95 5:de39081e1aaf 64 float old_accx, old_accy, old_accz, old_dot=0.0;
catchvibes95 5:de39081e1aaf 65 uint8_t StepNum = 0, StepNumber = 0;
catchvibes95 5:de39081e1aaf 66
catchvibes95 5:de39081e1aaf 67 float filter_buf[75];
catchvibes95 5:de39081e1aaf 68
catchvibes95 5:de39081e1aaf 69
catchvibes95 5:de39081e1aaf 70
catchvibes95 5:de39081e1aaf 71
catchvibes95 5:de39081e1aaf 72
khuang 1:a0d9eeedb771 73 /****************************Call Back Functions*******************************/
catchvibes95 5:de39081e1aaf 74
catchvibes95 5:de39081e1aaf 75 float Filter(int s)
catchvibes95 5:de39081e1aaf 76 {
catchvibes95 5:de39081e1aaf 77 accel.acquire_accel_data_g(accel_data);
catchvibes95 5:de39081e1aaf 78 float filter_sum = 0.0;
catchvibes95 5:de39081e1aaf 79 //printf("%d\n\r",s);
catchvibes95 5:de39081e1aaf 80 for(int i = 0; i < 75; i++)
catchvibes95 5:de39081e1aaf 81 {
catchvibes95 5:de39081e1aaf 82 filter_buf[i] = accel_data[s];
catchvibes95 5:de39081e1aaf 83 //printf("%4.2f\n\r",filter_buf[i]);
catchvibes95 5:de39081e1aaf 84 filter_sum += filter_buf[i];
catchvibes95 5:de39081e1aaf 85 }
catchvibes95 5:de39081e1aaf 86 return (float)(filter_sum / 75);
catchvibes95 5:de39081e1aaf 87 }
catchvibes95 5:de39081e1aaf 88
catchvibes95 5:de39081e1aaf 89
khuang 0:c80666325948 90 void ButtonRight(void)
khuang 0:c80666325948 91 {
khuang 0:c80666325948 92 StartHaptic();
khuang 0:c80666325948 93 kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 94 }
khuang 0:c80666325948 95
khuang 0:c80666325948 96 void ButtonLeft(void)
khuang 0:c80666325948 97 {
khuang 0:c80666325948 98 StartHaptic();
khuang 0:c80666325948 99 kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 100 }
khuang 0:c80666325948 101
catchvibes95 5:de39081e1aaf 102 void ButtonUp(void)
catchvibes95 5:de39081e1aaf 103 {
catchvibes95 5:de39081e1aaf 104 StartHaptic();
catchvibes95 5:de39081e1aaf 105 oled.FillScreen(COLOR_BLACK);
catchvibes95 5:de39081e1aaf 106
catchvibes95 5:de39081e1aaf 107 /* Get OLED Class Default Text Properties */
catchvibes95 5:de39081e1aaf 108 oled_text_properties_t textProperties = {0};
catchvibes95 5:de39081e1aaf 109 oled.GetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 110
catchvibes95 5:de39081e1aaf 111 /* Change font color to Blue */
catchvibes95 5:de39081e1aaf 112 textProperties.fontColor = COLOR_BLUE;
catchvibes95 5:de39081e1aaf 113 oled.SetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 114 strcpy((char *) text1,"Steps: ");
catchvibes95 5:de39081e1aaf 115 oled.Label((uint8_t *)text1,3,45);
catchvibes95 5:de39081e1aaf 116 sprintf(text1,"%d",StepNumber);
catchvibes95 5:de39081e1aaf 117 /* Display time reading in 35px by 15px textbox at(x=55, y=40) */
catchvibes95 5:de39081e1aaf 118 oled.TextBox((uint8_t *)text1,70,45,20,15); //Increase textbox for more digits
catchvibes95 5:de39081e1aaf 119
catchvibes95 5:de39081e1aaf 120
catchvibes95 5:de39081e1aaf 121 }
catchvibes95 5:de39081e1aaf 122 void ButtonDown(void)
catchvibes95 5:de39081e1aaf 123 {
catchvibes95 5:de39081e1aaf 124 oled.FillScreen(COLOR_BLACK);
catchvibes95 5:de39081e1aaf 125
catchvibes95 5:de39081e1aaf 126 /* Get OLED Class Default Text Properties */
catchvibes95 5:de39081e1aaf 127 oled_text_properties_t textProperties = {0};
catchvibes95 5:de39081e1aaf 128 oled.GetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 129
catchvibes95 5:de39081e1aaf 130 /* Change font color to Blue */
catchvibes95 5:de39081e1aaf 131 textProperties.fontColor = COLOR_BLUE;
catchvibes95 5:de39081e1aaf 132 oled.SetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 133
catchvibes95 5:de39081e1aaf 134 /* Display Bluetooth Label at x=17,y=65 */
catchvibes95 5:de39081e1aaf 135 strcpy((char *) text,"BLUETOOTH");
catchvibes95 5:de39081e1aaf 136 oled.Label((uint8_t *)text,17,65);
catchvibes95 5:de39081e1aaf 137
catchvibes95 5:de39081e1aaf 138 /* Change font color to white */
catchvibes95 5:de39081e1aaf 139 textProperties.fontColor = COLOR_WHITE;
catchvibes95 5:de39081e1aaf 140 textProperties.alignParam = OLED_TEXT_ALIGN_CENTER;
catchvibes95 5:de39081e1aaf 141 oled.SetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 142
catchvibes95 5:de39081e1aaf 143 /* Display Label at x=22,y=80 */
catchvibes95 5:de39081e1aaf 144 strcpy((char *) text,"Tap Below");
catchvibes95 5:de39081e1aaf 145 oled.Label((uint8_t *)text,22,80);
catchvibes95 5:de39081e1aaf 146
catchvibes95 5:de39081e1aaf 147
catchvibes95 5:de39081e1aaf 148 }
khuang 0:c80666325948 149 void PassKey(void)
khuang 0:c80666325948 150 {
khuang 0:c80666325948 151 StartHaptic();
khuang 0:c80666325948 152 strcpy((char *) text,"PAIR CODE");
khuang 1:a0d9eeedb771 153 oled.TextBox((uint8_t *)text,0,25,95,18);
khuang 0:c80666325948 154
khuang 0:c80666325948 155 /* Display Bond Pass Key in a 95px by 18px textbox at x=0,y=40 */
khuang 0:c80666325948 156 sprintf(text,"%d", kw40z_device.GetPassKey());
khuang 0:c80666325948 157 oled.TextBox((uint8_t *)text,0,40,95,18);
khuang 0:c80666325948 158 }
khuang 1:a0d9eeedb771 159
xihan94 4:20d4eebfa986 160 // Key modification: use the alert functionality enabled by the host-ble interface
xihan94 4:20d4eebfa986 161 // to define our own command.
xihan94 4:20d4eebfa986 162 void AlertReceived(uint8_t *data, uint8_t length)
xihan94 4:20d4eebfa986 163 {
xihan94 4:20d4eebfa986 164 StartHaptic();
xihan94 4:20d4eebfa986 165 data[19] = 0;
xihan94 4:20d4eebfa986 166 pc.printf("%s\n\r", data);
xihan94 4:20d4eebfa986 167
xihan94 4:20d4eebfa986 168 // data (our command) must 20 bytes long.
xihan94 4:20d4eebfa986 169 // CMD for turning on: 'ledonledonledonledon'
xihan94 4:20d4eebfa986 170 if (data[4] == 'n') {
xihan94 4:20d4eebfa986 171 greenLed = LED_ON;
xihan94 4:20d4eebfa986 172 redLed = LED_ON;
xihan94 4:20d4eebfa986 173 blueLed = LED_ON;
xihan94 4:20d4eebfa986 174 pc.printf("on\n\r", data);
xihan94 4:20d4eebfa986 175
xihan94 4:20d4eebfa986 176 // CMD for turning off: 'ledoffledoffledoffled'
xihan94 4:20d4eebfa986 177 } else if (data[4] == 'f') {
xihan94 4:20d4eebfa986 178 greenLed = LED_OFF;
xihan94 4:20d4eebfa986 179 redLed = LED_OFF;
xihan94 4:20d4eebfa986 180 blueLed = LED_OFF;
xihan94 4:20d4eebfa986 181 pc.printf("off\n\r", data);
xihan94 4:20d4eebfa986 182 }
xihan94 4:20d4eebfa986 183 }
khuang 1:a0d9eeedb771 184 /***********************End of Call Back Functions*****************************/
khuang 1:a0d9eeedb771 185
khuang 1:a0d9eeedb771 186 /********************************Main******************************************/
khuang 1:a0d9eeedb771 187
khuang 0:c80666325948 188 int main()
khuang 0:c80666325948 189 {
catchvibes95 5:de39081e1aaf 190
catchvibes95 5:de39081e1aaf 191 accel.accel_config();
cotigac 3:c2ab3a0de448 192 /* Register callbacks to application functions */
cotigac 3:c2ab3a0de448 193 kw40z_device.attach_buttonLeft(&ButtonLeft);
cotigac 3:c2ab3a0de448 194 kw40z_device.attach_buttonRight(&ButtonRight);
catchvibes95 5:de39081e1aaf 195 kw40z_device.attach_buttonDown(&ButtonDown);
catchvibes95 5:de39081e1aaf 196 kw40z_device.attach_buttonUp(&ButtonUp);
cotigac 3:c2ab3a0de448 197 kw40z_device.attach_passkey(&PassKey);
xihan94 4:20d4eebfa986 198 kw40z_device.attach_alert(&AlertReceived);
khuang 0:c80666325948 199
xihan94 4:20d4eebfa986 200 pc.printf("hello\n\r");
xihan94 4:20d4eebfa986 201
khuang 0:c80666325948 202 /* Turn on the backlight of the OLED Display */
khuang 0:c80666325948 203 oled.DimScreenON();
khuang 0:c80666325948 204
khuang 0:c80666325948 205 /* Fills the screen with solid black */
khuang 0:c80666325948 206
khuang 0:c80666325948 207
khuang 1:a0d9eeedb771 208 uint8_t prevLinkState = 0;
cotigac 3:c2ab3a0de448 209 uint8_t currLinkState = 0;
cotigac 3:c2ab3a0de448 210
khuang 1:a0d9eeedb771 211 txThread.start(txTask); /*Start transmitting Sensor Tag Data */
khuang 0:c80666325948 212
khuang 1:a0d9eeedb771 213 while (true)
khuang 1:a0d9eeedb771 214 {
xihan94 4:20d4eebfa986 215 // blueLed = !kw40z_device.GetAdvertisementMode(); /*Indicate BLE Advertisment Mode*/
khuang 1:a0d9eeedb771 216 Thread::wait(50);
khuang 1:a0d9eeedb771 217 }
khuang 1:a0d9eeedb771 218 }
khuang 1:a0d9eeedb771 219
khuang 1:a0d9eeedb771 220 /******************************End of Main*************************************/
khuang 1:a0d9eeedb771 221
khuang 1:a0d9eeedb771 222
khuang 1:a0d9eeedb771 223 /* txTask() transmits the sensor data */
khuang 1:a0d9eeedb771 224 void txTask(void){
khuang 1:a0d9eeedb771 225
khuang 1:a0d9eeedb771 226 while (true)
khuang 1:a0d9eeedb771 227 {
cotigac 3:c2ab3a0de448 228 UpdateSensorData();
khuang 0:c80666325948 229
khuang 1:a0d9eeedb771 230 /*Notify Hexiwear App that it is running Sensor Tag mode*/
khuang 0:c80666325948 231 kw40z_device.SendSetApplicationMode(GUI_CURRENT_APP_SENSOR_TAG);
khuang 0:c80666325948 232
khuang 1:a0d9eeedb771 233 /*The following is sending dummy data over BLE. Replace with real data*/
khuang 1:a0d9eeedb771 234
khuang 0:c80666325948 235 /*Send Battery Level for 20% */
catchvibes95 5:de39081e1aaf 236 kw40z_device.SendBatteryLevel(StepNumber);
khuang 0:c80666325948 237
khuang 0:c80666325948 238 /*Send Ambient Light Level at 50% */
catchvibes95 5:de39081e1aaf 239 //kw40z_device.SendAmbientLight(light);
khuang 0:c80666325948 240
khuang 0:c80666325948 241 /*Send Humidity at 90% */
catchvibes95 5:de39081e1aaf 242 //kw40z_device.SendHumidity(humidity);
khuang 0:c80666325948 243
khuang 0:c80666325948 244 /*Send Temperature at 25 degrees Celsius */
catchvibes95 5:de39081e1aaf 245 //kw40z_device.SendTemperature(temperature);
khuang 0:c80666325948 246
khuang 0:c80666325948 247 /*Send Pressure at 100kPA */
catchvibes95 5:de39081e1aaf 248 //kw40z_device.SendPressure(pressure);
khuang 0:c80666325948 249
khuang 1:a0d9eeedb771 250 /*Send Mag,Accel,Gyro Data. */
catchvibes95 5:de39081e1aaf 251 // kw40z_device.SendGyro(x,y,z);
catchvibes95 5:de39081e1aaf 252 // kw40z_device.SendAccel(z,x,y);
catchvibes95 5:de39081e1aaf 253 // kw40z_device.SendMag(y,z,x);
cotigac 3:c2ab3a0de448 254
catchvibes95 5:de39081e1aaf 255 Thread::wait(10);
khuang 0:c80666325948 256 }
khuang 0:c80666325948 257 }
khuang 0:c80666325948 258
cotigac 3:c2ab3a0de448 259 void UpdateSensorData(void)
cotigac 3:c2ab3a0de448 260 {
catchvibes95 5:de39081e1aaf 261 accel.acquire_accel_data_g(accel_data);
catchvibes95 5:de39081e1aaf 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);
catchvibes95 5:de39081e1aaf 263 ax = Filter(0);
catchvibes95 5:de39081e1aaf 264 ay = Filter(1);
catchvibes95 5:de39081e1aaf 265 az = Filter(2);
catchvibes95 5:de39081e1aaf 266 wait(0.02);
catchvibes95 5:de39081e1aaf 267 accel_rms = sqrt((ax*ax)+(ay*ay)+(az*az)/3);
catchvibes95 5:de39081e1aaf 268 //printf("Accelerometer \tX-Axis %4.2f \tY-Axis %4.2f \tZ-Axis %4.2f \tRMS %4.2f\n\r",ax,ay,az,accel_rms);
catchvibes95 5:de39081e1aaf 269 dot = (old_accx * ax)+(old_accy * ay)+(old_accz * az);
catchvibes95 5:de39081e1aaf 270 old_acc = abs(sqrt(old_accx*old_accx+old_accy*old_accy+old_accz*old_accz));
catchvibes95 5:de39081e1aaf 271 new_acc = abs(sqrt(ax*ax+ay*ay+az*az));
catchvibes95 5:de39081e1aaf 272 //printf("\nOld Acceleration: %4.2f\n\r",old_acc);
catchvibes95 5:de39081e1aaf 273 //printf("New Acceleration: %4.2f\n\r",new_acc);
catchvibes95 5:de39081e1aaf 274 dot /= (old_acc * new_acc);
catchvibes95 5:de39081e1aaf 275 //printf("\nDot: %4.2f\n\r",dot);
catchvibes95 5:de39081e1aaf 276 //printf("Old Dot: %4.2f\n\r",old_dot);
catchvibes95 5:de39081e1aaf 277
catchvibes95 5:de39081e1aaf 278 oled_text_properties_t textProperties = {0};
catchvibes95 5:de39081e1aaf 279 oled.GetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 280
catchvibes95 5:de39081e1aaf 281 /* Set text properties to white and right aligned for the dynamic text */
catchvibes95 5:de39081e1aaf 282 textProperties.fontColor = COLOR_BLUE;
catchvibes95 5:de39081e1aaf 283 textProperties.alignParam = OLED_TEXT_ALIGN_LEFT;
catchvibes95 5:de39081e1aaf 284 oled.SetTextProperties(&textProperties);
catchvibes95 5:de39081e1aaf 285
catchvibes95 5:de39081e1aaf 286 /* Display Legends */
catchvibes95 5:de39081e1aaf 287 //strcpy((char *) text1,"Steps: ");
catchvibes95 5:de39081e1aaf 288 //oled.Label((uint8_t *)text1,3,45);
catchvibes95 5:de39081e1aaf 289 StepNum = StepNumber;
catchvibes95 5:de39081e1aaf 290 if(abs(dot - old_dot) >= 0.05 && abs(dot - old_dot) <= 0.10)
catchvibes95 5:de39081e1aaf 291 {
catchvibes95 5:de39081e1aaf 292 StepNumber += 1;
catchvibes95 5:de39081e1aaf 293
catchvibes95 5:de39081e1aaf 294 }
catchvibes95 5:de39081e1aaf 295 //printf("%4.2f\n\r",dot);
catchvibes95 5:de39081e1aaf 296 old_accx = ax;
catchvibes95 5:de39081e1aaf 297 old_accy = ay;
catchvibes95 5:de39081e1aaf 298 old_accz = az;
catchvibes95 5:de39081e1aaf 299 old_dot = dot;
catchvibes95 5:de39081e1aaf 300
catchvibes95 5:de39081e1aaf 301 Thread::wait(250);
cotigac 3:c2ab3a0de448 302 }
cotigac 3:c2ab3a0de448 303
khuang 1:a0d9eeedb771 304 void StartHaptic(void) {
khuang 0:c80666325948 305 hapticTimer.start(50);
khuang 0:c80666325948 306 haptic = 1;
khuang 0:c80666325948 307 }
khuang 0:c80666325948 308
khuang 0:c80666325948 309 void StopHaptic(void const *n) {
khuang 0:c80666325948 310 haptic = 0;
khuang 0:c80666325948 311 hapticTimer.stop();
khuang 0:c80666325948 312 }
khuang 1:a0d9eeedb771 313