Calvin Ha / Mbed OS Hexi_Final_Project

Hexiwear Code for Game Controls

Dependencies:   FXAS21002 FXOS8700 Hexi_KW40Z Hexi_OLED_SSD1351

Fork of Hexi_Final_Project by Destin Raymundo

main.cpp@5:b479668a7373, 2018-06-12 (annotated)

Committer:
adrayv
Date:
Tue Jun 12 03:34:17 2018 +0000
Revision:
5:b479668a7373
Parent:
4:20d4eebfa986
Child:
6:8a9b0eb4835d
hexiwear sends motion data

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 5:b479668a7373 57 kw40z_device.SendAccel(x,y,z);
adrayv 5:b479668a7373 58 // kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 59 }
khuang 0:c80666325948 60
khuang 0:c80666325948 61 void ButtonLeft(void)
khuang 0:c80666325948 62 {
khuang 0:c80666325948 63 StartHaptic();
adrayv 5:b479668a7373 64 kw40z_device.SendAccel(x,y,z);
adrayv 5:b479668a7373 65 // kw40z_device.ToggleAdvertisementMode();
khuang 0:c80666325948 66 }
khuang 0:c80666325948 67
khuang 0:c80666325948 68 void PassKey(void)
khuang 0:c80666325948 69 {
khuang 0:c80666325948 70 StartHaptic();
khuang 0:c80666325948 71 strcpy((char *) text,"PAIR CODE");
khuang 1:a0d9eeedb771 72 oled.TextBox((uint8_t *)text,0,25,95,18);
khuang 0:c80666325948 73
khuang 0:c80666325948 74 /* Display Bond Pass Key in a 95px by 18px textbox at x=0,y=40 */
khuang 0:c80666325948 75 sprintf(text,"%d", kw40z_device.GetPassKey());
khuang 0:c80666325948 76 oled.TextBox((uint8_t *)text,0,40,95,18);
khuang 0:c80666325948 77 }
khuang 1:a0d9eeedb771 78
xihan94 4:20d4eebfa986 79 // Key modification: use the alert functionality enabled by the host-ble interface
xihan94 4:20d4eebfa986 80 // to define our own command.
xihan94 4:20d4eebfa986 81 void AlertReceived(uint8_t *data, uint8_t length)
xihan94 4:20d4eebfa986 82 {
xihan94 4:20d4eebfa986 83 StartHaptic();
xihan94 4:20d4eebfa986 84 data[19] = 0;
xihan94 4:20d4eebfa986 85 pc.printf("%s\n\r", data);
xihan94 4:20d4eebfa986 86
xihan94 4:20d4eebfa986 87 // data (our command) must 20 bytes long.
xihan94 4:20d4eebfa986 88 // CMD for turning on: 'ledonledonledonledon'
xihan94 4:20d4eebfa986 89 if (data[4] == 'n') {
xihan94 4:20d4eebfa986 90 greenLed = LED_ON;
xihan94 4:20d4eebfa986 91 redLed = LED_ON;
xihan94 4:20d4eebfa986 92 blueLed = LED_ON;
xihan94 4:20d4eebfa986 93 pc.printf("on\n\r", data);
xihan94 4:20d4eebfa986 94
xihan94 4:20d4eebfa986 95 // CMD for turning off: 'ledoffledoffledoffled'
xihan94 4:20d4eebfa986 96 } else if (data[4] == 'f') {
xihan94 4:20d4eebfa986 97 greenLed = LED_OFF;
xihan94 4:20d4eebfa986 98 redLed = LED_OFF;
xihan94 4:20d4eebfa986 99 blueLed = LED_OFF;
xihan94 4:20d4eebfa986 100 pc.printf("off\n\r", data);
xihan94 4:20d4eebfa986 101 }
xihan94 4:20d4eebfa986 102 }
khuang 1:a0d9eeedb771 103 /***********************End of Call Back Functions*****************************/
khuang 1:a0d9eeedb771 104
khuang 1:a0d9eeedb771 105 /********************************Main******************************************/
khuang 1:a0d9eeedb771 106
khuang 0:c80666325948 107 int main()
khuang 0:c80666325948 108 {
cotigac 3:c2ab3a0de448 109 /* Register callbacks to application functions */
cotigac 3:c2ab3a0de448 110 kw40z_device.attach_buttonLeft(&ButtonLeft);
cotigac 3:c2ab3a0de448 111 kw40z_device.attach_buttonRight(&ButtonRight);
cotigac 3:c2ab3a0de448 112 kw40z_device.attach_passkey(&PassKey);
xihan94 4:20d4eebfa986 113 kw40z_device.attach_alert(&AlertReceived);
adrayv 5:b479668a7373 114
adrayv 5:b479668a7373 115 accel.accel_config();
khuang 0:c80666325948 116
xihan94 4:20d4eebfa986 117 pc.printf("hello\n\r");
xihan94 4:20d4eebfa986 118
khuang 0:c80666325948 119 /* Turn on the backlight of the OLED Display */
khuang 0:c80666325948 120 oled.DimScreenON();
khuang 0:c80666325948 121
khuang 0:c80666325948 122 /* Fills the screen with solid black */
khuang 0:c80666325948 123 oled.FillScreen(COLOR_BLACK);
cotigac 3:c2ab3a0de448 124
cotigac 3:c2ab3a0de448 125 /* Get OLED Class Default Text Properties */
cotigac 3:c2ab3a0de448 126 oled_text_properties_t textProperties = {0};
cotigac 3:c2ab3a0de448 127 oled.GetTextProperties(&textProperties);
khuang 0:c80666325948 128
khuang 0:c80666325948 129 /* Change font color to Blue */
khuang 0:c80666325948 130 textProperties.fontColor = COLOR_BLUE;
khuang 0:c80666325948 131 oled.SetTextProperties(&textProperties);
khuang 0:c80666325948 132
khuang 0:c80666325948 133 /* Display Bluetooth Label at x=17,y=65 */
khuang 0:c80666325948 134 strcpy((char *) text,"BLUETOOTH");
khuang 0:c80666325948 135 oled.Label((uint8_t *)text,17,65);
khuang 0:c80666325948 136
khuang 0:c80666325948 137 /* Change font color to white */
khuang 0:c80666325948 138 textProperties.fontColor = COLOR_WHITE;
khuang 0:c80666325948 139 textProperties.alignParam = OLED_TEXT_ALIGN_CENTER;
khuang 0:c80666325948 140 oled.SetTextProperties(&textProperties);
khuang 0:c80666325948 141
khuang 1:a0d9eeedb771 142 /* Display Label at x=22,y=80 */
khuang 0:c80666325948 143 strcpy((char *) text,"Tap Below");
khuang 0:c80666325948 144 oled.Label((uint8_t *)text,22,80);
khuang 0:c80666325948 145
khuang 1:a0d9eeedb771 146 uint8_t prevLinkState = 0;
cotigac 3:c2ab3a0de448 147 uint8_t currLinkState = 0;
cotigac 3:c2ab3a0de448 148
khuang 1:a0d9eeedb771 149 txThread.start(txTask); /*Start transmitting Sensor Tag Data */
khuang 0:c80666325948 150
khuang 1:a0d9eeedb771 151 while (true)
khuang 1:a0d9eeedb771 152 {
xihan94 4:20d4eebfa986 153 // blueLed = !kw40z_device.GetAdvertisementMode(); /*Indicate BLE Advertisment Mode*/
khuang 1:a0d9eeedb771 154 Thread::wait(50);
khuang 1:a0d9eeedb771 155 }
khuang 1:a0d9eeedb771 156 }
khuang 1:a0d9eeedb771 157
khuang 1:a0d9eeedb771 158 /******************************End of Main*************************************/
khuang 1:a0d9eeedb771 159
khuang 1:a0d9eeedb771 160 /* txTask() transmits the sensor data */
khuang 1:a0d9eeedb771 161 void txTask(void){
khuang 1:a0d9eeedb771 162
khuang 1:a0d9eeedb771 163 while (true)
khuang 1:a0d9eeedb771 164 {
adrayv 5:b479668a7373 165 GetSensorData();
khuang 0:c80666325948 166
khuang 1:a0d9eeedb771 167 /*Notify Hexiwear App that it is running Sensor Tag mode*/
khuang 0:c80666325948 168 kw40z_device.SendSetApplicationMode(GUI_CURRENT_APP_SENSOR_TAG);
khuang 0:c80666325948 169
khuang 1:a0d9eeedb771 170 /*The following is sending dummy data over BLE. Replace with real data*/
khuang 1:a0d9eeedb771 171
khuang 0:c80666325948 172 /*Send Battery Level for 20% */
adrayv 5:b479668a7373 173 kw40z_device.SendBatteryLevel('x');
adrayv 5:b479668a7373 174 kw40z_device.SendBatteryLevel(abs_x);
adrayv 5:b479668a7373 175 kw40z_device.SendBatteryLevel('y');
adrayv 5:b479668a7373 176 kw40z_device.SendBatteryLevel(abs_y);
adrayv 5:b479668a7373 177 kw40z_device.SendBatteryLevel('z');
adrayv 5:b479668a7373 178 kw40z_device.SendBatteryLevel(abs_z);
khuang 0:c80666325948 179
khuang 0:c80666325948 180 /*Send Ambient Light Level at 50% */
adrayv 5:b479668a7373 181 // kw40z_device.SendAmbientLight(light);
khuang 0:c80666325948 182
khuang 0:c80666325948 183 /*Send Humidity at 90% */
adrayv 5:b479668a7373 184 // kw40z_device.SendHumidity(humidity);
khuang 0:c80666325948 185
khuang 0:c80666325948 186 /*Send Temperature at 25 degrees Celsius */
adrayv 5:b479668a7373 187 // kw40z_device.SendTemperature(temperature);
khuang 0:c80666325948 188
khuang 0:c80666325948 189 /*Send Pressure at 100kPA */
adrayv 5:b479668a7373 190 // kw40z_device.SendPressure(pressure);
khuang 0:c80666325948 191
khuang 1:a0d9eeedb771 192 /*Send Mag,Accel,Gyro Data. */
adrayv 5:b479668a7373 193 // kw40z_device.SendGyro(x,y,z);
adrayv 5:b479668a7373 194 kw40z_device.SendAccel(x,y,z);
adrayv 5:b479668a7373 195 // kw40z_device.SendMag(y,z,x);
cotigac 3:c2ab3a0de448 196
khuang 1:a0d9eeedb771 197 Thread::wait(1000);
khuang 0:c80666325948 198 }
khuang 0:c80666325948 199 }
khuang 0:c80666325948 200
adrayv 5:b479668a7373 201 void GetSensorData(void) {
adrayv 5:b479668a7373 202 accel.acquire_accel_data_g(accel_data);
adrayv 5:b479668a7373 203 x = (int16_t)(accel_data[0] * 100);
adrayv 5:b479668a7373 204 y = (int16_t)(accel_data[1] * 100);
adrayv 5:b479668a7373 205 z = (int16_t)(accel_data[2] * 100);
adrayv 5:b479668a7373 206 abs_x = abs(x);
adrayv 5:b479668a7373 207 abs_y = abs(y);
adrayv 5:b479668a7373 208 abs_z = abs(z);
adrayv 5:b479668a7373 209 // printf("ACCEL: %d %4.2f %4.2f\n",x, accel_data[1], accel_data[2]);
adrayv 5:b479668a7373 210 // printf("ACCEL (x100): X:%d Y:%d Z:%d\n",x,y,z);
adrayv 5:b479668a7373 211 printf("ACCEL (x100)(ABS): X:%d Y:%d Z:%d\n",abs_x,abs_y,abs_z);
cotigac 3:c2ab3a0de448 212 }
cotigac 3:c2ab3a0de448 213
khuang 1:a0d9eeedb771 214 void StartHaptic(void) {
khuang 0:c80666325948 215 hapticTimer.start(50);
khuang 0:c80666325948 216 haptic = 1;
khuang 0:c80666325948 217 }
khuang 0:c80666325948 218
khuang 0:c80666325948 219 void StopHaptic(void const *n) {
khuang 0:c80666325948 220 haptic = 0;
khuang 0:c80666325948 221 hapticTimer.stop();
khuang 0:c80666325948 222 }
khuang 1:a0d9eeedb771 223