Moved gyro controlled CG shift to PID Controller