Diff: main.cpp

Revision:

0:940647793667

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Thu Sep 22 11:38:40 2016 +0000
@@ -0,0 +1,234 @@
+/* Copyright (c) 2016 Aconno. All Rights Reserved.
+ *
+ * Licensees are granted free, non-transferable use of the information. NO
+ * WARRANTY of ANY KIND is provided. This heading must NOT be removed from
+ * the file.
+ *
+ */
+
+
+#include "mbed.h"
+#include "acd52832_bsp.h"
+#include "LSM9DS1_regs.h"
+#include "LSM9DS1_defVals.h"
+#include "GDEP015OC1.h"
+
+// #define GYRO
+
+SPI spi(p3, NC, p4);
+GDEP015OC1 epd = GDEP015OC1(spi, p5, p6, p7, p8);
+
+// Initialize I2C protocol
+I2C mems(PIN_EXP_SDA, PIN_EXP_SCL);
+
+DigitalOut RED(PIN_LED_RED);
+DigitalOut GREEN(PIN_LED_GREEN);
+DigitalOut BLUE(PIN_LED_BLUE);
+DigitalOut LEDD(PIN_LED);
+
+
+void check(bool success)
+{
+    if(!success) {
+        // serial.printf("Success.\n");
+        RED = 1;
+        GREEN = 0;
+    } else {
+        // serial.printf("Unsuccess!\n");
+        RED = 0;
+        GREEN = 1;
+        wait(2);
+    }
+    wait (0.05);
+    RED = 1;
+    GREEN = 1;
+}
+
+
+
+void start_mag()
+{
+    char data[2];
+    bool success;
+
+    data[0] = (char)CTRL_REG1_M;          // Target register
+    data[1] = (char)0x7C;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+
+    data[0] = (char)CTRL_REG2_M;          // Target register
+    data[1] = (char)0x60;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+
+    data[0] = (char)CTRL_REG3_M;          // Target register
+    data[1] = (char)0x00;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+
+    data[0] = (char)CTRL_REG4_M;          // Target register
+    data[1] = (char)0x0C;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+
+    data[0] = (char)CTRL_REG5_M;          // Target register
+    data[1] = (char)0x00;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+}
+
+void read_mag(float *results){
+    char results_[6];
+    float res_final[3];
+    char out_x_l_m = OUT_X_L_M;
+    
+    check (mems.write(TWI_MAG_ADDR, &out_x_l_m, 1, true));
+    check (mems.read(TWI_MAG_ADDR, results_, 6, 0));
+    res_final[0] = ((results_[1]<<8) | results_[0]);
+    res_final[1] = ((results_[3]<<8) | results_[2]);
+    res_final[2] = ((results_[5]<<8) | results_[4]);
+    
+    *(results) = res_final[0];
+    *(results + 1) = res_final[1];
+    *(results + 2) = res_final[2];
+}
+
+void start_acc()
+{
+    char data[2];
+    bool success;
+    
+    data[0] = (char)CTRL_REG5_XL;          // Target register
+    data[1] = (char)0x38;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+    data[0] = (char)CTRL_REG6_XL;          // Target register
+    data[1] = (char)0xC7;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+}
+
+void read_acc(float *results){
+    char results_[6];
+    float res_final[3];
+    char out_x_l_xl = OUT_X_L_XL;
+    
+    check (mems.write(TWI_MAG_ADDR, &out_x_l_xl, 1, true));
+    check (mems.read(TWI_MAG_ADDR, results_, 6, 0));
+    res_final[0] = ((results_[1]<<8) | results_[0]);
+    res_final[1] = ((results_[3]<<8) | results_[2]);
+    res_final[2] = ((results_[5]<<8) | results_[4]);
+    
+    *(results) = res_final[0];
+    *(results + 1) = res_final[1];
+    *(results + 2) = res_final[2];
+}
+
+void start_gyro(){
+    char data[2];
+    bool success;
+    
+    // If GYRO is defines (gyro enabled)
+    #ifdef GYRO
+        data[0] = (char)CTRL_REG6_XL;                  // Target register
+        data[1] = (char)0xC7 & (char)0x1F;             // Data to write
+        success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+        check(success);
+    #endif
+    
+    data[0] = (char)CTRL_REG1_G;          // Target register
+    data[1] = (char)0xC0;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+    data[0] = (char)CTRL_REG2_G;          // Target register
+    data[1] = (char)0x00;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+    data[0] = (char)CTRL_REG3_G;          // Target register
+    data[1] = (char)0x00;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+    data[0] = (char)CTRL_REG4;            // Target register
+    data[1] = (char)0x3A;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+    
+    data[0] = (char)ORIENT_CFG_G;          // Target register
+    data[1] = (char)0x00;                 // Data to write
+    success = mems.write(TWI_MAG_ADDR, data, 0x02,0);
+    check(success);
+}
+
+void read_gyro(float *results){
+    char results_[6];
+    float res_final[3];
+    char out_x_l_g = OUT_X_L_G;
+    
+    check (mems.write(TWI_MAG_ADDR, &out_x_l_g, 1, true));
+    check (mems.read(TWI_MAG_ADDR, results_, 6, 0));
+    res_final[0] = ((results_[1]<<8) | results_[0]);
+    res_final[1] = ((results_[3]<<8) | results_[2]);
+    res_final[2] = ((results_[5]<<8) | results_[4]);
+    
+    *(results) = res_final[0];
+    *(results + 1) = res_final[1];
+    *(results + 2) = res_final[2];
+}
+
+
+int main()
+{
+    float old_res = 0;
+    float results[3];
+    char buffer[6];
+
+    // Clear LEDs
+    RED = 1;
+    GREEN = 1;
+    
+    // Start acceleration sensor
+    start_acc();
+
+    while (1) {        
+        // Get data from mag sensor
+        read_acc(results);
+        
+        if (*results != old_res) {
+            // Write new value on display
+            epd.empty();
+            epd.write();
+            
+            // Write mag_x
+            sprintf(buffer, "%+2.1f", *results);    //Create a string
+            epd.writeString(buffer,85,70,0);                                       //Write new data to the buffer
+            epd.write();
+            
+            // Write mag_y
+            sprintf(buffer, "%+2.1f", *(results+1));    //Create a string
+            epd.writeString(buffer,85,80,0);                                       //Write new data to the buffer
+            epd.write();
+            
+            // Write mag_z
+            sprintf(buffer, "%+2.1f", *(results+2));    //Create a string
+            epd.writeString(buffer,85,90,0);                                       //Write new data to the buffer
+            epd.write();
+
+            old_res = *results;
+            BLUE = 0;
+            wait (1);
+            BLUE = 1;
+            wait(1);
+        }
+        LEDD = 0;
+        wait(1);
+        LEDD = 1;
+        wait(1);
+    }
+
+
+}
\ No newline at end of file