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
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
def __init__(self): # Four states, two measurements (X,Y) EKF.__init__(self, 2, 2)
def __init__(self): # Two state values (mouse coordinates), two measurement values (mouse coordinates) EKF.__init__(self, 2, 2)
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)
def __init__(self): EKF.__init__(self, 2, 2)
def __init__(self): EKF.__init__(self, 3, 4, rval=.1) # covariance arbitrary rn lol