   
   MoveMotorPosSpeed(pitchMotorNumber, pitchPIDOutput,pitchMotorPower);
   MoveMotorPosSpeed(rollMotorNumber, rollPIDOutput,rollMotorPower);
- 
+
+  
+
   if(subTick % SUBTICK_FREQ == (SUBTICK_FREQ-1)){
     inputMillivolts = analogRead(A0) * BATT_INPUT_ADC_TO_MILLI_VOLTS;
-
     if(outputAngle){
       Serial.print("PRA ");
       Serial.print(pitchAngle);

    return x;
  }
}

void pin7Changed(){
  Serial.println("Changed");
}

	Gyro_getADC(); // read raw gyro data
	ACC_getADC(); // read raw accel data
  imu.calculate(gyroADC,accADC,&pitchAngle,&rollAngle);

  
  pitchAngularVelocity = gyroADC[GYRO_X_AXIS];
  rollAngularVelocity = gyroADC[GYRO_Y_AXIS];
