Added 1 to the second arg for the foward flight command in forwardState(). Changed keepConnection() wait time to 30ms instead of 300ms. Added a call to keepConnection() at the end of the forwardSensorTest() function.