dfm-python 0.1.0__py3-none-any.whl

dfm_python/kalman.py

@@ -0,0 +1,403 @@
+"""Kalman filter and fixed-interval smoother implementation."""
+
+import numpy as np
+from scipy.linalg import inv, pinv
+from typing import Tuple, Dict
+from dataclasses import dataclass
+import logging
+
+# Set up logger (optional - only if logging is enabled)
+_logger = logging.getLogger(__name__)
+if not _logger.handlers:
+    # Only configure if logging is enabled (avoid overhead if disabled)
+    root_logger = logging.getLogger()
+    if root_logger.level <= logging.WARNING:
+        _logger.setLevel(logging.WARNING)
+        handler = logging.StreamHandler()
+        handler.setFormatter(logging.Formatter(
+            '%(asctime)s - %(name)s - %(levelname)s - %(message)s',
+            datefmt='%Y-%m-%d %H:%M:%S'
+        ))
+        _logger.addHandler(handler)
+
+
+@dataclass
+class KalmanFilterState:
+    """Kalman filter state structure."""
+    Zm: np.ndarray      # Prior/predicted factor state (m x nobs)
+    Vm: np.ndarray      # Prior covariance (m x m x nobs)
+    ZmU: np.ndarray     # Posterior/updated state (m x (nobs+1))
+    VmU: np.ndarray     # Posterior covariance (m x m x (nobs+1))
+    loglik: float       # Log-likelihood
+    k_t: np.ndarray     # Kalman gain
+
+
+def miss_data(y: np.ndarray, C: np.ndarray, R: np.ndarray) -> Tuple[np.ndarray, np.ndarray, np.ndarray, np.ndarray]:
+    """Eliminate rows in y, C, R corresponding to missing data (NaN) in y.
+    
+    Parameters:
+    -----------
+    y : np.ndarray
+        Vector of observations at time t (k,)
+    C : np.ndarray
+        Observation matrix (k x m)
+    R : np.ndarray
+        Covariance for observation matrix residuals (k x k)
+        
+    Returns:
+    --------
+    y : np.ndarray
+        Reduced observation vector
+    C : np.ndarray
+        Reduced observation matrix
+    R : np.ndarray
+        Reduced covariance matrix
+    L : np.ndarray
+        Selection matrix to restore standard dimensions
+    """
+    # Returns True for nonmissing series
+    ix = ~np.isnan(y)
+    
+    # Index for columns with nonmissing variables
+    e = np.eye(len(y))
+    L = e[:, ix]
+    
+    # Remove missing series
+    y = y[ix]
+    
+    # Remove missing series from observation matrix
+    C = C[ix, :]
+    
+    # Remove missing series from covariance matrix
+    R = R[np.ix_(ix, ix)]
+    
+    return y, C, R, L
+
+
+def skf(Y: np.ndarray, A: np.ndarray, C: np.ndarray, Q: np.ndarray, 
+        R: np.ndarray, Z_0: np.ndarray, V_0: np.ndarray) -> KalmanFilterState:
+    """Apply Kalman filter (forward pass).
+    
+    Parameters:
+    -----------
+    Y : np.ndarray
+        Input data (k x nobs), where k = number of series, nobs = time periods
+    A : np.ndarray
+        Transition matrix (m x m)
+    C : np.ndarray
+        Observation matrix (k x m)
+    Q : np.ndarray
+        Covariance for transition equation residuals (m x m)
+    R : np.ndarray
+        Covariance for observation matrix residuals (k x k)
+    Z_0 : np.ndarray
+        Initial state vector (m,)
+    V_0 : np.ndarray
+        Initial state covariance matrix (m x m)
+        
+    Returns:
+    --------
+    KalmanFilterState
+        Filter state with prior and posterior estimates
+    """
+    # Dimensions
+    k, nobs = Y.shape  # k series, nobs time periods
+    m = C.shape[1]     # m factors
+    
+    # Initialize output
+    Zm = np.full((m, nobs), np.nan)       # Z_t | t-1 (prior)
+    Vm = np.full((m, m, nobs), np.nan)    # V_t | t-1 (prior)
+    ZmU = np.full((m, nobs + 1), np.nan)  # Z_t | t (posterior/updated)
+    VmU = np.full((m, m, nobs + 1), np.nan)  # V_t | t (posterior/updated)
+    loglik = 0.0
+    
+    # Set initial values
+    Zu = Z_0.copy()  # Z_0|0 (In loop, Zu gives Z_t | t)
+    Vu = V_0.copy()  # V_0|0 (In loop, Vu gives V_t | t)
+    
+    # Store initial values
+    ZmU[:, 0] = Zu
+    VmU[:, :, 0] = Vu
+    
+    # Kalman filter procedure
+    for t in range(nobs):
+        # Calculate prior distribution
+        # Use transition equation to create prior estimate for factor
+        # i.e. Z = Z_t|t-1
+        # Check for NaN/Inf in inputs
+        if np.any(np.isnan(Zu)) or np.any(np.isinf(Zu)):
+            _logger.warning(f"skf: Zu contains NaN/Inf at t={t}, resetting to zeros")
+            Zu = np.zeros_like(Zu)
+        
+        Z = A @ Zu
+        
+        # Check for NaN/Inf in Z
+        if np.any(np.isnan(Z)) or np.any(np.isinf(Z)):
+            _logger.warning(f"skf: Z contains NaN/Inf at t={t}, using previous Zu")
+            Z = Zu.copy()
+        
+        # Prior covariance matrix of Z (i.e. V = V_t|t-1)
+        # Var(Z) = Var(A*Z + u_t) = Var(A*Z) + Var(u) = A*Vu*A' + Q
+        V = A @ Vu @ A.T + Q
+        V = 0.5 * (V + V.T)  # Trick to make symmetric
+        
+        # Numerical stability: ensure V is positive semi-definite
+        # Add small regularization if needed
+        try:
+            eigenvals = np.linalg.eigvals(V)
+            min_eigenval = np.min(eigenvals)
+            if min_eigenval < 1e-8:
+                # Add regularization to ensure positive semi-definiteness
+                V = V + np.eye(V.shape[0]) * (1e-8 - min_eigenval)
+                V = 0.5 * (V + V.T)  # Re-symmetrize
+        except (np.linalg.LinAlgError, ValueError):
+            # Eigendecomposition failed - add small regularization
+            V = V + np.eye(V.shape[0]) * 1e-8
+            V = 0.5 * (V + V.T)
+        
+        # Check for NaN/Inf
+        if np.any(np.isnan(V)) or np.any(np.isinf(V)):
+            # Fallback: use previous covariance with regularization
+            V = Vu + np.eye(V.shape[0]) * 1e-6
+            V = 0.5 * (V + V.T)
+        
+        # Calculate posterior distribution
+        # Remove missing series: These are removed from Y, C, and R
+        Y_t, C_t, R_t, _ = miss_data(Y[:, t], C, R)
+        
+        # Check if y_t contains no data
+        if len(Y_t) == 0:
+            Zu = Z
+            Vu = V
+        else:
+            # Steps for variance and population regression coefficients:
+            # Var(c_t*Z_t + e_t) = c_t Var(Z) c_t' + Var(e) = c_t*V*c_t' + R
+            VC = V @ C_t.T
+            
+            # Compute innovation covariance F = C_t @ V @ C_t.T + R_t
+            F = C_t @ VC + R_t
+            F = 0.5 * (F + F.T)  # Ensure symmetry
+            
+            # Numerical stability: regularize F if needed
+            try:
+                F_eigenvals = np.linalg.eigvals(F)
+                min_F_eigenval = np.min(F_eigenvals)
+                if min_F_eigenval < 1e-8:
+                    F = F + np.eye(F.shape[0]) * (1e-8 - min_F_eigenval)
+                    F = 0.5 * (F + F.T)
+            except (np.linalg.LinAlgError, ValueError):
+                F = F + np.eye(F.shape[0]) * 1e-8
+                F = 0.5 * (F + F.T)
+            
+            # Check for NaN/Inf before inversion
+            if np.any(np.isnan(F)) or np.any(np.isinf(F)):
+                # Fallback: use identity with large variance
+                F = np.eye(F.shape[0]) * 1e6
+                _logger.warning(f"skf: F matrix contains NaN/Inf at t={t}, using fallback")
+            
+            try:
+                iF = inv(F)
+            except (np.linalg.LinAlgError, ValueError) as e:
+                # Matrix inversion failed - use pseudo-inverse with regularization
+                F_reg = F + np.eye(F.shape[0]) * 1e-6
+                iF = pinv(F_reg)
+                _logger.warning(f"skf: F inversion failed at t={t}, using pinv: {type(e).__name__}")
+            
+            # Matrix of population regression coefficients (Kalman gain)
+            VCF = VC @ iF
+            
+            # Difference between actual and predicted observation matrix values
+            innov = Y_t - C_t @ Z
+            
+            # Check for NaN/Inf in innovation
+            if np.any(np.isnan(innov)) or np.any(np.isinf(innov)):
+                _logger.warning(f"skf: Innovation contains NaN/Inf at t={t}, skipping update")
+                Zu = Z
+                Vu = V
+            else:
+                # Update estimate of factor values (posterior)
+                Zu = Z + VCF @ innov
+                
+                # Clean NaN/Inf only (remove excessive clipping during iterations)
+                if np.any(~np.isfinite(Zu)):
+                    Zu = np.nan_to_num(Zu, nan=0.0, posinf=0.0, neginf=0.0)
+                
+                # Update covariance matrix (posterior) for time t
+                Vu = V - VCF @ VC.T
+                Vu = 0.5 * (Vu + Vu.T)  # Approximation trick to make symmetric
+                
+                # Clean NaN/Inf only (keep regularization for PSD)
+                if np.any(~np.isfinite(Vu)):
+                    Vu = np.nan_to_num(Vu, nan=1e-8, posinf=1e6, neginf=1e-8)
+                
+                # Ensure Vu is positive semi-definite
+                try:
+                    Vu_eigenvals = np.linalg.eigvals(Vu)
+                    min_Vu_eigenval = np.min(Vu_eigenvals)
+                    if min_Vu_eigenval < 1e-8:
+                        Vu = Vu + np.eye(Vu.shape[0]) * (1e-8 - min_Vu_eigenval)
+                        Vu = 0.5 * (Vu + Vu.T)
+                except (np.linalg.LinAlgError, ValueError):
+                    Vu = Vu + np.eye(Vu.shape[0]) * 1e-8
+                    Vu = 0.5 * (Vu + Vu.T)
+                
+                # Check for NaN/Inf in Vu
+                if np.any(np.isnan(Vu)) or np.any(np.isinf(Vu)):
+                    _logger.warning(f"skf: Vu contains NaN/Inf at t={t}, using V as fallback")
+                    Vu = V.copy()
+                
+                # Update log-likelihood (with safeguards)
+                try:
+                    det_iF = np.linalg.det(iF)
+                    if det_iF > 0 and np.isfinite(det_iF):
+                        log_det = np.log(det_iF)
+                        innov_term = innov.T @ iF @ innov
+                        if np.isfinite(innov_term):
+                            loglik += 0.5 * (log_det - innov_term)
+                        else:
+                            _logger.debug(f"skf: innov_term not finite at t={t}, skipping loglik update")
+                    else:
+                        _logger.debug(f"skf: det(iF) <= 0 or not finite at t={t}, skipping loglik update")
+                except (np.linalg.LinAlgError, ValueError, OverflowError):
+                    _logger.debug(f"skf: Log-likelihood calculation failed at t={t}")
+        
+        # Store output
+        # Store covariance and observation values for t (priors)
+        Zm[:, t] = Z
+        Vm[:, :, t] = V
+        
+        # Store covariance and state values for t (posteriors)
+        # i.e. Zu = Z_t|t   & Vu = V_t|t
+        ZmU[:, t + 1] = Zu
+        VmU[:, :, t + 1] = Vu
+    
+    # Store Kalman gain k_t (from final iteration)
+    if len(Y_t) == 0:
+        k_t = np.zeros((m, m))
+    else:
+        k_t = VCF @ C_t
+    
+    return KalmanFilterState(Zm=Zm, Vm=Vm, ZmU=ZmU, VmU=VmU, loglik=loglik, k_t=k_t)
+
+
+def fis(A: np.ndarray, S: KalmanFilterState) -> KalmanFilterState:
+    """Apply fixed-interval smoother (backward pass).
+    
+    Parameters:
+    -----------
+    A : np.ndarray
+        Transition matrix (m x m)
+    S : KalmanFilterState
+        State from Kalman filter (SKF)
+        
+    Returns:
+    --------
+    KalmanFilterState
+        State with smoothed estimates added (ZmT, VmT, VmT_1)
+    """
+    m, nobs = S.Zm.shape
+    
+    # Initialize output matrices
+    ZmT = np.zeros((m, nobs + 1))
+    VmT = np.zeros((m, m, nobs + 1))
+    
+    # Fill the final period of ZmT, VmT with SKF posterior values
+    ZmT[:, nobs] = S.ZmU[:, nobs]
+    VmT[:, :, nobs] = S.VmU[:, :, nobs]
+    
+    # Initialize VmT_1 lag 1 covariance matrix for final period
+    VmT_1 = np.zeros((m, m, nobs))
+    VmT_1[:, :, nobs - 1] = (np.eye(m) - S.k_t) @ A @ S.VmU[:, :, nobs - 1]
+    
+    # Used for recursion process
+    J_2 = S.VmU[:, :, nobs - 1] @ A.T @ pinv(S.Vm[:, :, nobs - 1])
+    
+    # Run smoothing algorithm
+    # Loop through time reverse-chronologically (starting at final period nobs-1)
+    for t in range(nobs - 1, -1, -1):
+        # Store posterior and prior factor covariance values
+        VmU = S.VmU[:, :, t]
+        Vm1 = S.Vm[:, :, t]
+        
+        # Store previous period smoothed factor covariance and lag-1 covariance
+        V_T = VmT[:, :, t + 1]
+        V_T1 = VmT_1[:, :, t] if t < nobs - 1 else np.zeros((m, m))
+        
+        J_1 = J_2
+        
+        # Update smoothed factor estimate
+        ZmT[:, t] = S.ZmU[:, t] + J_1 @ (ZmT[:, t + 1] - A @ S.ZmU[:, t])
+        
+        # Clean NaN/Inf only (remove excessive clipping)
+        if np.any(~np.isfinite(ZmT[:, t])):
+            ZmT[:, t] = np.nan_to_num(ZmT[:, t], nan=0.0, posinf=0.0, neginf=0.0)
+        
+        # Update smoothed factor covariance matrix
+        VmT[:, :, t] = VmU + J_1 @ (V_T - Vm1) @ J_1.T
+        VmT[:, :, t] = 0.5 * (VmT[:, :, t] + VmT[:, :, t].T)  # Ensure symmetry
+        
+        # Clean NaN/Inf and ensure PSD (keep only critical regularization)
+        if np.any(~np.isfinite(VmT[:, :, t])):
+            VmT[:, :, t] = np.nan_to_num(VmT[:, :, t], nan=1e-8, posinf=1e6, neginf=1e-8)
+        
+        if t > 0:
+            # Update weight
+            J_2 = S.VmU[:, :, t - 1] @ A.T @ pinv(S.Vm[:, :, t - 1])
+            
+            # Update lag 1 factor covariance matrix
+            VmT_1[:, :, t - 1] = VmU @ J_2.T + J_1 @ (V_T1 - A @ VmU) @ J_2.T
+    
+    # Add smoothed estimates as attributes
+    S.ZmT = ZmT
+    S.VmT = VmT
+    S.VmT_1 = VmT_1
+    
+    return S
+
+
+def run_kf(Y: np.ndarray, A: np.ndarray, C: np.ndarray, Q: np.ndarray,
+           R: np.ndarray, Z_0: np.ndarray, V_0: np.ndarray) -> Tuple[np.ndarray, np.ndarray, np.ndarray, float]:
+    """Apply Kalman filter and fixed-interval smoother.
+    
+    Parameters:
+    -----------
+    Y : np.ndarray
+        Input data (k x nobs)
+    A : np.ndarray
+        Transition matrix (m x m)
+    C : np.ndarray
+        Observation matrix (k x m)
+    Q : np.ndarray
+        Covariance for transition residuals (m x m)
+    R : np.ndarray
+        Covariance for observation residuals (k x k)
+    Z_0 : np.ndarray
+        Initial state (m,)
+    V_0 : np.ndarray
+        Initial covariance (m x m)
+        
+    Returns:
+    --------
+    zsmooth : np.ndarray
+        Smoothed factor estimates (m x (nobs+1)), zsmooth[:, t+1] = Z_t|T
+    Vsmooth : np.ndarray
+        Smoothed factor covariance (m x m x (nobs+1)), Vsmooth[:, :, t+1] = Cov(Z_t|T)
+    VVsmooth : np.ndarray
+        Lag 1 factor covariance (m x m x nobs), Cov(Z_t, Z_t-1|T)
+    loglik : float
+        Log-likelihood
+    """
+    # Kalman filter
+    S = skf(Y, A, C, Q, R, Z_0, V_0)
+    
+    # Fixed-interval smoother
+    S = fis(A, S)
+    
+    # Organize output
+    zsmooth = S.ZmT
+    Vsmooth = S.VmT
+    VVsmooth = S.VmT_1
+    loglik = S.loglik
+    
+    return zsmooth, Vsmooth, VVsmooth, loglik
+