/* 
 *  Copyright 2002 by Soos, Antal 
 *  All rights reserved. Property of Soos, Antal. 
 *  Restricted rights to use, duplicate or disclose this code are 
 *  granted through contract.   
 */ 
/***************************************************************************/ 
/*                                                                         */ 
/*     KF . hpp															   */ 
/*                                                                         */ 
/*     Recoursive Kalman Filter Algorithm inplementation.				   */ 
/*																	       */ 
/*                                                                         */ 
/***************************************************************************/ 
 
#ifndef _KF_HPP_ 
#define _KF_HPP_ 
 
#include "sysIdent.hpp" 
 
class KF_alg : public sysid { 
 
	Matrix P_KF; 
	Matrix R; 
	Matrix Q; 
	Matrix k; 
	Matrix MtempA; // Temporary result holder matrix 
	Matrix MtempB; // Temporary result holder matrix 
 
public: 
 
	void update(float y_n, float u_n_1); 
	KF_alg(float r,float q, int is,int ia,int ib,int ic) ; 
	~KF_alg(); 
}; 
 
 
#endif // _KF_HPP_