new gimbal movement algorithm