Revision 12:2dde21ae53c4, committed 2022-04-29

Comitter:

ndnafzig

Date:

Fri Apr 29 16:52:11 2022 +0000

Parent:

11:756321f0b0cd

Commit message:

Standard

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FXAS21000.lib	Fri Apr 29 16:52:11 2022 +0000
@@ -0,0 +1,1 @@
+https://os.mbed.com/users/JimCarver/code/FXAS21000/#a8f83b52f4df

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/FXOS8700Q.lib	Fri Apr 29 16:52:11 2022 +0000
@@ -0,0 +1,1 @@
+https://os.mbed.com/users/carlosperate/code/FXOS8700Q/#a8deb4ce9b4a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/RegisterWriter.lib	Fri Apr 29 16:52:11 2022 +0000
@@ -0,0 +1,1 @@
+https://developer.mbed.org/teams/Rohm/code/RegisterWriter/#3d4508874121

--- a/main.cpp	Sat Aug 28 22:17:23 2021 +0000
+++ b/main.cpp	Fri Apr 29 16:52:11 2022 +0000
@@ -1,44 +1,89 @@
-/**
-Electronically Controlled Intelligent Shelves
-Developed by: Priyank Kalgaonkar
-**/
-
 #include "mbed.h"
 #include "hcsr04.h"
 #include "ESP8266.h"
 #include "math.h"
-#define CloudIP "184.106.153.149"           //Raw IP Address of ThingSpeak Cloud Server
+#include "FXOS8700Q.h"
+#include "FXAS21000.h"
+#include "RegisterWriter/RegisterWriter/rohm_hal2.h"
+#include "rohm-bh1790glc-driver/bh1790glc_registers.h"
+#include "rohm-bh1790glc-driver/bh1790glc.h"
 
-DigitalOut RLed(LED1);                      //Onboard Red LED = Shelf Out of Stock
-DigitalOut GLed(LED2);                      //Onboard Green LED = All OK
-DigitalOut BLed(LED3);                      //Onboard Blue LED for Wifi Tx Indication
-HCSR04 usensor1(D8,D9);                     //ECHO Pin=D9, TRIG Pin=D8
-HCSR04 usensor2(D7,D6);                     //ECHO Pin=D7, TRIG Pin=D6
+#define CloudIP "184.106.153.149"           //Raw IP Address of ThingSpeak Cloud Server
+#define SSID "SSID"
+#define Password "Password"
+
+HCSR04 usensor1(D10,D11);                   //ECHO Pin=D11, TRIG Pin=D10
 Serial pc(USBTX,USBRX);                     //Serial Communication with PC
 ESP8266 wifi(PTC17, PTC16, 115200);         //Tx Pin:PTC17; Rx Pin:PTC17; Baud rate:115200
 
-void wifi_send(void);;                      //Connect and Push Data Channel to Cloud Server
+I2C i2c(PTE25, PTE24);
+FXOS8700QAccelerometer acc(i2c, FXOS8700CQ_SLAVE_ADDR1);    // Configured for the FRDM-K64F with onboard sensors
+FXOS8700QMagnetometer mag(i2c, FXOS8700CQ_SLAVE_ADDR1);
+FXAS21000 gyro(D14,D15);
+
+I2C i2chm(I2C_SDA, I2C_SCL);
+RegisterWriter i2c_rw(i2chm);
+BH1790GLC bh1790glc(i2c_rw);
+
+DigitalOut buzzer(D7);
+
+int on = 1, off = 0; 
+
+void wifi_send(void);               //Connect and Push Data Channel to Cloud Server
+void US_Sensor(void);               //Take ultrasonic measurement and send to cloud
+void Acc_Mag_Gyro(void);            //Take measurements from acceleromter, magnetometer, and gyroscope and send to cloud
+void Heart_Monitor(void);              
 
 int num = 0;
