Diff: main.cpp

Revision:

0:c355c42bd6de

Child:

1:474dc40b688a

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Aug 23 18:11:16 2018 +0000
@@ -0,0 +1,83 @@
+#include "mbed.h"
+#include "LSM303DLHC.h"
+
+
+DigitalOut led1(LED1);
+DigitalOut led2 (LED2);
+
+
+float aax, aay, aaz, mmx, mmy, mmz, aaz_old;
+bool retval;
+EventQueue queue;
+InterruptIn free_fall(P5_1); // Free Fall Interupt asserted on pin 5_1
+
+LSM303DLHC sensor(P3_4, P3_5);  //Initialise LMS303
+
+/** Function to calculate Impact Acceleration after a Free Fall Interrupt has been Asserted **/
+void ff_proc()
+{
+double atotal;
+double TH=4;
+printf("Free Fall Interupt Asserted ..... \n");
+retval=sensor.read(&aax, &aay, &aaz, &mmx, &mmy, &mmz);
+atotal=sqrt(pow(aax,2)+pow(aay,2)+pow(aaz,2));
+printf("Total Acceleration  %f\n", atotal);
+if (atotal<TH) //Fall NOT verified
+{
+    led2=0;
+    led1=1;
+    }
+    
+}
+
+/** Free Fall Interrupt Service **/
+void ff()
+{
+// Potential Fall detected    
+    led2=1;
+    led1=0;
+    
+    queue.call(&ff_proc); //Calculate Impact Acceleration and any other thresholds to verify Free Fall Event
+}    
+
+
+
+//*******************************************************************************//
+
+// main() 
+    int main() {
+
+int flag=1;
+Thread eventThread;
+
+   led1=1;  // LED1 OFF
+   led2=1;  // LED2 OFF
+   
+ eventThread.start(callback(&queue, &EventQueue::dispatch_forever));  
+    
+    led2=0;
+        printf("Initialising LSM303DLHC ..... \n");
+        
+        retval=sensor.read(&aax, &aay, &aaz, &mmx, &mmy, &mmz);
+        if (retval==1)
+        {
+            printf("Success: LSM303DLHC Connected, Accel Values:  %3.2f%3.2f%3.2f\n", aax, aay, aaz);
+        
+          
+            
+         }
+         else {
+           printf("Failure : LSM303DLHC NOT RESPONDING................... \n");
+           flag=0;
+           }     
+        
+if (flag) {
+             
+free_fall.fall(&ff);              
+
+while(1)
+{       
+}
+
+}
+}
\ No newline at end of file