Destin Raymundo / Mbed OS Hexi_Final_Project

hexiwear code that transmits sensor data via bluetooth

Dependencies:   FXAS21002 FXOS8700 Hexi_KW40Z Hexi_OLED_SSD1351

Fork of Hexi_BLE_Example_Modified by Xi Han

main.cpp@6:8a9b0eb4835d, 2018-06-12 (annotated)

Committer:
adrayv
Date:
Tue Jun 12 03:39:57 2018 +0000
Revision:
6:8a9b0eb4835d
Parent:
5:b479668a7373 
cleaned up code

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"
adrayv 5:b479668a7373 7 #include "FXAS21002.h"
adrayv 5:b479668a7373 8 #include "FXOS8700.h"
adrayv 5:b479668a7373 9 #include <cmath>
khuang 0:c80666325948 10
khuang 0:c80666325948 11 #define LED_ON 0
khuang 0:c80666325948 12 #define LED_OFF 1
cotigac 3:c2ab3a0de448 13
cotigac 3:c2ab3a0de448 14 void UpdateSensorData(void);
adrayv 5:b479668a7373 15 void GetSensorData(void);
khuang 0:c80666325948 16 void StartHaptic(void);
khuang 0:c80666325948 17 void StopHaptic(void const *n);
khuang 1:a0d9eeedb771 18 void txTask(void);
adrayv 5:b479668a7373 19 FXOS8700 accel(PTC11, PTC10);
khuang 0:c80666325948 20
xihan94 4:20d4eebfa986 21 Serial pc(USBTX, USBRX);
xihan94 4:20d4eebfa986 22
khuang 0:c80666325948 23 DigitalOut redLed(LED1,1);
khuang 0:c80666325948 24 DigitalOut greenLed(LED2,1);
khuang 0:c80666325948 25 DigitalOut blueLed(LED3,1);
khuang 0:c80666325948 26 DigitalOut haptic(PTB9);
khuang 0:c80666325948 27
khuang 0:c80666325948 28 /* Define timer for haptic feedback */
khuang 0:c80666325948 29 RtosTimer hapticTimer(StopHaptic, osTimerOnce);
khuang 0:c80666325948 30
khuang 0:c80666325948 31 /* Instantiate the Hexi KW40Z Driver (UART TX, UART RX) */
khuang 0:c80666325948 32 KW40Z kw40z_device(PTE24, PTE25);
khuang 0:c80666325948 33
khuang 0:c80666325948 34 /* Instantiate the SSD1351 OLED Driver */
khuang 0:c80666325948 35 SSD1351 oled(PTB22,PTB21,PTC13,PTB20,PTE6, PTD15); /* (MOSI,SCLK,POWER,CS,RST,DC) */
khuang 0:c80666325948 36
khuang 1:a0d9eeedb771 37 /*Create a Thread to handle sending BLE Sensor Data */
khuang 1:a0d9eeedb771 38 Thread txThread;
khuang 0:c80666325948 39
khuang 1:a0d9eeedb771 40 /* Text Buffer */
khuang 1:a0d9eeedb771 41 char text[20];
khuang 1:a0d9eeedb771 42
cotigac 3:c2ab3a0de448 43 uint8_t battery = 100;
adrayv 5:b479668a7373 44 int16_t x = 0;
adrayv 5:b479668a7373 45 int16_t y = 0;
adrayv 5:b479668a7373 46 int16_t z = 0;
adrayv 5:b479668a7373 47
adrayv 5:b479668a7373 48 uint8_t abs_x = 0;
adrayv 5:b479668a7373 49 uint8_t abs_y = 0;
adrayv 5:b479668a7373 50 uint8_t abs_z = 0;
adrayv 5:b479668a7373 51 float accel_data[3];
cotigac 3:c2ab3a0de448 52
khuang 1:a0d9eeedb771 53 /****************************Call Back Functions*******************************/
khuang 0:c80666325948 54 void ButtonRight(void)
khuang 0:c80666325948 55 {
khuang 0:c80666325948 56 StartHaptic();
adrayv 6:8a9b0eb4835d 57 kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 58 }
khuang 0:c80666325948 59
khuang 0:c80666325948 60 void ButtonLeft(void)
khuang 0:c80666325948 61 {
khuang 0:c80666325948 62 StartHaptic();
adrayv 6:8a9b0eb4835d 63 kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 64 }
khuang 0:c80666325948 65
khuang 0:c80666325948 66 void PassKey(void)
khuang 0:c80666325948 67 {
khuang 0:c80666325948 68 StartHaptic();
khuang 0:c80666325948 69 strcpy((char *) text,"PAIR CODE");
khuang 1:a0d9eeedb771 70 oled.TextBox((uint8_t *)text,0,25,95,18);
khuang 0:c80666325948 71
khuang 0:c80666325948 72 /* Display Bond Pass Key in a 95px by 18px textbox at x=0,y=40 */
khuang 0:c80666325948 73 sprintf(text,"%d", kw40z_device.GetPassKey());
khuang 0:c80666325948 74 oled.TextBox((uint8_t *)text,0,40,95,18);
khuang 0:c80666325948 75 }
khuang 1:a0d9eeedb771 76
xihan94 4:20d4eebfa986 77 // Key modification: use the alert functionality enabled by the host-ble interface
xihan94 4:20d4eebfa986 78 // to define our own command.
xihan94 4:20d4eebfa986 79 void AlertReceived(uint8_t *data, uint8_t length)
xihan94 4:20d4eebfa986 80 {
xihan94 4:20d4eebfa986 81 StartHaptic();
xihan94 4:20d4eebfa986 82 data[19] = 0;
xihan94 4:20d4eebfa986 83 pc.printf("%s\n\r", data);
xihan94 4:20d4eebfa986 84
xihan94 4:20d4eebfa986 85 // data (our command) must 20 bytes long.
xihan94 4:20d4eebfa986 86 // CMD for turning on: 'ledonledonledonledon'
xihan94 4:20d4eebfa986 87 if (data[4] == 'n') {
xihan94 4:20d4eebfa986 88 greenLed = LED_ON;
xihan94 4:20d4eebfa986 89 redLed = LED_ON;
xihan94 4:20d4eebfa986 90 blueLed = LED_ON;
xihan94 4:20d4eebfa986 91 pc.printf("on\n\r", data);
xihan94 4:20d4eebfa986 92
xihan94 4:20d4eebfa986 93 // CMD for turning off: 'ledoffledoffledoffled'
xihan94 4:20d4eebfa986 94 } else if (data[4] == 'f') {
xihan94 4:20d4eebfa986 95 greenLed = LED_OFF;
xihan94 4:20d4eebfa986 96 redLed = LED_OFF;
xihan94 4:20d4eebfa986 97 blueLed = LED_OFF;
xihan94 4:20d4eebfa986 98 pc.printf("off\n\r", data);
xihan94 4:20d4eebfa986 99 }
xihan94 4:20d4eebfa986 100 }
khuang 1:a0d9eeedb771 101 /***********************End of Call Back Functions*****************************/
khuang 1:a0d9eeedb771 102
khuang 1:a0d9eeedb771 103 /********************************Main******************************************/
khuang 1:a0d9eeedb771 104
khuang 0:c80666325948 105 int main()
khuang 0:c80666325948 106 {
cotigac 3:c2ab3a0de448 107 /* Register callbacks to application functions */
cotigac 3:c2ab3a0de448 108 kw40z_device.attach_buttonLeft(&ButtonLeft);
cotigac 3:c2ab3a0de448 109 kw40z_device.attach_buttonRight(&ButtonRight);
cotigac 3:c2ab3a0de448 110 kw40z_device.attach_passkey(&PassKey);
xihan94 4:20d4eebfa986 111 kw40z_device.attach_alert(&AlertReceived);
adrayv 5:b479668a7373 112
adrayv 5:b479668a7373 113 accel.accel_config();
khuang 0:c80666325948 114
xihan94 4:20d4eebfa986 115 pc.printf("hello\n\r");
xihan94 4:20d4eebfa986 116
khuang 0:c80666325948 117 /* Turn on the backlight of the OLED Display */
khuang 0:c80666325948 118 oled.DimScreenON();
khuang 0:c80666325948 119
khuang 0:c80666325948 120 /* Fills the screen with solid black */
khuang 0:c80666325948 121 oled.FillScreen(COLOR_BLACK);
cotigac 3:c2ab3a0de448 122
cotigac 3:c2ab3a0de448 123 /* Get OLED Class Default Text Properties */
cotigac 3:c2ab3a0de448 124 oled_text_properties_t textProperties = {0};
cotigac 3:c2ab3a0de448 125 oled.GetTextProperties(&textProperties);
khuang 0:c80666325948 126
khuang 0:c80666325948 127 /* Change font color to Blue */
khuang 0:c80666325948 128 textProperties.fontColor = COLOR_BLUE;
khuang 0:c80666325948 129 oled.SetTextProperties(&textProperties);
khuang 0:c80666325948 130
khuang 0:c80666325948 131 /* Display Bluetooth Label at x=17,y=65 */
khuang 0:c80666325948 132 strcpy((char *) text,"BLUETOOTH");
khuang 0:c80666325948 133 oled.Label((uint8_t *)text,17,65);
khuang 0:c80666325948 134
khuang 0:c80666325948 135 /* Change font color to white */
khuang 0:c80666325948 136 textProperties.fontColor = COLOR_WHITE;
khuang 0:c80666325948 137 textProperties.alignParam = OLED_TEXT_ALIGN_CENTER;
khuang 0:c80666325948 138 oled.SetTextProperties(&textProperties);
khuang 0:c80666325948 139
khuang 1:a0d9eeedb771 140 /* Display Label at x=22,y=80 */
khuang 0:c80666325948 141 strcpy((char *) text,"Tap Below");
khuang 0:c80666325948 142 oled.Label((uint8_t *)text,22,80);
khuang 0:c80666325948 143
khuang 1:a0d9eeedb771 144 uint8_t prevLinkState = 0;
cotigac 3:c2ab3a0de448 145 uint8_t currLinkState = 0;
cotigac 3:c2ab3a0de448 146
khuang 1:a0d9eeedb771 147 txThread.start(txTask); /*Start transmitting Sensor Tag Data */
khuang 0:c80666325948 148
khuang 1:a0d9eeedb771 149 while (true)
khuang 1:a0d9eeedb771 150 {
xihan94 4:20d4eebfa986 151 // blueLed = !kw40z_device.GetAdvertisementMode(); /*Indicate BLE Advertisment Mode*/
khuang 1:a0d9eeedb771 152 Thread::wait(50);
khuang 1:a0d9eeedb771 153 }
khuang 1:a0d9eeedb771 154 }
khuang 1:a0d9eeedb771 155
khuang 1:a0d9eeedb771 156 /******************************End of Main*************************************/
khuang 1:a0d9eeedb771 157
khuang 1:a0d9eeedb771 158 /* txTask() transmits the sensor data */
khuang 1:a0d9eeedb771 159 void txTask(void){
khuang 1:a0d9eeedb771 160
khuang 1:a0d9eeedb771 161 while (true)
khuang 1:a0d9eeedb771 162 {
adrayv 5:b479668a7373 163 GetSensorData();
khuang 0:c80666325948 164
khuang 1:a0d9eeedb771 165 /*Notify Hexiwear App that it is running Sensor Tag mode*/
khuang 0:c80666325948 166 kw40z_device.SendSetApplicationMode(GUI_CURRENT_APP_SENSOR_TAG);
khuang 0:c80666325948 167
khuang 1:a0d9eeedb771 168 /*The following is sending dummy data over BLE. Replace with real data*/
khuang 1:a0d9eeedb771 169
khuang 0:c80666325948 170 /*Send Battery Level for 20% */
adrayv 6:8a9b0eb4835d 171 // SendAccel does not work and is not stable over bluetooth
adrayv 6:8a9b0eb4835d 172 // So we will use SendBattery
adrayv 6:8a9b0eb4835d 173 // But since SendBattery cannot send multiple values at a time
adrayv 6:8a9b0eb4835d 174 // We will have to advertise to Pi what value it should expect next
adrayv 5:b479668a7373 175 kw40z_device.SendBatteryLevel('x');
adrayv 5:b479668a7373 176 kw40z_device.SendBatteryLevel(abs_x);
adrayv 5:b479668a7373 177 kw40z_device.SendBatteryLevel('y');
adrayv 5:b479668a7373 178 kw40z_device.SendBatteryLevel(abs_y);
adrayv 5:b479668a7373 179 kw40z_device.SendBatteryLevel('z');
adrayv 5:b479668a7373 180 kw40z_device.SendBatteryLevel(abs_z);
cotigac 3:c2ab3a0de448 181
khuang 1:a0d9eeedb771 182 Thread::wait(1000);
khuang 0:c80666325948 183 }
khuang 0:c80666325948 184 }
khuang 0:c80666325948 185
adrayv 5:b479668a7373 186 void GetSensorData(void) {
adrayv 5:b479668a7373 187 accel.acquire_accel_data_g(accel_data);
adrayv 6:8a9b0eb4835d 188
adrayv 6:8a9b0eb4835d 189 // get x,y,z data and amplify them by 100
adrayv 6:8a9b0eb4835d 190 // convert x,y,z data to positive numbers since SendBattery only supports unsigned ints
adrayv 5:b479668a7373 191 x = (int16_t)(accel_data[0] * 100);
adrayv 5:b479668a7373 192 y = (int16_t)(accel_data[1] * 100);
adrayv 5:b479668a7373 193 z = (int16_t)(accel_data[2] * 100);
adrayv 5:b479668a7373 194 abs_x = abs(x);
adrayv 5:b479668a7373 195 abs_y = abs(y);
adrayv 5:b479668a7373 196 abs_z = abs(z);
adrayv 5:b479668a7373 197 printf("ACCEL (x100)(ABS): X:%d Y:%d Z:%d\n",abs_x,abs_y,abs_z);
cotigac 3:c2ab3a0de448 198 }
cotigac 3:c2ab3a0de448 199
khuang 1:a0d9eeedb771 200 void StartHaptic(void) {
khuang 0:c80666325948 201 hapticTimer.start(50);
khuang 0:c80666325948 202 haptic = 1;
khuang 0:c80666325948 203 }
khuang 0:c80666325948 204
khuang 0:c80666325948 205 void StopHaptic(void const *n) {
khuang 0:c80666325948 206 haptic = 0;
khuang 0:c80666325948 207 hapticTimer.stop();
khuang 0:c80666325948 208 }
khuang 1:a0d9eeedb771 209