message: Add files via upload
  Finished forward pitch
diff: @@ -44,7 +44,9 @@ public class LaunchPidController {
  u[0] = _Kp_dz * dzError + _Ki_dz * _integralError;
  // If time is between five and six seconds, set pitch to a very small value (.001)
  -
  + if (5<t && t<6){
  + u[2] = u[2] += .001;
  + }
  // Track previous time for dt
  tprev = t;
  