   dataLog = SD.open("datalog.txt", FILE_WRITE);
   dataLog.print("Total time,Flight time,Accel X,Accel Y,Accel Z,Gyro X,Gyro Y,Gyro Z,Baro Press,Baro Temp,Baro Alt,Latitude,Lat Heading,Longitude,Long Heading,GPS Alt,GPS Fix,Fix Quality,Battery %");
   dataLog.close(); //Write the datalog header to the SD card (used for spreadsheet conversion)
+  digitalWrite(controlPin, HIGH);
+  digitalWrite(servoPowerPin, HIGH);
+  delay(100);
 }
 
 

      digitalWrite(statePinA, HIGH);

    digitalWrite(controlPin, LOW); //Once the output pins have been set properly, pulse the control pin to update the servo.
    delay(5);
    digitalWrite(controlPin, HIGH);

    finPosition = goal; //Update the fin state tracking variable

int finPosition = CENTER; //Since the servo moves based on increments and not absolute positions, these constants and variable are needed to track the fins' position.

bool servoPowerFlag = false;
const int servoPowerPin = 5; //Flag and pin to power on/off the servo with a transistor

const int batteryPin = 9; //Built-in power tracking pin
float batteryLevel = 100; //Battery power, in percentage
