Tsungta Wu
Fork from Sog Yang
Dependencies: BNO055_AS7000 NNN50_WIFI_API
Fork of
NNN50_BLEWIFISensor
by 
Sog Yang
Diff: main.cpp
- Revision:
- 7:06495d54d107
- Parent:
- 6:4ca0aa131d20
- Child:
- 8:ff7fdd152f14
--- a/main.cpp Tue May 02 08:47:57 2017 +0000
+++ b/main.cpp Thu May 04 02:37:17 2017 +0000
@@ -1,30 +1,14 @@
#include "mbed.h"
-#include "rtos.h"
-#include <events/mbed_events.h>
-
+#include "BNO055.h"
+#include "AS7000.h"
#include "ble/BLE.h"
#include "ble/Gap.h"
#include "ble/services/BatteryService.h"
#include "DOORService.h"
-#include "BNO055.h"
-#include "AS7000.h"
#include "EthernetInterface.h"
#include "WIFIDevice.h"
-BNO055 imu(p0,p30);
-AS7000 hrm(p0,p30);
-Serial pc(USBTX, USBRX);
-Semaphore two_slots(2);
-//static Thread t1;
-static Thread t2;
-static Ticker ticker;
-
-const static char DEVICE_NAME[] = "DOORCTL";
-static uint8_t ADV_manuf[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
-static char out_buffer_tt[] = "hrm:120 yaw:250.2 pitch:359.1 roll:180.2\n";
-static uint8_t BLE_RX_CMD = 0xFF;
-static uint8_t doorStatusPayload[2] = {0xFF,};
union IP {
unsigned int ip;
struct {
@@ -37,21 +21,34 @@
char ips[20];
IP ip;
-unsigned short a, b, c, d;
-BLEDevice ble;
+
+DOORService *doorServicePtr;
+
+
+BNO055 imu(p0,p30);
+AS7000 hrm(p0,p30);
+Serial pc(USBTX, USBRX);
EthernetInterface eth;
WIFIDevice wifi;
+
+Thread thread;
+Thread network_thread;
TCPSocketConnection sock_tcp;
-//UDPSocket sock_udp;
-//Endpoint echo_server;
+char* ECHO_SERVER_ADDRESS = "10.0.1.13";
+int ECHO_SERVER_PORT = 1030;
-static DOORService *doorServicePtr;
+uint8_t initialValueForDOORCharacteristic = 0xFF;
+uint8_t BLE_RX_CMD = 0xFF;
+const char DEVICE_NAME[] = "DOORCTL";
+uint8_t ADV_manuf[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00};
+char out_buffer[45];
static EventQueue eventQueue(
/* event count */ 16 * /* event size */ 32
);
-static char* ECHO_SERVER_ADDRESS = "192.168.2.110";
-static int ECHO_SERVER_PORT = 1030;
-static bool triggerTempValueUpdate = false;
+
+ bool isConnect = false;
+ bool isWiFiEnable = false;
+
void disconnectionCallback(const Gap::DisconnectionCallbackParams_t *params)
{
@@ -63,90 +60,11 @@
if ((params->handle == doorServicePtr->getValueHandle()) && (params->len == 1)) {
{
- BLE_RX_CMD = *(params->data);
+ BLE_RX_CMD = *(params->data);
}
}
}
-void ble_thread() {
- while (true) {
- switch (BLE_RX_CMD) {
- case 0x00:
- if ( ADV_manuf[5]== 0xA1) {
- eth.disconnect();
- sock_tcp.close();
- wifi.sleep();
- }
-
- BLE_RX_CMD = 0xFF;
- doorStatusPayload[0]=0xF0;
- ADV_manuf[5] = 0xF0;
-
- eth.init();
- wifi.setNetwork(M2M_WIFI_SEC_WPA_PSK, "20-4F-5_Guest", "11223344");
- eth.connect();
- /*
- if(wifi.is_AP_connected())
- printf("Connect Success! \n");
- else
- printf("Connect Fail! \n");
-
- printf("MAC: %s\n", eth.getMACAddress());
- printf("IP: %s\n", eth.getIPAddress());
- printf("Gateway: %s\n", eth.getGateway());
- printf("NetworkMask: %s\n", eth.getNetworkMask());
- */
- while (sock_tcp.connect(ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT) < 0) {
- //printf("Unable to connect to (%s) on port (%d)\n", ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT);
- wait(1);
- }
- //printf("Connected to Server at %s\n",ECHO_SERVER_ADDRESS);
-
- snprintf(ips, sizeof(ips), "%s",eth.getIPAddress());
- unsigned short a, b, c, d;
- sscanf(ips, "%hu.%hu.%hu.%hu", &a, &b, &c, &d);
- sprintf(ips, "%x.%x.%x.%x", a, b, c, d);
- ADV_manuf[0] = a;
- ADV_manuf[1] = b;
- ADV_manuf[2] = c;
- ADV_manuf[3] = d;
- break;
-
- case 0x02:
- if ( ADV_manuf[5]== 0xA1) {
- eth.disconnect();
- sock_tcp.close();
- wifi.sleep();
- }
- BLE_RX_CMD = 0xFF;
-
- ADV_manuf[0] = 0x00;
- ADV_manuf[1] = 0x00;
- ADV_manuf[2] = 0x00;
- ADV_manuf[3] = 0x00;
-
- ADV_manuf[5] = 0xF2;
- doorStatusPayload[0]=0xF2;
-
- break;
-
- case 0xA1:
- //BLE_RX_CMD = 0xFF;
- sprintf(out_buffer_tt,"hrm:%03d yaw:%6.2f pitch:%6.2f roll:%6.2f\n", hrm.hrm.hreat_rate, imu.euler.yaw, imu.euler.pitch, imu.euler.roll);
- sock_tcp.send_all(out_buffer_tt, sizeof(out_buffer_tt) - 1);
- ADV_manuf[5] = 0xA1;
- doorStatusPayload[0]=0xA1;
- break;
- }
-
- if (ble.getGapState().connected) {
- ble.updateCharacteristicValue((doorServicePtr->getValueHandle()),doorStatusPayload, 1);
- }
- }
-}
-
-
-
/**
* This function is called when the ble initialization process has failled
*/
@@ -178,14 +96,13 @@
ble.gattServer().onDataWritten(onDataWrittenCallback);
/* Setup primary services */
- uint8_t initialValueForDOORCharacteristic = 0xFF;
doorServicePtr = new DOORService(ble, initialValueForDOORCharacteristic);
/* Setup advertising */
ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::COMPLETE_LOCAL_NAME, (uint8_t *)DEVICE_NAME, sizeof(DEVICE_NAME));
ble.gap().accumulateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, ADV_manuf, sizeof(ADV_manuf));
ble.gap().setAdvertisingType(GapAdvertisingParams::ADV_CONNECTABLE_UNDIRECTED);
- ble.gap().setAdvertisingInterval(200); /* 1000ms */
+ ble.gap().setAdvertisingInterval(150); /* 1000ms */
ble.gap().startAdvertising();
}
@@ -193,59 +110,125 @@
BLE &ble = BLE::Instance();
eventQueue.call(Callback<void()>(&ble, &BLE::processEvents));
}
-
-void network_thread(void const *name) {
- while (true) {
- two_slots.wait();
- //printf("%s\n\r", (const char*)name);
- ble_thread();
- /*
- wait_ms(5);
- imu.get_angles(); //query the i2c device
- //printf("get angles\n");
- wait_ms(5);
- hrm.hr_only();
- //printf("get hrm\n");
-*/
- wait_ms(100);
- two_slots.release();
+
+
+void network_send_thread (void) {
+ while(true) {
+ pc.printf("network_send_thread");
+ wait(1);
}
}
-void periodicCallback(void){
- triggerTempValueUpdate = true;
-}
-
int main (void) {
- pc.baud(38400);
+
hrm.enable();
- imu.reset();
+ imu.reset();
imu.setmode(OPERATION_MODE_NDOF);
+ #if 0
+ eth.init();
+ wifi.setNetwork(M2M_WIFI_SEC_WPA_PSK, "SOG", "0227322327");
+ eth.connect();
+ wait_ms(20);
+
+
+ pc.printf("Connect Success! \n");
+ pc.printf("MAC: %s\n", eth.getMACAddress());
+ pc.printf("IP: %s\n", eth.getIPAddress());
+ pc.printf("Gateway: %s\n", eth.getGateway());
+ pc.printf("NetworkMask: %s\n", eth.getNetworkMask());
+
+#endif
BLE &ble = BLE::Instance();
ble.onEventsToProcess(scheduleBleEventsProcessing);
ble.init(bleInitComplete);
-
- // t1.start(callback(sensor_thread, (void *)"Sensor Thread"));
- t2.start(callback(network_thread, (void *)"BLE-WIFI CTL Thread"));
-
-
- ticker.attach(periodicCallback, 1); // blink LED every 1 second
-
-
+
while (true) {
- if (triggerTempValueUpdate) {
- /* Do blocking calls or whatever hardware-specific action is
- * necessary to poll the sensor. */
- BLE::Instance(BLE::DEFAULT_INSTANCE).gap().updateAdvertisingPayload(GapAdvertisingData::MANUFACTURER_SPECIFIC_DATA, ADV_manuf, sizeof(ADV_manuf));
- printf("*HR=%03d#", hrm.hrm.hreat_rate);
- triggerTempValueUpdate = false;
+ imu.get_angles(); //query the i2c device
+ wait_ms(5);
+ hrm.hr_only();
+ wait_ms(5);
+ /* GATT Command 0xA1 Cloud Data Transfer*/
+ if (BLE_RX_CMD == 0xA1){
+ if (isConnect == true) {
+ sprintf(out_buffer,"hrm:%03d yaw:%6.2f pitch:%6.2f roll:%6.2f\n", hrm.hrm.hreat_rate, imu.euler.yaw, imu.euler.pitch, imu.euler.roll);
+ sock_tcp.send_all(out_buffer, sizeof(out_buffer) - 1);
+ wait_ms(5);
+ } else {
+ BLE_RX_CMD = 0xFF;
+ if (sock_tcp.connect(ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT) < 0) {
+ isConnect = false;
+ pc.printf("Unable to connect to (%s) on port (%d)\n", ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT);
+ } else {
+ isConnect = true;
+ pc.printf("Connected to Server at %s\n",ECHO_SERVER_ADDRESS);
+ }
+ }
+ }
+ /* GATT Command 0x02 WiFI & Cloud Connection Close*/
+ if (BLE_RX_CMD == 0x02){
+ ADV_manuf[5] = 0xF2;
+ if ( isConnect == true ) {
+ sock_tcp.close();
+ isConnect = false;
}
- hrm.hr_only();
- wait_ms(15);
- imu.get_angles(); //query the i2c device
- wait_ms(15);
+ if ( isWiFiEnable == true ) {
+ eth.disconnect();
+ wifi.sleep();
+ isWiFiEnable = false;
+ }
+ if (isConnect == true) isConnect = false;
+
+ BLE_RX_CMD = 0xFF;
+ ADV_manuf[0] = 0x00;
+ ADV_manuf[1] = 0x00;
+ ADV_manuf[2] = 0x00;
+ ADV_manuf[3] = 0x00;
+ }
+ /* GATT Command 0x0 init WiFI & Cloud Connection*/
+ if (BLE_RX_CMD == 0x00){
+ BLE_RX_CMD = 0xFF;
+ ADV_manuf[5] = 0xF0;
+
+ if (isWiFiEnable == false) {
+ eth.init();
+ wifi.setNetwork(M2M_WIFI_SEC_WPA_PSK, "SOG", "0227322327");
+ eth.connect();
+ wait_ms(25);
+ pc.printf("Connect Success! \n");
+ pc.printf("MAC: %s\n", eth.getMACAddress());
+ pc.printf("IP: %s\n", eth.getIPAddress());
+ pc.printf("Gateway: %s\n", eth.getGateway());
+ pc.printf("NetworkMask: %s\n", eth.getNetworkMask());
+
+ snprintf(ips, sizeof(ips), "%s",eth.getIPAddress());
+ unsigned short a, b, c, d;
+ sscanf(ips, "%hu.%hu.%hu.%hu", &a, &b, &c, &d);
+ sprintf(ips, "%x.%x.%x.%x", a, b, c, d);
+ ADV_manuf[0] = a;
+ ADV_manuf[1] = b;
+ ADV_manuf[2] = c;
+ ADV_manuf[3] = d;
+ isWiFiEnable = true;
+ }
+
+ if (isConnect == false) {
+ if (isWiFiEnable == true) {
+ if (sock_tcp.connect(ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT) < 0) {
+ pc.printf("Unable to connect to (%s) on port (%d)\n", ECHO_SERVER_ADDRESS, ECHO_SERVER_PORT);
+ sock_tcp.close();
+ ADV_manuf[0] = 0xCF;
+ ADV_manuf[1] = 0xCF;
+ ADV_manuf[2] = 0xCF;
+ ADV_manuf[3] = 0xCF;
+ } else {
+ isConnect = true;
+ pc.printf("Connected to Server at %s\n",ECHO_SERVER_ADDRESS);
+ }
+ }
+ }
+ }
ble.waitForEvent();
}
-}
+}
\ No newline at end of file