![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
dsdaf
Dependencies: FXOS8700 Hexi_KW40Z Hexi_OLED_SSD1351 MAX30101
Fork of HeartRate by
Revision 4:eb89733b8642, committed 2018-06-11
- Comitter:
- catchvibes95
- Date:
- Mon Jun 11 23:10:17 2018 +0000
- Parent:
- 3:2e12e0cd1f26
- Commit message:
- jk;
Changed in this revision
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/FXOS8700.lib Mon Jun 11 23:10:17 2018 +0000 @@ -0,0 +1,1 @@ +http://mbed.org/users/AswinSivakumar/code/FXOS8700/#98ea52282575
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Hexi_KW40Z.lib Mon Jun 11 23:10:17 2018 +0000 @@ -0,0 +1,1 @@ +https://developer.mbed.org/teams/Hexiwear/code/Hexi_KW40Z/#3f5ed7abc5c7
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Hexi_OLED_SSD1351.lib Mon Jun 11 23:10:17 2018 +0000 @@ -0,0 +1,1 @@ +https://developer.mbed.org/teams/Hexiwear/code/Hexi_OLED_SSD1351/#ae5fad429790
--- a/main.cpp Fri Jun 01 23:23:08 2018 +0000 +++ b/main.cpp Mon Jun 11 23:10:17 2018 +0000 @@ -1,9 +1,29 @@ #include "mbed.h" #include "mbed_events.h" #include "MAX30101.h" +#include "Hexi_KW40Z.h" +#include "Hexi_OLED_SSD1351.h" +#include "OLED_types.h" +#include "OpenSans_Font.h" +#include "string.h" +#include "FXOS8700.h" + #define FIFO_DATA_MAX 288 + + +#define LED_ON 0 +#define LED_OFF 1 + +void UpdateSensorData(void); +void StartHaptic(void); +void StopHaptic(void const *n); +void txTask(void); + +DigitalOut led1(LED_GREEN); // RGB LED +FXOS8700 accel(PTC11, PTC10); + DigitalOut pwr1v8(PTA29); DigitalOut pwr3v3b(PTC13); DigitalOut pwr15v(PTB12); @@ -11,6 +31,23 @@ InterruptIn maximInterrupt(PTB18); Serial pc(USBTX, USBRX); +DigitalOut redLed(LED1,1); +DigitalOut greenLed(LED2,1); +DigitalOut blueLed(LED3,1); +DigitalOut haptic(PTB9); + + +RtosTimer hapticTimer(StopHaptic, osTimerOnce); + +/* Instantiate the Hexi KW40Z Driver (UART TX, UART RX) */ +KW40Z kw40z_device(PTE24, PTE25); + +/* Instantiate the SSD1351 OLED Driver */ +SSD1351 oled(PTB22,PTB21,PTC13,PTB20,PTE6, PTD15); /* (MOSI,SCLK,POWER,CS,RST,DC) */ + +/*Create a Thread to handle sending BLE Sensor Data */ +Thread txThread; + EventQueue evqueue(32 * EVENTS_EVENT_SIZE); Thread t; @@ -18,6 +55,147 @@ int mask_ppg = 0; uint32_t count = 0; + + + +char text[20]; + +uint8_t battery = 100; +uint8_t light = 0; +uint16_t humidity = 4500; +uint16_t temperature = 2000; +uint16_t pressure = 9000; +uint16_t x = 0; +uint16_t y = 5000; +uint16_t z = 10000; + +// Variables +float accel_data[3]; // Storage for the data from the sensor +float accel_rms=0.0; // RMS value from the sensor +float ax, ay, az; // Integer value from the sensor to be displayed +const uint8_t *image1; // Pointer for the image1 to be displayed +char text1[20]; // Text Buffer for dynamic value displayed +char text2[20]; // Text Buffer for dynamic value displayed +char text3[20]; // Text Buffer for dynamic value displayed +float dot; +float old_acc=0; +float new_acc=0; +float old_accx, old_accy, old_accz, old_dot=0.0; +uint8_t StepNum = 0, StepNumber = 0; + +float filter_buf[75]; + +/****************************Call Back Functions*******************************/ + +float Filter(int s) +{ + accel.acquire_accel_data_g(accel_data); + float filter_sum = 0.0; + //printf("%d\n\r",s); + for(int i = 0; i < 75; i++) + { + filter_buf[i] = accel_data[s]; + //printf("%4.2f\n\r",filter_buf[i]); + filter_sum += filter_buf[i]; + } + return (float)(filter_sum / 75); +} + + +void ButtonRight(void) +{ + StartHaptic(); + kw40z_device.ToggleAdvertisementMode(); +} + +void ButtonLeft(void) +{ + StartHaptic(); + kw40z_device.ToggleAdvertisementMode(); +} + +void ButtonUp(void) +{ + StartHaptic(); + oled.FillScreen(COLOR_BLACK); + + /* Get OLED Class Default Text Properties */ + oled_text_properties_t textProperties = {0}; + oled.GetTextProperties(&textProperties); + + /* Change font color to Blue */ + textProperties.fontColor = COLOR_BLUE; + oled.SetTextProperties(&textProperties); + strcpy((char *) text1,"Steps: "); + oled.Label((uint8_t *)text1,3,45); + sprintf(text1,"%d",StepNumber); + /* Display time reading in 35px by 15px textbox at(x=55, y=40) */ + oled.TextBox((uint8_t *)text1,70,45,20,15); //Increase textbox for more digits + + +} +void ButtonDown(void) +{ + oled.FillScreen(COLOR_BLACK); + + /* Get OLED Class Default Text Properties */ + oled_text_properties_t textProperties = {0}; + oled.GetTextProperties(&textProperties); + + /* Change font color to Blue */ + textProperties.fontColor = COLOR_BLUE; + oled.SetTextProperties(&textProperties); + + /* Display Bluetooth Label at x=17,y=65 */ + strcpy((char *) text,"BLUETOOTH"); + oled.Label((uint8_t *)text,17,65); + + /* Change font color to white */ + textProperties.fontColor = COLOR_WHITE; + textProperties.alignParam = OLED_TEXT_ALIGN_CENTER; + oled.SetTextProperties(&textProperties); + + /* Display Label at x=22,y=80 */ + strcpy((char *) text,"Tap Below"); + oled.Label((uint8_t *)text,22,80); + + +} +void PassKey(void) +{ + StartHaptic(); + strcpy((char *) text,"PAIR CODE"); + oled.TextBox((uint8_t *)text,0,25,95,18); + + /* Display Bond Pass Key in a 95px by 18px textbox at x=0,y=40 */ + sprintf(text,"%d", kw40z_device.GetPassKey()); + oled.TextBox((uint8_t *)text,0,40,95,18); +} + +// Key modification: use the alert functionality enabled by the host-ble interface +// to define our own command. +void AlertReceived(uint8_t *data, uint8_t length) +{ + StartHaptic(); + data[19] = 0; + pc.printf("%s\n\r", data); + + // data (our command) must 20 bytes long. + // CMD for turning on: 'ledonledonledonledon' + if (data[4] == 'n') { + greenLed = LED_ON; + redLed = LED_ON; + blueLed = LED_ON; + pc.printf("on\n\r", data); + + // CMD for turning off: 'ledoffledoffledoffled' + } else if (data[4] == 'f') { + greenLed = LED_OFF; + redLed = LED_OFF; + blueLed = LED_OFF; + pc.printf("off\n\r", data); + } +} void interruptHandlerQueued() { MAX30101::InterruptBitField_u interruptStatus; @@ -83,7 +261,7 @@ sample[1] = data[i + 1]; sample[2] = data[i]; - printf("%u\r\n", *(uint32_t *) sample); + printf("%u\r\n", *(uint32_t *) sample); } } @@ -103,7 +281,27 @@ // printf("Hello world.\r\n"); t.start(callback(&evqueue, &EventQueue::dispatch_forever)); - + accel.accel_config(); + /* Register callbacks to application functions */ + kw40z_device.attach_buttonLeft(&ButtonLeft); + kw40z_device.attach_buttonRight(&ButtonRight); + kw40z_device.attach_buttonDown(&ButtonDown); + kw40z_device.attach_buttonUp(&ButtonUp); + kw40z_device.attach_passkey(&PassKey); + kw40z_device.attach_alert(&AlertReceived); + + pc.printf("hello\n\r"); + + /* Turn on the backlight of the OLED Display */ + oled.DimScreenON(); + + /* Fills the screen with solid black */ + + + uint8_t prevLinkState = 0; + uint8_t currLinkState = 0; + + pwr1v8 = 1; pwr3v3b = 1; pwr15v = 0; @@ -115,6 +313,105 @@ interruptStatus.all = 0xFF; hr.enableInterrupts(interruptStatus); + + txThread.start(txTask); /*Start transmitting Sensor Tag Data */ + + while (true) + { + // blueLed = !kw40z_device.GetAdvertisementMode(); /*Indicate BLE Advertisment Mode*/ + Thread::wait(50); + } + return 0; } +void txTask(void){ + + while (true) + { + UpdateSensorData(); + + /*Notify Hexiwear App that it is running Sensor Tag mode*/ + kw40z_device.SendSetApplicationMode(GUI_CURRENT_APP_SENSOR_TAG); + + /*The following is sending dummy data over BLE. Replace with real data*/ + + /*Send Battery Level for 20% */ + kw40z_device.SendBatteryLevel(StepNumber); + + /*Send Ambient Light Level at 50% */ + //kw40z_device.SendAmbientLight(light); + + /*Send Humidity at 90% */ + //kw40z_device.SendHumidity(humidity); + + /*Send Temperature at 25 degrees Celsius */ + //kw40z_device.SendTemperature(temperature); + /*Send Pressure at 100kPA */ + //kw40z_device.SendPressure(pressure); + + /*Send Mag,Accel,Gyro Data. */ + // kw40z_device.SendGyro(x,y,z); + // kw40z_device.SendAccel(z,x,y); + // kw40z_device.SendMag(y,z,x); + + Thread::wait(10); + } +} + +void UpdateSensorData(void) +{ + accel.acquire_accel_data_g(accel_data); + //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); + ax = Filter(0); + ay = Filter(1); + az = Filter(2); + wait(0.02); + accel_rms = sqrt((ax*ax)+(ay*ay)+(az*az)/3); + //printf("Accelerometer \tX-Axis %4.2f \tY-Axis %4.2f \tZ-Axis %4.2f \tRMS %4.2f\n\r",ax,ay,az,accel_rms); + dot = (old_accx * ax)+(old_accy * ay)+(old_accz * az); + old_acc = abs(sqrt(old_accx*old_accx+old_accy*old_accy+old_accz*old_accz)); + new_acc = abs(sqrt(ax*ax+ay*ay+az*az)); + //printf("\nOld Acceleration: %4.2f\n\r",old_acc); + //printf("New Acceleration: %4.2f\n\r",new_acc); + dot /= (old_acc * new_acc); + //printf("\nDot: %4.2f\n\r",dot); + //printf("Old Dot: %4.2f\n\r",old_dot); + + oled_text_properties_t textProperties = {0}; + oled.GetTextProperties(&textProperties); + + /* Set text properties to white and right aligned for the dynamic text */ + textProperties.fontColor = COLOR_BLUE; + textProperties.alignParam = OLED_TEXT_ALIGN_LEFT; + oled.SetTextProperties(&textProperties); + + /* Display Legends */ + //strcpy((char *) text1,"Steps: "); + //oled.Label((uint8_t *)text1,3,45); + StepNum = StepNumber; + if(abs(dot - old_dot) >= 0.05 && abs(dot - old_dot) <= 0.10) + { + StepNumber += 1; + + } + //printf("%4.2f\n\r",dot); + old_accx = ax; + old_accy = ay; + old_accz = az; + old_dot = dot; + + Thread::wait(250); +} + + +void StartHaptic(void) { + hapticTimer.start(50); + haptic = 1; +} + +void StopHaptic(void const *n) { + haptic = 0; + hapticTimer.stop(); +} +