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 DISCRETEKALMANFILTER_H_ 00038 #define DISCRETEKALMANFILTER_H_ 00039 00040 #include "wire/core/IStateEstimator.h" 00041 00042 #include "problib/pdfs/PMF.h" 00043 #include "problib/conversions.h" 00044 00050 class DiscreteFilter : public mhf::IStateEstimator { 00051 00052 public: 00053 00054 static int N_DISCRETEKALMAN_FILTER; 00055 00056 DiscreteFilter(); 00057 00058 DiscreteFilter(const DiscreteFilter& orig); 00059 00060 virtual ~DiscreteFilter(); 00061 00062 virtual DiscreteFilter* clone() const; 00063 00069 virtual void update(const pbl::PDF& z, const mhf::Time& time); 00070 00075 virtual void propagate(const mhf::Time& time); 00076 00080 virtual void reset(); 00081 00086 virtual const pbl::PDF& getValue() const; 00087 00088 protected: 00089 00090 pbl::PMF pmf_; 00091 00092 }; 00093 00094 #endif /* DISCRETEKALMANFILTER_H_ */