Exemplo n.º 1
0
 def __init__(self, x, freq):
     EKF.__init__(self,
                  9,
                  6,
                  qval=[0.001] * 9,
                  rval=[0.008, 0.008, 0.008, 0.04, 0.04, 0.04],
                  init_x=x)
     self.dt = 1 / freq
Exemplo n.º 2
0
 def __init__(self, x, freq):
     EKF.__init__(self,
                  9,
                  3,
                  qval=[
                      0.001, 0.001, 0.001, 0.001, 0.001, 0.001, 0.001,
                      0.001, 0.001
                  ],
                  rval=[0.09, 0.09, 0.09],
                  init_x=x)
     self.dt = 1 / freq
Exemplo n.º 3
0
    def __init__(self):

        # Four states, two measurements (X,Y)
        EKF.__init__(self, 2, 2)
Exemplo n.º 4
0
    def __init__(self):

        # Two state values (mouse coordinates), two measurement values (mouse coordinates)
        EKF.__init__(self, 2, 2)
Exemplo n.º 5
0
    def __init__(self):

        # One state (ASL), two measurements (baro, sonar), with larger-than-usual
        # measurement covariance noise to help with sonar blips.
        EKF.__init__(self, 1, 2, rval=.5)
Exemplo n.º 6
0
    def __init__(self):

        # Four states, two measurements (X,Y)
        EKF.__init__(self, 2, 2)
Exemplo n.º 7
0
    def __init__(self):

        # One state (ASL), two measurements (baro, sonar), with larger-than-usual
        # measurement covariance noise to help with sonar blips.
        EKF.__init__(self, 1, 2, rval=.5)
Exemplo n.º 8
0
    def __init__(self):

        EKF.__init__(self, 2, 2)
Exemplo n.º 9
0
 def __init__(self):
     EKF.__init__(self, 3, 4, rval=.1)   # covariance arbitrary rn lol