A template class which is simple implementation for kalman filter