예제 #1
0
파일: main.cpp 프로젝트: zhamahn/quad
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");
}
예제 #2
0
파일: main.c 프로젝트: DavoudiDavoud/ali
void setup()
{
	accelemeter.init();  
	Serial.begin(9600);
}