WebSVN – Code-Repo – Diff – /PIC Stuff/PICX_16F1829_BLE_IMU/main.c

 #include "INTERRUPT.h"
 #include "UART.h"
 #include "I2C.h"
 #include "L3G.h"
 #include "LSM303.h"
+#include "RN-42.h"
+#include "MAX17040.h"
 // <editor-fold defaultstate="collapsed" desc="Configuration Bits">
 // CONFIG1
 #pragma config FOSC = INTOSC    // Oscillator Selection (INTOSC oscillator: I/O function on CLKIN pin)
 #pragma config WDTE = OFF       // Watchdog Timer Enable (WDT disabled)
 char LED_R_ON = 0;
 char LED_G_ON = 0;
 char LED_B_ON = 0;
 char timer_2_pwm = 0;
+char connected = 0;
 void Error(char ID) {
     while(1) {
         for (char i = 0; i < ID; i++) {
             LED_R_ON = 1;
     INTERRUPT_Enable();
 //    TIMER_1_Start();
     TIMER_2_Start();
     // A small delay is needed for the sensors to start up
-    __delay_ms(10);
+    __delay_ms(1000);
     // Run a check to ensure that all sensors are properly connected
     Startup_Check();
     // Initialze the sensors
     L3G_Init();
     LSM303_Init();
+    RN42_Init();
+    MAX17040_Init();
-    char output[19] = {0};
+    char output[21] = {0};
-    output[18] = '\n';
+    output[20] = '\n';
-    LED_B_ON = 1;
-    __delay_ms(3000);
+//    char len, buffer[30];
+    LED_B_ON = 1;
     while(1) {
-        LSM303_Read_Accl(&output[0], &output[1], &output[2], &output[3], &output[4], &output[5]);
-        L3G_Read_Gyro(&output[6], &output[7], &output[8], &output[9], &output[10], &output[11]);
+        __delay_ms(10);
-        LSM303_Read_Magn(&output[12], &output[13], &output[14], &output[15], &output[16], &output[17]);
+//        len = UART_Read(buffer);
+//        if (len != 0) {
+//            if (!strncmp(buffer, "!CONNECT", 8)) {
+//                connected = 1;
+//                LED_G_ON = 1;
+//            }
+//            if (!strncmp(buffer, "!DISCONNECT", 11)) {
+//                connected = 0;
+//                LED_G_ON = 0;
+//            }
+//        }
+//        if (connected) {
+            LSM303_Read_Accl(&output[0], &output[1], &output[2], &output[3], &output[4], &output[5]);
+            L3G_Read_Gyro(&output[6], &output[7], &output[8], &output[9], &output[10], &output[11]);
+            LSM303_Read_Magn(&output[12], &output[13], &output[14], &output[15], &output[16], &output[17]);
-        UART_Write((char *)&output[0], 19);
+            MAX17040_Read_Batt(&output[18], &output[19]);
-        __delay_ms(10);
+            UART_Write((char *)&output[0], 21);
+//        }
 //        LED_B_ON = 0;
 //        LED_R_ON = 1;
 //        __delay_ms(250);
 //        LED_R_ON = 0;

Subversion Repositories Code-Repo

(root)/PIC Stuff/PICX_16F1829_BLE_IMU/main.c @ 224 – Rev 223 → 224