7,6 → 7,8 |
#include "I2C.h" |
#include "L3G.h" |
#include "LSM303.h" |
#include "RN-42.h" |
#include "MAX17040.h" |
|
// <editor-fold defaultstate="collapsed" desc="Configuration Bits"> |
// CONFIG1 |
36,6 → 38,7 |
char LED_G_ON = 0; |
char LED_B_ON = 0; |
char timer_2_pwm = 0; |
char connected = 0; |
|
void Error(char ID) { |
while(1) { |
190,7 → 193,7 |
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(); |
198,23 → 201,40 |
// Initialze the sensors |
L3G_Init(); |
LSM303_Init(); |
RN42_Init(); |
MAX17040_Init(); |
|
char output[19] = {0}; |
output[18] = '\n'; |
char output[21] = {0}; |
output[20] = '\n'; |
|
// char len, buffer[30]; |
|
LED_B_ON = 1; |
|
while(1) { |
__delay_ms(10); |
|
__delay_ms(3000); |
// 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; |
// } |
// } |
|
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]); |
LSM303_Read_Magn(&output[12], &output[13], &output[14], &output[15], &output[16], &output[17]); |
// 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]); |
MAX17040_Read_Batt(&output[18], &output[19]); |
|
UART_Write((char *)&output[0], 19); |
UART_Write((char *)&output[0], 21); |
// } |
|
__delay_ms(10); |
|
// LED_B_ON = 0; |
// LED_R_ON = 1; |
// __delay_ms(250); |