Diff: accelerometer.cpp

Revision:

0:e36d80703ed0

diff -r 000000000000 -r e36d80703ed0 accelerometer.cpp
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/accelerometer.cpp	Mon Feb 27 06:12:23 2017 +0000
@@ -0,0 +1,325 @@
+
+#include "mbed.h"
+#include "obd_libraries.h"
+#include "accelerometer.h"
+#include "common_definitions.h"
+
+#define IDLE    0
+#define ACTIVE  1
+
+I2C i2c(PB_9, PB_8);
+Serial pc(USBTX, USBRX);
+
+InterruptIn double_tap(PC_1);      // Pin assignment may vary
+InterruptIn inactivity(PC_0);      // Pin assignment may vary
+
+DigitalOut led(LED1);
+
+// INTERFACING ADXL345 ACCELEROMETER USING I2C 
+
+/*
+
+NOTE :
+Due to communication speed limitations, the maximum output
+data rate when using 400 kHz I2C is 800 Hz and scales linearly with
+a change in the I2C communication speed
+
+*/
+
+//InterruptIn activity(PB_0);  // Button B1 (Blue)
+
+
+
+const int slave_address_acc = 0xA6;
+char axis_data[6] = {0,0,0,0,0,0};
+int16_t x_axis, y_axis, z_axis;
+char interrupt_source[2];
+char axis_data_start_address[2];
+char intr_source_address[2] = {0x30, 0};
+char all_interrupt_clear_command[2] = {0x2E, 0x00};
+char all_interrupt_enable_command[2] = {0x2E, 0x18};
+char activity_interrupt_disable_command[2] = {0x2E, 0x28};
+char inactivity_interrupt_disable_command[2] = {0x2E, 0x30};
+char accelerometer_status_registered = 0;
+unsigned int interrupt_source_duplicate;
+
+char previous_state = 0;
+char current_state = 0;
+
+extern long vehicle_speed;
+char current_speed, previous_speed;
+char speed_threshold = 10;
+
+//----------------------------------------------------------------------------------------------------------
+
+void char_to_int(char data_fetched)
+{
+    unsigned int shifter;
+    
+    interrupt_source_duplicate = 0x00;
+    
+        for(shifter = 0; shifter < 8; shifter++)
+        {
+            interrupt_source_duplicate |= (((data_fetched >> shifter) & 0x01) << shifter); // Converts char data into unsigned int
+        }   
+}
+
+//----------------------------------------------------------------------------------------------------------
+
+void print_data_bits(char data_fetched)
+{
+    unsigned int shifter;
+    
+        for(shifter = 0; shifter < 8; shifter++)
+        {
+            pc.printf("%d",((data_fetched&0x80)>>7));
+            data_fetched = data_fetched << 1;
+        }
+        pc.printf("\r\n\r\n");       
+}
+
+//----------------------------------------------------------------------------------------------------------
+
+/*----------------------------------------------------------------------------------------------------------
+
+                AS FAR NOW, ONE INTERRUPT PIN (INT1) OF ACCELEROMETER IS NOT WORKING
+                    USE THIS TO CUSTOMIZE ACCELEROMETER WHEN THAT PIN IS WORKING
+
+void use_me_later() {
+    char count;
+    for(count = 0; count < 10; count++)
+    {
+        led = !led;
+        wait(0.10);
+    }
+}
+----------------------------------------------------------------------------------------------------------*/
+
+void interrupt_sudden_jerk() 
+{
+    char count;
+    
+    i2c.write(slave_address_acc, all_interrupt_clear_command, 2); 
+    pc.printf("~~~ ENTERED SUDDEN JERK CONDITION ~~~\r\n\r\n");
+
+        for(count = 0; count < 2; count++)
+        {
+            led = 1;
+            wait(2);
+            led = 0;
+            wait(1);   
+        }
+
+    i2c.write(slave_address_acc, all_interrupt_enable_command, 2);
+    
+}
+
+//*********************************************************************************************************
+
+// THE FOLLWOING CODE BLOCK IS THE MULITIPLEXED ISR FOR BOTH ACTIVITY & INACTIVITY INTERRUPT
+
+void interrupt_activity_inactivity() 
+{  
+    char count;
+    
+    // The following statement disables all interrupts since no other interrupts must disturb at this point
+    
+    i2c.write(slave_address_acc, all_interrupt_clear_command, 2); 
+    
+    i2c.write(slave_address_acc, intr_source_address, 1);
+    i2c.read(slave_address_acc, interrupt_source, 1);
+    
+    char_to_int(interrupt_source[0]);   // Coverts intr_source(char) to int & stores in intr_source_d
+    
+    pc.printf("INT Source = ");
+    print_data_bits((interrupt_source_duplicate));
+
+//--------------------------------------------------------------------------------------------------------
+        
+        /* VERIFY WHETHER THE INTERRUPT IS BECAUSE OF ACTIVITY */
+
+    //if((((int)intr_source) & 0x10) == 0x10)  
+    if(interrupt_source_duplicate & 0x10)
+    {
+        /* THE FOLLOWING BLOCK IS USED JUST FOR VERIFICATION PURPOSE AND ARE NOT MANDATORY */        
+        
+        pc.printf("ENTERED ACTIVITY CONDITION\r\n\r\n");
+        for(count = 0; count < 10; count++)
+        {
+            led = !led;
+            wait(0.05);   
+        }
+/* 
+        fetch_vehicle_speed();
+        previous_speed = vehicle_speed;
+        wait(5);
+        fetch_vehicle_speed();
+        current_speed = vehicle_speed;
+        
+        //if((current_speed > previous_speed) && (current_speed > speed_threshold))   // Decision making regarding vehicle's current state
+        if(current_speed == 79)
+        {
+            i2c.write(slave_address_acc, activity_interrupt_disable_command, 2); // Disables Activity interrupt & enables Inactivity interrupt
+            pc.printf("\r\n>>> VEHICLE HAS STARTED FROM STOP <<<");
+        }
+*/
+    }
+
+//--------------------------------------------------------------------------------------------------------
+    
+      /* VERIFY WHETHER THE INTERRUPT IS BECAUSE OF INACTIVITY */
+
+    //if((((int)intr_source) & 0x08) == 0x08) // Verify whether it is inactivity interrupt
+    if(interrupt_source_duplicate & 0x08)
+    {
+        /* THE FOLLOWING BLOCK IS USED JUST FOR VERIFICATION PURPOSE AND ARE NOT MANDATORY */
+
+        pc.printf("ENTERED INACTIVITY CONDITION \r\n\r\n");
+        for(count = 0; count < 10; count++)
+        {
+            led = !led;
+            wait(0.2);
+        }  
+/*
+        fetch_vehicle_speed();
+        
+        if(vehicle_speed == 0)  // Decision making regarding vehicle's current state
+        {
+            i2c.write(slave_address_acc, inactivity_interrupt_disable_command, 2);  // Disables Inactivity interrupt & enables Activity interrupt
+            pc.printf("\r\n>>> VEHICLE HAS STOPPED FROM START <<<");
+        }     
+*/
+    }
+
+}
+
+//*********************************************************************************************************
+
+void initialize_accelerometer()
+{
+    inactivity.rise(interrupt_activity_inactivity); // Attach the address of interrupt_activity_inactivity function to rising edge
+    double_tap.rise(interrupt_sudden_jerk);
+    pc.baud(38400);
+    
+    char cmd[2], cmd2[2], cmd3[5], cmd4[8], cmd5[3], cmd6[2], cmd7[2], cmd8[2];
+    
+    
+    
+/* THE FOLLOWING GROUP OF COMMAND VARIABLES STORES THE CONFIGURATION VALUES TO BE WRITTEN TO THE ADXL345 ACCELEROMETER */    
+    
+    cmd[0] = 0x2D;      // Post the Register address of the slave (Have to write this into slave)
+    cmd[1] = 0x08;      // Turn ON the Measure Bit
+    
+    cmd3[0] = 0x1D;     // Threshold Tap Register address
+    cmd3[1] = 100;       // Threshold tap Register value
+    cmd3[2] = 0x7F;     // Offset - X axis
+    cmd3[3] = 0x7F;     // Offset - Y axis
+    cmd3[4] = 0x05;     // Offset - Z axis
+    
+    
+    cmd4[0] = 0x21;     // DUR Register address
+    cmd4[1] = 0x15;     // DUR Register value providing maximum time to be held to generate an interrupt
+    cmd4[2] = 0x15;     // Latent
+    cmd4[3] = 0x45;     // Window Time
+    cmd4[4] = 64;       // THRES_ACT register value 62.5mg/LSB , therfore value 32 indicates 2g activity
+    cmd4[5] = 50;       // THRES_INACT Register 
+    cmd4[6] = 5;        // TIME_INACT Register, making inactivity detection time = 5 secs
+    cmd4[7] = 0x77;     // Activity, Inactivity detection enabled for all axis
+    
+    cmd5[0] = 0x2E;     // INT Enable Register address
+    //cmd5[1] = 0x74;   // INT Enable Register value enabling Single Tap, Double Tap, Activity and Free Fall detection
+    //cmd5[2] = 0x00;   // INT Map Register value mapping Single Tap event to INT1
+    //cmd5[1] = 0x20;   // Enabling only the double tap interrupt
+    //cmd5[2] = 0x20;   // Mapping the double tap interrupt to INT2 pin
+    //cmd5[1] = 0x10;   // Enabling only the activity interrupt
+    //cmd5[2] = 0x10;   // Mapping the sctivity interrupt to the INT2 pin
+    //cmd5[1] = 0x08;   // Enabling only the inactivity interrupt
+    //cmd5[2] = 0x08;   // Mapping the Inactivity interrupt to the INT2 pin
+    cmd5[1] = 0x38;     // Enabling Activity & inactivity interrupt
+    cmd5[2] = 0xDF;     // Activity--->INT1 & Inactivity--->INT2
+    
+    
+    cmd6[0] = 0x2A;     // Address of the TAP_AXES Register
+    cmd6[1] = 0x06;     // X & Y axis participate in tap detection
+    
+    cmd7[0] = 0x28;     // Address of the Threshold register for Free Fall detection
+    cmd7[1] = 0x07;     // Recommeded value : 0x05 to 0x09 Refer datasheet
+    
+    cmd8[0] = 0x2C;     // Address of the BW RATE register
+    cmd8[1] = 0x0D;     // Increased the data rate to 800Hz, default is 0x0A indicating 100Hz
+            
+    cmd2[0] = 0x31;     // Data format register address
+    cmd2[1] = 0x04;     // Making the acceleration data as left justified
+    
+    axis_data_start_address[0] = 0x32;
+    
+    
+    
+    i2c.write(slave_address_acc, cmd, 2);
+    i2c.write(slave_address_acc, cmd3, 5);
+    i2c.write(slave_address_acc, cmd4, 8);
+    i2c.write(slave_address_acc, cmd5, 3);
+    i2c.write(slave_address_acc, cmd6, 2);
+    i2c.write(slave_address_acc, cmd7, 2);
+    i2c.write(slave_address_acc, cmd8, 2);
+    i2c.write(slave_address_acc, cmd2, 2);
+    
+    
+    //char dev_add[2] = {0x00,0};
+    //i2c.write(slave_address_acc, dev_add, 1);
+    //i2c.read(slave_address_acc, dev_add, 1);
+    //print_data_bits(dev_add[0]);
+    
+    pc.printf("    ACCELEROMETER DATA LOG \r\n\r\n");
+    
+    while (1);
+    
+    pc.printf("\r\n CAME HERE \r\n");
+  
+  //  pc.printf("    ACCELEROMETER DATA LOG \r\n\r\n");
+  
+  //  while (1) {
+/*--------------------------------------------------------------------------------------------------------------------------------------               
+        wait(1.0);
+        pc.printf("STILL IN WHILE LOOP\r\n\r\n");       
+--------------------------------------------------------------------------------------------------------------------------------------*/
+   // wait(0.25);
+//--------------------------------------------------------------------------------------------------------------------------------------       
+
+                // USE THE FOLLOWING BLOCK TO READ THE DATA IN X-AXIS, Y-AXIS & Z-AXIS 
+    /*    
+        i2c.write(slave_address_acc, axis_data_start_address, 1);
+        i2c.read(slave_address_acc, axis_data, 6);
+               
+        x_axis = axis_data[1];  // Puts MSB data into respective axes
+        y_axis = axis_data[3];
+        z_axis = axis_data[5];
+        
+        if(x_axis & 0x80)                                           // Testing the signess of the x-axis data
+            pc.printf("X-axis_1 = %d\r\n", (((~x_axis)+1)));        // Converts 2's complement data into decimal
+        else
+            pc.printf("X-axis_0 = %d\r\n", x_axis);
+        
+        if(y_axis & 0x80)                                           // Testing the signess of the y-axis data
+            pc.printf("Y-axis_1 = %d\r\n", (((~y_axis)+1)));        // Converts 2's complement data into decimal
+        else
+            pc.printf("Y-axis_0 = %d\r\n", y_axis);
+        
+        if(z_axis & 0x80)                                           // Testing the signess of the y-axis data
+            pc.printf("Z-axis_1 = %d\r\n\r\n", (((~z_axis)+1)));    // Converts 2's complement data into decimal
+        else
+            pc.printf("Z-axis_0 = %d\r\n\r\n",z_axis);
+*/
+/*--------------------------------------------------------------------------------------------------------------------------------------      
+
+// THIS CAN BE USED WHEN THERE IS A NEED OF VERY HIGH LEVEL ACCURACY & USE INT16_T DATA TYPE
+            
+        x_axis  = (int)axis_data[1] << 8 | (int)axis_data[0];
+        y_axis  = (int)axis_data[3] << 8 | (int)axis_data[2];
+        z_axis  = (int)axis_data[5] << 8 | (int)axis_data[4];
+        
+--------------------------------------------------------------------------------------------------------------------------------------*/       
+   // }
+}
+
+