Chen Ting Lee
a
Dependencies: stm32l475e_iot01_gps BSP_B-L475E-IOT01
Diff: main.cpp
- Revision:
- 101:8d2cd7e4f3c1
- Parent:
- 100:84aa1516022b
--- a/main.cpp Thu Jan 14 23:36:14 2021 +0000
+++ b/main.cpp Fri Jan 15 13:24:34 2021 +0000
@@ -1,331 +1,326 @@
-/* WiFi Example
- * Copyright (c) 2018 ARM Limited
- *
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- */
-
-
-
-#include "ThisThread.h"
-#include "mbed.h"
-#include "TCPSocket.h"
-//#include "TCPServer.h"
-#include "stm32l475e_iot01_accelero.h"
-
-#define WIFI_IDW0XX1 2
-
-#if (defined(TARGET_DISCO_L475VG_IOT01A) || defined(TARGET_DISCO_F413ZH))
-#include "ISM43362Interface.h"
-ISM43362Interface wifi( false);
-
-#else // External WiFi modules
-
-#if MBED_CONF_APP_WIFI_SHIELD == WIFI_IDW0XX1
-#include "SpwfSAInterface.h"
-SpwfSAInterface wifi(MBED_CONF_APP_WIFI_TX, MBED_CONF_APP_WIFI_RX);
-#endif // MBED_CONF_APP_WIFI_SHIELD == WIFI_IDW0XX1
-
-#endif
-
-#define SCALE_MULTIPLIER 0.004
-
-
-const char *sec2str(nsapi_security_t sec)
-{
- switch (sec) {
- case NSAPI_SECURITY_NONE:
- return "None";
- case NSAPI_SECURITY_WEP:
- return "WEP";
- case NSAPI_SECURITY_WPA:
- return "WPA";
- case NSAPI_SECURITY_WPA2:
- return "WPA2";
- case NSAPI_SECURITY_WPA_WPA2:
- return "WPA/WPA2";
- case NSAPI_SECURITY_UNKNOWN:
- default:
- return "Unknown";
- }
-}
-
-int scan_demo(WiFiInterface *wifi)
-{
- WiFiAccessPoint *ap;
-
- printf("Scan:\n");
-
- int count = wifi->scan(NULL,0);
- printf("%d networks available.\n", count);
-
- /* Limit number of network arbitrary to 15 */
- count = count < 15 ? count : 15;
-
- ap = new WiFiAccessPoint[count];
- count = wifi->scan(ap, count);
- for (int i = 0; i < count; i++)
- {
- printf("Network: %s secured: %s BSSID: %hhX:%hhX:%hhX:%hhx:%hhx:%hhx RSSI: %hhd Ch: %hhd\n", ap[i].get_ssid(),
- sec2str(ap[i].get_security()), ap[i].get_bssid()[0], ap[i].get_bssid()[1], ap[i].get_bssid()[2],
- ap[i].get_bssid()[3], ap[i].get_bssid()[4], ap[i].get_bssid()[5], ap[i].get_rssi(), ap[i].get_channel());
- }
-
- delete[] ap;
- return count;
-}
-
-void acc_server(NetworkInterface *net)
-{
- /*
- TCPServer socket;
- TCPSocket* client;*/
- TCPSocket socket;
- SocketAddress addr("192.168.43.199",65431);
- nsapi_error_t response;
-
- int16_t pDataXYZ[3] = {0};
- char recv_buffer[9];
- char acc_json[64];
- int sample_num = 0;
-
- //analyze
- float bufX[80], bufY[80], bufZ[80];
- int saX[80]={0}, saY[80]={0}, saZ[80]={0};
- int fuzX[3]={80,0,0}, fuzY[3]={80,0,0}, fuzZ[3]={80,0,0};
- int stX=0, stY=0, stZ=0;
- int ptr=0;
- int i=0;
- /*
- for(i=0;i<80;i++){
- saX[i]=0;
- saY[i]=0;
- saZ[i]=0;
- }
- */
-
- // Open a socket on the network interface, and create a TCP connection to addr
- response = socket.open(net);
- if (0 != response){
- printf("Error opening: %d\n", response);
- }
- response = socket.connect(addr);
-
- if (0 != response){
- printf("Error connecting: %d\n", response);
- }
-
-
- socket.set_blocking(1);
- while (1){
- ptr=sample_num%80;
- ++sample_num;
- BSP_ACCELERO_AccGetXYZ(pDataXYZ);
- float x = pDataXYZ[0]*SCALE_MULTIPLIER, y = pDataXYZ[1]*SCALE_MULTIPLIER, z = pDataXYZ[2]*SCALE_MULTIPLIER;
- int len;
-
- bufX[ptr]=x;
- bufY[ptr]=y;
- bufZ[ptr]=z;
-
- fuzX[saX[ptr]]-=1;
- if(x>1.5){
- saX[ptr]=2;
- fuzX[2]+=1;
- }else if(x>-1.5){
- saX[ptr]=1;
- fuzX[1]+=1;
- }else{
- saX[ptr]=0;
- fuzX[0]+=1;
- }
- fuzY[saX[ptr]]-=1;
- if(y>1.5){
- saY[ptr]=2;
- fuzY[2]+=1;
- }else if(y>-1.5){
- saY[ptr]=1;
- fuzY[1]+=1;
- }else{
- saY[ptr]=0;
- fuzY[0]+=1;
- }
- fuzZ[saX[ptr]]-=1;
- if(z>5.5){
- saZ[ptr]=2;
- fuzZ[2]+=1;
- }else if(z>2.5){
- saZ[ptr]=1;
- fuzZ[1]+=1;
- }else{
- saZ[ptr]=0;
- fuzZ[0]+=1;
- }
-
- //fuzzy
- //X
- if(fuzX[2]>64 || fuzX[0]>64){
- if(stX!=3){
- len = sprintf(acc_json,"x3\n");
- socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stX=3;
- }
- }else if((fuzX[2]>32 || fuzX[0]>32) && fuzX[1]>32){
- if(stX!=2){
- len = sprintf(acc_json,"x2\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stX=2;
- }
- }else if(fuzX[2]>32 && fuzX[0]>32){
- if(stX!=1){
- len = sprintf(acc_json,"x1\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stX=1;
- }
- }else if(fuzX[1]>64){
- stX=0;
- }
- //Y
- if(fuzY[2]>64 || fuzY[0]>64){
- if(stY!=3){
- len = sprintf(acc_json,"y3\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stY=3;
- }
- }else if((fuzY[2]>32 || fuzY[0]>32) && fuzY[1]>32){
- if(stY!=2){
- len = sprintf(acc_json,"y2\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stY=2;
- }
- }else if(fuzY[2]>32 && fuzY[0]>32){
- if(stY!=1){
- len = sprintf(acc_json,"y1\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stY=1;
- }
- }else if(fuzY[1]>64){
- stY=0;
- }
- //Z
- if(fuzZ[2]>64 || fuzZ[0]>64){
- if(stZ!=3){
- len = sprintf(acc_json,"z3\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stZ=3;
- }
- }else if((fuzZ[2]>32 || fuzZ[0]>32) && fuzZ[1]>32){
- if(stZ!=2){
- len = sprintf(acc_json,"z2\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stZ=2;
- }
- }else if(fuzZ[2]>32 && fuzZ[0]>32){
- if(stZ!=1){
- len = sprintf(acc_json,"z1\n");
- response = socket.send(acc_json,len);
- for(i=1;i<81;i++){
- len=sprintf(acc_json,"%f,%f,%f\n",(float)((int)(bufX[(ptr+i)%80]*10000))/10000,
- (float)((int)(bufY[(ptr+i)%80]*10000))/10000, (float)((int)(bufZ[(ptr+i)%80]*10000))/10000);
- socket.send(acc_json,len);
- }
- stZ=1;
- }
- }else if(fuzZ[1]>64){
- stZ=0;
- }
-
- //int len = sprintf(acc_json,"%f,%f,%f,%d,%d\n",(float)((int)(x*10000))/10000,
- // (float)((int)(y*10000))/10000, (float)((int)(z*10000))/10000, sample_num, ptr);
-
-
- //response = socket.send(acc_json,len);
- if (0 >= response){
- printf("Error seding: %d\n", response);
- }
- ThisThread::sleep_for(0.1);
-
-
- }
-
-
- socket.close();
-}
-
-int main()
-{
-
- printf("\nConnecting to %s...\n", MBED_CONF_APP_WIFI_SSID);
- //wifi.set_network("192.168.130.105","255.255.255.0","192.168.130.254");
- int ret = wifi.connect(MBED_CONF_APP_WIFI_SSID, MBED_CONF_APP_WIFI_PASSWORD, NSAPI_SECURITY_WPA_WPA2);
- if (ret != 0) {
- printf("\nConnection error\n");
- return -1;
- }
-
- printf("Success\n\n");
- printf("MAC: %s\n", wifi.get_mac_address());
- printf("IP: %s\n", wifi.get_ip_address());
- printf("Netmask: %s\n", wifi.get_netmask());
- printf("Gateway: %s\n", wifi.get_gateway());
- printf("RSSI: %d\n\n", wifi.get_rssi());
-
-
-
- BSP_ACCELERO_Init();
-
-
- acc_server(&wifi);
-
-
-
-}
\ No newline at end of file
+/* WiFi Example
+ * Copyright (c) 2018 ARM Limited
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ */
+
+
+
+#include "ThisThread.h"
+#include "mbed.h"
+#include "TCPSocket.h"
+//#include "TCPServer.h"
+#include "stm32l475e_iot01_accelero.h"
+#include "stm32l475e_iot01_gps.h"
+
+
+#define WIFI_IDW0XX1 2
+
+#if (defined(TARGET_DISCO_L475VG_IOT01A) || defined(TARGET_DISCO_F413ZH))
+#include "ISM43362Interface.h"
+ISM43362Interface wifi( false);
+
+#else // External WiFi modules
+
+#if MBED_CONF_APP_WIFI_SHIELD == WIFI_IDW0XX1
+#include "SpwfSAInterface.h"
+SpwfSAInterface wifi(MBED_CONF_APP_WIFI_TX, MBED_CONF_APP_WIFI_RX);
+#endif // MBED_CONF_APP_WIFI_SHIELD == WIFI_IDW0XX1
+
+#endif
+
+#define SCALE_MULTIPLIER 0.004
+
+
+GPS* gps=new GPS(D1,D0);
+
+const char *sec2str(nsapi_security_t sec)
+{
+ switch (sec) {
+ case NSAPI_SECURITY_NONE:
+ return "None";
+ case NSAPI_SECURITY_WEP:
+ return "WEP";
+ case NSAPI_SECURITY_WPA:
+ return "WPA";
+ case NSAPI_SECURITY_WPA2:
+ return "WPA2";
+ case NSAPI_SECURITY_WPA_WPA2:
+ return "WPA/WPA2";
+ case NSAPI_SECURITY_UNKNOWN:
+ default:
+ return "Unknown";
+ }
+}
+
+int scan_demo(WiFiInterface *wifi)
+{
+ WiFiAccessPoint *ap;
+
+ printf("Scan:\n");
+
+ int count = wifi->scan(NULL,0);
+ printf("%d networks available.\n", count);
+
+ /* Limit number of network arbitrary to 15 */
+ count = count < 15 ? count : 15;
+
+ ap = new WiFiAccessPoint[count];
+ count = wifi->scan(ap, count);
+ for (int i = 0; i < count; i++)
+ {
+ printf("Network: %s secured: %s BSSID: %hhX:%hhX:%hhX:%hhx:%hhx:%hhx RSSI: %hhd Ch: %hhd\n", ap[i].get_ssid(),
+ sec2str(ap[i].get_security()), ap[i].get_bssid()[0], ap[i].get_bssid()[1], ap[i].get_bssid()[2],
+ ap[i].get_bssid()[3], ap[i].get_bssid()[4], ap[i].get_bssid()[5], ap[i].get_rssi(), ap[i].get_channel());
+ }
+
+ delete[] ap;
+ return count;
+}
+
+void acc_server(NetworkInterface *net)
+{
+ /*
+ TCPServer socket;
+ TCPSocket* client;*/
+ TCPSocket socket;
+ SocketAddress addr("192.168.43.163",65431);
+ nsapi_error_t response;
+
+ int16_t pDataXYZ[3] = {0};
+ char recv_buffer[9];
+ char acc_json[64];
+ int sample_num = 0;
+
+ //analyze
+ float bufX[80], bufY[80], bufZ[80];
+ int saX[80]={0}, saY[80]={0}, saZ[80]={0};
+ int fuzX[3]={80,0,0}, fuzY[3]={80,0,0}, fuzZ[3]={80,0,0};
+ int stX=0, stY=0, stZ=0;
+ int ptr=0;
+ int i=0;
+ /*
+ for(i=0;i<80;i++){
+ saX[i]=0;
+ saY[i]=0;
+ saZ[i]=0;
+ }
+ */
+
+ // Open a socket on the network interface, and create a TCP connection to addr
+ response = socket.open(net);
+ if (0 != response){
+ printf("Error opening: %d\n", response);
+ }
+ response = socket.connect(addr);
+
+ if (0 != response){
+ printf("Error connecting: %d\n", response);
+ }
+
+
+ socket.set_blocking(1);
+ while (1){
+ ptr=sample_num%80;
+ ++sample_num;
+ BSP_ACCELERO_AccGetXYZ(pDataXYZ);
+ float x = pDataXYZ[0]*SCALE_MULTIPLIER, y = pDataXYZ[1]*SCALE_MULTIPLIER, z = pDataXYZ[2]*SCALE_MULTIPLIER;
+ int len;
+
+ bufX[ptr]=x;
+ bufY[ptr]=y;
+ bufZ[ptr]=z;
+
+ fuzX[saX[ptr]]-=1;
+ if(x>1){
+ saX[ptr]=2;
+ fuzX[2]+=1;
+ }else if(x>-1){
+ saX[ptr]=1;
+ fuzX[1]+=1;
+ }else{
+ saX[ptr]=0;
+ fuzX[0]+=1;
+ }
+ fuzY[saX[ptr]]-=1;
+ if(y>1){
+ saY[ptr]=2;
+ fuzY[2]+=1;
+ }else if(y>-1){
+ saY[ptr]=1;
+ fuzY[1]+=1;
+ }else{
+ saY[ptr]=0;
+ fuzY[0]+=1;
+ }
+ fuzZ[saX[ptr]]-=1;
+ if(z>5){
+ saZ[ptr]=2;
+ fuzZ[2]+=1;
+ }else if(z>3){
+ saZ[ptr]=1;
+ fuzZ[1]+=1;
+ }else{
+ saZ[ptr]=0;
+ fuzZ[0]+=1;
+ }
+
+ //fuzzy
+ //X
+ if(fuzX[2]>64 || fuzX[0]>64){
+ if(stX!=3){
+ len = sprintf(acc_json,"x3\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stX=3;
+ }
+ }else if((fuzX[2]>32 || fuzX[0]>32) && fuzX[1]>32){
+ if(stX!=2){
+ len = sprintf(acc_json,"x2\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stX=2;
+ }
+ }else if(fuzX[2]>32 && fuzX[0]>32){
+ if(stX!=1){
+ len = sprintf(acc_json,"x1\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stX=1;
+ }
+ }else if(fuzX[1]>64){
+ stX=0;
+ }
+ //Y
+ if(fuzY[2]>64 || fuzY[0]>64){
+ if(stY!=3){
+ len = sprintf(acc_json,"y3\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stY=3;
+ }
+ }else if((fuzY[2]>32 || fuzY[0]>32) && fuzY[1]>32){
+ if(stY!=2){
+ len = sprintf(acc_json,"y2\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stY=2;
+ }
+ }else if(fuzY[2]>32 && fuzY[0]>32){
+ if(stY!=1){
+ len = sprintf(acc_json,"y1\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stY=1;
+ }
+ }else if(fuzY[1]>64){
+ stY=0;
+ }
+ //Z
+ if(fuzZ[2]>64 || fuzZ[0]>64){
+ if(stZ!=3){
+ len = sprintf(acc_json,"z3\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stZ=3;
+ }
+ }else if((fuzZ[2]>32 || fuzZ[0]>32) && fuzZ[1]>32){
+ if(stZ!=2){
+ len = sprintf(acc_json,"z2\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stZ=2;
+ }
+ }else if(fuzZ[2]>32 && fuzZ[0]>32){
+ if(stZ!=1){
+ len = sprintf(acc_json,"z1\n");
+ response = socket.send(acc_json,len);
+ int v=gps->sample();
+ if(v){len=sprintf(acc_json,"%f,%f",gps->longitude,gps->latitude);}
+ else{len=sprintf(acc_json,"N");}
+ response = socket.send(acc_json,len);
+ stZ=1;
+ }
+ }else if(fuzZ[1]>64){
+ stZ=0;
+ }
+
+ //int len = sprintf(acc_json,"%f,%f,%f,%d,%d\n",(float)((int)(x*10000))/10000,
+ // (float)((int)(y*10000))/10000, (float)((int)(z*10000))/10000, sample_num, ptr);
+
+
+ //response = socket.send(acc_json,len);
+ if (0 >= response){
+ printf("Error seding: %d\n", response);
+ }
+ ThisThread::sleep_for(0.1);
+
+
+ }
+
+
+ socket.close();
+}
+
+int main()
+{
+
+ printf("\nConnecting to %s...\n", MBED_CONF_APP_WIFI_SSID);
+ //wifi.set_network("192.168.130.105","255.255.255.0","192.168.130.254");
+ int ret = wifi.connect(MBED_CONF_APP_WIFI_SSID, MBED_CONF_APP_WIFI_PASSWORD, NSAPI_SECURITY_WPA_WPA2);
+ if (ret != 0) {
+ printf("\nConnection error\n");
+ return -1;
+ }
+
+ printf("Success\n\n");
+ printf("MAC: %s\n", wifi.get_mac_address());
+ printf("IP: %s\n", wifi.get_ip_address());
+ printf("Netmask: %s\n", wifi.get_netmask());
+ printf("Gateway: %s\n", wifi.get_gateway());
+ printf("RSSI: %d\n\n", wifi.get_rssi());
+
+
+
+ BSP_ACCELERO_Init();
+
+
+ acc_server(&wifi);
+
+
+
+}