Merge pull request #781 from danbarla/danbarla_dev
						commit
						6f02ebde14
					
				| 
						 | 
				
			
			@ -19,6 +19,21 @@ from gtsam.utils.test_case import GtsamTestCase
 | 
			
		|||
class TestKalmanFilter(GtsamTestCase):
 | 
			
		||||
 | 
			
		||||
    def test_KalmanFilter(self):
 | 
			
		||||
        """ 
 | 
			
		||||
        Kalman Filter Definitions:
 | 
			
		||||
        F - State Transition Model
 | 
			
		||||
        B - Control Input Model
 | 
			
		||||
        u - Control Vector
 | 
			
		||||
        modelQ - Covariance of the process Noise (input for KalmanFilter object) - sigma as input
 | 
			
		||||
        Q - Covariance of the process Noise (for reference calculation) - sigma^2 as input
 | 
			
		||||
        H - Observation Model
 | 
			
		||||
        z1 - Observation iteration 1
 | 
			
		||||
        z2 - Observation iteration 2
 | 
			
		||||
        z3 - observation iteration 3
 | 
			
		||||
        modelR - Covariance of the observation Noise (input for KalmanFilter object) - sigma as input
 | 
			
		||||
        R - Covariance of the observation Noise (for reference calculation) - sigma^2 as input
 | 
			
		||||
        """
 | 
			
		||||
 | 
			
		||||
        F = np.eye(2)
 | 
			
		||||
        B = np.eye(2)
 | 
			
		||||
        u = np.array([1.0, 0.0])
 | 
			
		||||
| 
						 | 
				
			
			
 | 
			
		|||
		Loading…
	
		Reference in New Issue