void setup(){
Serial.begin(115200);
Wire.begin(); //gyro code
gyro.init();//gyro code
gyro.enableDefault(); //gyro code
ps.enableDefault(); //baro code
handshaken = 0;
/*accelerometer code*/
compass.init();
compass.enableDefault();
/*accelerometer code*/
/*sonar code*/
pinMode(TRIGGER_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(TRIGGER_PIN2, OUTPUT);
pinMode(ECHO_PIN2, INPUT);
pinMode(TRIGGER_PIN3, OUTPUT);
pinMode(ECHO_PIN3, INPUT);
pinMode(TRIGGER_PIN4, OUTPUT);
pinMode(ECHO_PIN4, INPUT);
pinMode(TRIGGER_PIN5, OUTPUT);
pinMode(ECHO_PIN5, INPUT);
/*sonar code*/
pinMode(MOTOR, OUTPUT);
/*
Calibration values; the default values of +/-32767 for each axis
lead to an assumed magnetometer bias of 0. Use the ACCalibrate
program to determine appropriate values for your particular unit.
*/
//compass.m_min = (LSM303::vector<int16_t>){-32767, -32767, -32767};
//compass.m_max = (LSM303::vector<int16_t>){+32767, +32767, +32767};
//LSM303::vector<int16_t> running_min = {-2872, -3215, -1742}, running_max = {+3019, +3108, +3570}; //calibration init data for compass
compass.m_min = (LSM303::vector<int16_t>){-2872, -3215, -1742};
compass.m_max = (LSM303::vector<int16_t>) {+3019, +3108, +3570};
}
void setup(){
rled = 1; gled = 1; bled = 1;
autoSD.ready_datalogger(); // Prepares a datalog filename according to index.txt
pc.printf("Index: %d\r\n",autoSD.curr_index());
if(!ps.init()){ //enable pressure sensor
pc.printf("Unable to talk to Barometer\r\n");
while(1){ rled = !rled; wait_ms(100);}
}
else{
ps.enableDefault();
}
if(!gyr.init()){
pc.printf("Unable to talk to Gyroscope\r\n");
while(1){ rled = !rled; wait_ms(100);}
}
else{
gyr.enableDefault();
}
if(!acc.init()){
pc.printf("Unable to talk to Accelerometer\r\n");
while(1){ rled = !rled; wait_ms(100);}
}
else{
acc.enableDefault();
}
fp = fopen(autoSD.filepath, "w");
if (fp == NULL) {
pc.printf("Unable to write the file \r\n");
while(1){ rled = !rled; wait_ms(100);}
}
pc.printf("Success in Set Up\r\n");
}
