mixtureBootstrapFilter.cpp

Go to the documentation of this file.

// Copyright (C) 2009 Tinne De Laet <first dot last at gmail dot com>
// $Id: mixtureBootstrapFilter.h 2009-02-03 tdelaet $
//
// This program is free software; you can redistribute it and/or modify
// it under the terms of the GNU Lesser General Public License as published by
// the Free Software Foundation; either version 2.1 of the License, or
// (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
// GNU Lesser General Public License for more details.
//
// You should have received a copy of the GNU Lesser General Public License
// along with this program; if not, write to the Free Software
// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
//

#include "mixtureBootstrapFilter.h"
#include "../sample/weightedsample.h"

#define StateVar SVar
#define MeasVar MVar

template <typename SVar, typename MVar>
MixtureBootstrapFilter<SVar,MVar>::MixtureBootstrapFilter(Mixture<SVar> * prior,
                                            int resampleperiod,
                                            double resamplethreshold,
                                        int resamplescheme,
                        int maintainMixturePeriod)
  : MixtureParticleFilter<SVar,MVar>(prior,NULL,resampleperiod,
                                     resamplethreshold,
                                     resamplescheme,
                     maintainMixturePeriod)
{
  // for a MixtureBootstrapFilter, the proposal does not depend on the
  // measurement
  this->_proposal_depends_on_meas = false;
}


template <typename SVar, typename MVar>
MixtureBootstrapFilter<SVar,MVar>::MixtureBootstrapFilter(Mixture<SVar> * prior,
                                            Mixture<SVar> * post,
                                            int resampleperiod,
                                            double resamplethreshold,
                                        int resamplescheme,
                        int maintainMixturePeriod)
  : MixtureParticleFilter<SVar,MVar>(prior,post,NULL,resampleperiod,
                                     resamplethreshold,
                                     resamplescheme,
                     maintainMixturePeriod)
{
  // for a MixtureBootstrapFilter, the proposal does not depend on the
  // measurement
  this->_proposal_depends_on_meas = false;
}




template <typename SVar, typename MVar>
MixtureBootstrapFilter<SVar,MVar>::~MixtureBootstrapFilter(){}

template <typename SVar, typename MVar> bool
MixtureBootstrapFilter<SVar,MVar>::UpdateInternal(SystemModel<SVar>* const sysmodel,
                                           const SVar& u,
                                           MeasurementModel<MVar,SVar>* const measmodel,
                                           const MVar& z,
                                           const SVar& s)
{
  bool result = true;

  if (sysmodel != NULL){
    this->ProposalSet(sysmodel->SystemPdfGet());
    result = this->MixtureParticleFilter<SVar,MVar>::UpdateInternal(sysmodel,u,NULL,z,s) && result;
  }
  if (measmodel != NULL)
    result = this->MixtureParticleFilter<SVar,MVar>::UpdateInternal(NULL,u,measmodel,z,s) && result;

  return result;
}