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"); }