void setup() { debug("Starting setup"); Serial.begin(9600); mySerial.begin(9600); // Initialize classes escs.x = &esc_x; escs.nx = &esc_nx; escs.y = &esc_y; escs.ny = &esc_ny; quad.escs = &escs; quad.controller = &controller; quad.gyro = &gyro; quad.acc = &acc; quad.alt = &alt; Wire.begin(); acc.init(); gyro.init(); attachInterrupt(PING_INT, pingInterrupt, FALLING); pinMode(ESC_X_PIN, OUTPUT); pinMode(ESC_NX_PIN, OUTPUT); pinMode(ESC_Y_PIN, OUTPUT); pinMode(ESC_NY_PIN, OUTPUT); // Set all motor speeds to ESC min escs.write(OUTPUT_MIN); debug("Entering main loop"); }
void setup() { accelemeter.init(); Serial.begin(9600); }