-int distance1, distance2;
-float dist_remaining1, dist_percent1, dist_remaining2, dist_percent2;
-char snd[255],rcv[1000];                    //snd: send command to ESP8266
-                                            //rcv: receive response from ESP8266
+char snd[255],rcv[1000];                    //snd: send command to ESP8266, rcv: receive response from ESP8266
+    
+//Ultrasonic sensor variable
+int distance1 = 100;
+    
+//acc, mag, and gryo variables
+float gyro_data[3];
+motion_data_units_t acc_data, mag_data;
+motion_data_counts_t acc_raw, mag_raw;
+float faX, faY, faZ, fmX, fmY, fmZ, tmp_float;
+int16_t raX, raY, raZ, rmX, rmY, rmZ, tmp_int;
+
+//heart monitor variables
+bool interval_elapsed;
+Ticker ticker;
+uint16_t data[2];
+
+void timer_isr()
+{
+    interval_elapsed = true;
+}
 
 int main()
 {
+    buzzer = off;
     pc.baud(115200);                        //Baud Rate of 115200 for Tera Term
     
-    pc.printf("########  ######  ####  ######      ######  ##    ##  ######  ######## ######## ##     ##\n\r");
-    pc.printf("##       ##    ##  ##  ##    ##    ##    ##  ##  ##  ##    ##    ##    ##       ###   ###\n\r");
-    pc.printf("##       ##        ##  ##          ##         ####   ##          ##    ##       #### ####\n\r");
-    pc.printf("######   ##        ##   ######      ######     ##     ######     ##    ######   ## ### ##\n\r");
-    pc.printf("##       ##        ##        ##          ##    ##          ##    ##    ##       ##     ##\n\r");
-    pc.printf("##       ##    ##  ##  ##    ##    ##    ##    ##    ##    ##    ##    ##       ##     ##\n\r");
-    pc.printf("########  ######  ####  ######      ######     ##     ######     ##    ######## ##     ##\n\r");
-    pc.printf("-----------------------------------------------------------------------------------------\n\r");
-    pc.printf("Developed By: Priyank Kalgaonkar\n\r");
-    pc.printf("-----------------------------------------------------------------------------------------\n\r\n\r");
+    acc.enable();
+    mag.enable();
+
+    pc.baud(115200);
+    i2c.frequency(400000);
+    
+    int error;
+
+    wait(0.1);
+
+    do
+    { //until init OK.
+        error = bh1790glc.set_default_on();
+        wait_ms(500);
+        wait_ms(200);
+    }
+    while (error);
+    
+    bh1790glc.set_default_on();
+    
+    interval_elapsed = false;
+    ticker.attach(&timer_isr, 0.03125);                 //32Hz
     
     pc.printf("Initial Setup\r\n");
     wifi.SetMode(1);                        //Set ESP mode to 1
@@ -46,10 +91,10 @@
     pc.printf("%s\r", rcv);
 
     pc.printf("Connecting to WiFi\r\n");    //AP Setup Initialization
-    wifi.Join("Z", "12345678");//Put your Wifi SSID followed by Password WiFi_SSID WiFi_Password
+    wifi.Join(SSID, Password);              //Put your Wifi SSID followed by Password
     wifi.RcvReply(rcv, 1000);
     pc.printf("%s\n", rcv);
-    wait(8);
+    wait(2);
     
     wifi.GetIP(rcv);                        //Obtains an IP address from the AP
     
@@ -57,10 +102,7 @@
     {
         wifi_send();
         
-        RLed = 1;
-        GLed = 1;
-        BLed = 0;
-        wait(2.0f);
+        wait(1.0f);
     }
 }
 
