00001 /* ======================================================================== 00002 * Copyright (c) 2006, 00003 * Institute for Computer Graphics and Vision 00004 * Graz University of Technology 00005 * All rights reserved. 00006 * 00007 * Redistribution and use in source and binary forms, with or without 00008 * modification, are permitted provided that the following conditions are 00009 * met: 00010 * 00011 * Redistributions of source code must retain the above copyright notice, 00012 * this list of conditions and the following disclaimer. 00013 * 00014 * Redistributions in binary form must reproduce the above copyright 00015 * notice, this list of conditions and the following disclaimer in the 00016 * documentation and/or other materials provided with the distribution. 00017 * 00018 * Neither the name of the Graz University of Technology nor the names of 00019 * its contributors may be used to endorse or promote products derived from 00020 * this software without specific prior written permission. 00021 * 00022 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS 00023 * IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 00024 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A 00025 * PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER 00026 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, 00027 * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 00028 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR 00029 * PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF 00030 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING 00031 * NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS 00032 * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 00033 * ======================================================================== 00034 * PROJECT: OpenTracker 00035 * ======================================================================== */ 00044 #ifndef __DESP_H__ 00045 #define __DESP_H__ 00046 00047 #include <vector> 00048 00049 namespace ot { 00050 00051 00053 00056 class DESP 00057 { 00058 public: 00059 DESP(float nAlpha=0.5f); 00060 00061 void setAlpha(float nAlpha) { alpha = nAlpha; } 00062 00063 float getAlpha() const { return alpha; } 00064 00065 void observe(float nValue); 00066 00067 float predict(int delta_t); 00068 00069 void reinit(); 00070 00071 protected: 00072 float spt, spt2; 00073 float alpha; 00074 }; 00075 00076 00078 00083 class PoseDESP 00084 { 00085 public: 00086 PoseDESP(); 00087 00088 void setAlpha(float nAlphaPos, float nAlphaRot); 00089 00090 void observe(std::vector<float> position_, std::vector<float> quaternion_); 00091 00092 void predict(int delta_t, std::vector<float> &position_, std::vector<float> &quaternion_); 00093 00094 void reinit(); 00095 00096 protected: 00097 DESP pos[3]; 00098 DESP rot[4]; 00099 }; 00100 00101 00102 } // namespace ot 00103 00104 00105 #endif //__DESP_H__ 00106 00107 /* 00108 * ------------------------------------------------------------ 00109 * End of DESP.h 00110 * ------------------------------------------------------------ 00111 * Automatic Emacs configuration follows. 00112 * Local Variables: 00113 * mode:c++ 00114 * c-basic-offset: 4 00115 * eval: (c-set-offset 'substatement-open 0) 00116 * eval: (c-set-offset 'case-label '+) 00117 * eval: (c-set-offset 'statement 'c-lineup-runin-statements) 00118 * eval: (setq indent-tabs-mode nil) 00119 * End: 00120 * ------------------------------------------------------------ 00121 */
1.4.6