00001 /************************************************************************ 00002 * Copyright (C) 2012 Eindhoven University of Technology (TU/e). * 00003 * All rights reserved. * 00004 ************************************************************************ 00005 * Redistribution and use in source and binary forms, with or without * 00006 * modification, are permitted provided that the following conditions * 00007 * are met: * 00008 * * 00009 * 1. Redistributions of source code must retain the above * 00010 * copyright notice, this list of conditions and the following * 00011 * disclaimer. * 00012 * * 00013 * 2. Redistributions in binary form must reproduce the above * 00014 * copyright notice, this list of conditions and the following * 00015 * disclaimer in the documentation and/or other materials * 00016 * provided with the distribution. * 00017 * * 00018 * THIS SOFTWARE IS PROVIDED BY TU/e "AS IS" AND ANY EXPRESS OR * 00019 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED * 00020 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE * 00021 * ARE DISCLAIMED. IN NO EVENT SHALL TU/e OR CONTRIBUTORS BE LIABLE * 00022 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR * 00023 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT * 00024 * OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; * 00025 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF * 00026 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT * 00027 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE * 00028 * USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH * 00029 * DAMAGE. * 00030 * * 00031 * The views and conclusions contained in the software and * 00032 * documentation are those of the authors and should not be * 00033 * interpreted as representing official policies, either expressed or * 00034 * implied, of TU/e. * 00035 ************************************************************************/ 00036 00037 #ifndef SE_MULTI_MODEL_FILTER_H_ 00038 #define SE_MULTI_MODEL_FILTER_H_ 00039 00040 #include "wire/core/IStateEstimator.h" 00041 #include "problib/conversions.h" 00042 00043 class KalmanFilter; 00044 00045 class MultiModelFilter : public mhf::IStateEstimator { 00046 00047 public: 00048 00049 MultiModelFilter(); 00050 00051 MultiModelFilter(const MultiModelFilter& orig); 00052 00053 virtual MultiModelFilter* clone() const; 00054 00055 virtual ~MultiModelFilter(); 00056 00057 void addEstimator(mhf::IStateEstimator* estimator); 00058 00063 virtual void propagate(const mhf::Time& time); 00064 00070 void update(const pbl::PDF& z, const mhf::Time& time); 00071 00075 virtual void reset(); 00076 00081 const pbl::PDF& getValue() const; 00082 00083 void setValue(const pbl::PDF& pdf); 00084 00091 bool setParameter(const std::string& param, bool b); 00092 00099 bool setParameter(const std::string& param, double v); 00100 00101 protected: 00102 00103 bool initialized_; 00104 00105 std::vector<mhf::IStateEstimator*> estimators_; 00106 00107 std::vector<double> weights_; 00108 00109 mutable pbl::Mixture mixture_; 00110 00111 }; 00112 00113 #endif