@@ -69,63 +111,241 @@
     while(num<1000000000000)
     {
         num=num+1;
-        pc.printf("\nCloud Sync Instance #: %d\n\r", num);
-        pc.printf("Syncing Data with Cloud, Please Wait.\n\r");
+        pc.printf("\nSyncing to Thingspeak #: %d\n\r", num);
+        
+        US_Sensor();
+        
+        Acc_Mag_Gyro();     
         
+        Heart_Monitor();
+    }
+}
+
+void US_Sensor(void)
+{
     //Ultrasound Sensor (HC-SR04) #1 Initialization
-        int a = 30;
-        usensor1.start();
-        wait_ms(500);
+    usensor1.start();
+    wait_ms(100);
         
     //Calculating Distance Percentage Remaining for Sensor # 1
-        distance1 = usensor1.get_dist_cm();
-        dist_remaining1 = a-distance1;
-        dist_percent1 = (dist_remaining1/30)*100;
-        
-    //LED and Tera Term Output
-        if (distance1<30 && distance2<30) {
-            RLed = 1;
-            BLed = 1;
-            GLed = 0;
-            //printf("Percent remaining: %f\r", dist_percent1 && dist_percent2);
-        } else {
-            GLed = 1;
-            BLed = 1;
-            RLed = 0;
-            printf("Shelves Empty! Replenish Stock.\n\r");
-        }    
+    distance1 = usensor1.get_dist_cm();
         
     //Sending Data to the Cloud Server via ESP8266 WiFi Module
-        strcpy(snd,"AT+CIPMUX=0\n\r");        //AT+CIPMUX: Enabling Single Channel Mode
-        wifi.SendCMD(snd);
-        wait(1);
-        wifi.RcvReply(rcv, 1000);
-        wait(1);
+    strcpy(snd,"AT+CIPMUX=0\n\r");        //AT+CIPMUX: Enabling Single Channel Mode
+    wifi.SendCMD(snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
         
     //Establish TCP connection w/ Cloud Server
-        sprintf(snd,"AT+CIPSTART=4,\"TCP\",\"%s\",80\n",CloudIP);
-        wait(1);
-        wifi.RcvReply(rcv, 1000);
-        wait(1);
+    sprintf(snd,"AT+CIPSTART=4,\"TCP\",\"%s\",80\n",CloudIP);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
+        
+    //Set length of the data that will be sent
+    strcpy(snd,"AT+CIPSEND=100\n\r");
+    wifi.SendCMD(snd);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
+        
+    //Pushing the data acquired from HC-SR04 Ultrasonic Sensor to Cloud Server via API
+    sprintf(snd,"\rhttps://api.thingspeak.com/update?api_key=MR7SIH7MSC5KIIH0&field1=%d\r", distance1);
+    printf("Distance from Object: %dcm\n\r", distance1);
+    
+    
+    
+    if(distance1 < 6)
+    {
+        buzzer = on;
+        wait(.3);
+        buzzer = off;
+        wait(0.3);
+        buzzer = on;
+        wait(0.3);
+        buzzer = off;
+        wait(0.3);
+        buzzer = on;
+        wait(0.3);
+        buzzer = off;
+    }
+    
+    wifi.SendCMD(snd);
+    pc.printf("%s\r",snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);    
+}
+
+void Acc_Mag_Gyro(void)
+{
+    //counts based results
+    acc.getAxis(acc_raw);
+    mag.getAxis(mag_raw);
+    acc.getX(raX);
+    acc.getY(raY);
+    acc.getZ(raZ);
+    mag.getX(rmX);
+    mag.getY(rmY);
+    mag.getZ(rmZ);
+            
+    //unit based results
+    acc.getAxis(acc_data);
+    mag.getAxis(mag_data);
+    acc.getX(faX);
+    acc.getY(faY);
+    acc.getZ(faZ);
+    mag.getX(fmX);
+    mag.getY(fmY);
+    mag.getZ(fmZ);
+    pc.printf("Acellerometer: X=%1.4fY=%1.4fZ=%1.4f\n\r", acc.getX(faX),acc.getY(faY),acc.getZ(faZ));
+    pc.printf("Magnetometer: X=%4.1fY=%4.1fZ=%4.1f\n\r", mag.getX(fmX),mag.getY(fmY), mag.getZ(fmZ));
+    gyro.ReadXYZ(gyro_data);
+    pc.printf("Gyro: X=%6.2f Y=%6.2f Z=%6.2f\n\r", gyro_data[0],gyro_data[1], gyro_data[2]);
+    wait(0.5f);
+            
+    //Sending Data to the Cloud Server via ESP8266 WiFi Module
+    strcpy(snd,"AT+CIPMUX=0\n\r");        //AT+CIPMUX: Enabling Single Channel Mode
+    wifi.SendCMD(snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
+        
+    //Establish TCP connection w/ Cloud Server
+    sprintf(snd,"AT+CIPSTART=4,\"TCP\",\"%s\",80\n",CloudIP);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
         
     //Set length of the data that will be sent
-        strcpy(snd,"AT+CIPSEND=100\n\r");
-        wifi.SendCMD(snd);
-        pc.printf("%s\r", rcv);
-        wait(1);
-        wifi.RcvReply(rcv, 1000);
-        pc.printf("%s\r", rcv);
-        wait(1);
+    strcpy(snd,"AT+CIPSEND=100\n\r");
+    wifi.SendCMD(snd);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
         
-    //Pushing the data acquired from HC-SR04 Ultrasonic Sensor to Cloud Server via API
-    //Replace with your own API Request - Write a Channel Feed below
-        pc.printf("Product X - Sensor 1: \n\r");
-        sprintf(snd,"\r ***Replace with your own API Request - Write a Channel Feed below*** \r", dist_percent1);
-        printf("Percent Stock X Remaining: %f\n\r", dist_percent1);
-        wifi.SendCMD(snd);
-        pc.printf("%s\r",snd);
-        wait(0.5);
-        wifi.RcvReply(rcv, 1000);
-        pc.printf("%s\r", rcv);     
+    //Pushing the data acquired from Acc to Cloud Server via API
+    //Sends only X data for simplicity of testing purposes
+    sprintf(snd,"\rhttps://api.thingspeak.com/update?api_key=MR7SIH7MSC5KIIH0&field2=%f\r", acc.getX(faX));
+    printf("Current X Acceleration: %f\n\r", acc.getX(faX));
+    wifi.SendCMD(snd);
+    pc.printf("%s\r",snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);   
+    
+    //Pushing the data acquired from Mag to Cloud Server via API
+    //Sends only X data for simplicity of testing purposes
+    sprintf(snd,"\rhttps://api.thingspeak.com/update?api_key=MR7SIH7MSC5KIIH0&field3=%f\r", mag.getX(fmX));
+    printf("Current X Position: %f\n\r", mag.getX(fmX));
+    wifi.SendCMD(snd);
+    pc.printf("%s\r",snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv); 
+    
+    //Pushing the data acquired from Gyro to Cloud Server via API
+    //Sends only X data for simplicity of testing purposes
+    sprintf(snd,"\rhttps://api.thingspeak.com/update?api_key=MR7SIH7MSC5KIIH0&field4=%f\r", gyro_data[0]);
+    printf("Current X Orientation: %f\n\r", gyro_data[0]);
+    wifi.SendCMD(snd);
+    pc.printf("%s\r",snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);  
+}
+
+void Heart_Monitor(void)
+{
+    int i = 0;
+    int sum = 0;
+    int count = 0;
+    float average = 0;
+    int error;
+    
+    wait_ms(500);
+    
+    while(i < 10)
+        { 
+            if (interval_elapsed)       //Wait until ISR
+            {                         
+                error = bh1790glc.getresults(data);
+                
+                if (!error) 
+                {                          
+                    //get data, print to serial, update flags
+                    pc.printf("%d, \t%d\n\r", data[1], data[0]);                
+                    interval_elapsed = false;
+                    i++;
+                    sum += data[1];
+                    count++;
+                }   
+            }
+        }
+        
+        average = sum/10;
+        
+    if(average > 3500)
+    {
+        buzzer = on;
+        wait(.1);
+        buzzer = off;
+        wait(0.1);
+        buzzer = on;
+        wait(0.1);
+        buzzer = off;
+        wait(0.1);
+        buzzer = on;
+        wait(.1);
+        buzzer = off;
+        wait(0.1);
+        buzzer = on;
+        wait(0.1);
+        buzzer = off;
+        wait(0.1);
+        buzzer = on;
+        wait(.1);
+        buzzer = off;
+        wait(0.1);
+        buzzer = on;
+        wait(0.1);
+        buzzer = off;
     }
-}
\ No newline at end of file
+        
+    //Sending Data to the Cloud Server via ESP8266 WiFi Module
+    strcpy(snd,"AT+CIPMUX=0\n\r");        //AT+CIPMUX: Enabling Single Channel Mode
+    wifi.SendCMD(snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
+        
+    //Establish TCP connection w/ Cloud Server
+    sprintf(snd,"AT+CIPSTART=4,\"TCP\",\"%s\",80\n",CloudIP);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    wait(0.1);
+        
+    //Set length of the data that will be sent
+    strcpy(snd,"AT+CIPSEND=100\n\r");
+    wifi.SendCMD(snd);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);
+    wait(0.1);
+        
+    //Pushing the data acquired from heart monitor to Cloud Server via API
+    //Sends only X data for simplicity of testing purposes
+    sprintf(snd,"\rhttps://api.thingspeak.com/update?api_key=MR7SIH7MSC5KIIH0&field5=%f\r", average);
+    printf("Current average heart rate: %f\n\r", average);
+    wifi.SendCMD(snd);
+    pc.printf("%s\r",snd);
+    wait(0.1);
+    wifi.RcvReply(rcv, 1000);
+    pc.printf("%s\r", rcv);
+}

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/rohm-bh1790glc-driver.lib	Fri Apr 29 16:52:11 2022 +0000
@@ -0,0 +1,1 @@
+https://developer.mbed.org/teams/Rohm/code/rohm-bh1790glc-driver/#4446bf1de21b