kalman_takasu.cpp File Reference

#include <math.h>
#include <assert.h>
#include <string.h>
#include "linalg.h"
#include "miniblas.h"

Namespaces
namespace	warpos

Macros
#define	KALMAN_MAX_STATE_SIZE   32 /* kalman filter scratchpad buf size */
#define	KALMAN_MAX_MEASUREMENTS   3 /* kalman filter scratchpad buf size */

Functions
int	warpos::kalman_takasu (floating_point *x, floating_point *P, const floating_point *dz, const floating_point *R, const floating_point *Ht, int n, int m, floating_point chi2_threshold, floating_point *chi2)
	Kalman Filter Routine (Takasu Formulation).
void	warpos::kalman_predict (floating_point *x, floating_point *P, const floating_point *Phi, const floating_point *G, const floating_point *Q, int n, int r)
	Kalman Temporal / Prediction Step.

Macro Definition Documentation

KALMAN_MAX_MEASUREMENTS

#define KALMAN_MAX_MEASUREMENTS   3 /* kalman filter scratchpad buf size */

KALMAN_MAX_STATE_SIZE

#define KALMAN_MAX_STATE_SIZE   32 /* kalman filter scratchpad buf size */