Changed derivative term to be based off of gyro rate instead of differentiating theta to get angle change rate. Added deadband based on pitch.