     servoPitch = minPitch;  
   }
 
+  // Print out the current yaw and pitch angle values being sent to the servos.
   DPRINTSTIMER(100) {
     DPRINTSFN(15, "\tServo - Yaw:", servoYaw, 6, 1);
     DPRINTSFN(15, "\tServo - invertYaw:", invertedYaw, 6, 1);

 */
void moveServos(int servoYaw, int servoPitch) {

  //TODO: Determine if yaw/pitch is beyond normal servo angles
  //i.e. > 179 or < 0
  //If so, assume actual gyro position and provide max servo value.
  //Create trimAngles() method.
  
  //Invert Yaw
  int invertedYaw = map(servoYaw, 0, 179, 179, 0);

  //Prevent the servos from moving farther than my head can rotate.
  if (invertedYaw > maxYaw) {
    invertedYaw = maxYaw;
  }

    invertedYaw = minYaw; 
  }

  // Prevent the servos from tilting farther than my head can nod.
  if (servoPitch > maxPitch) {
    servoPitch = maxPitch;
  }
