00001 // -*- mode: c++; indent-tabs-mode: t; tab-width: 4; c-basic-offset: 4; -*- 00002 #include <iostream> 00003 #include "KalmanFilterService_impl.h" 00004 #include "KalmanFilter.h" 00005 00006 KalmanFilterService_impl::KalmanFilterService_impl() 00007 { 00008 } 00009 00010 KalmanFilterService_impl::~KalmanFilterService_impl() 00011 { 00012 } 00013 00014 bool KalmanFilterService_impl::setKalmanFilterParam(const OpenHRP::KalmanFilterService::KalmanFilterParam& i_param) 00015 { 00016 return m_kalman->setKalmanFilterParam(i_param); 00017 } 00018 00019 bool KalmanFilterService_impl::getKalmanFilterParam(OpenHRP::KalmanFilterService::KalmanFilterParam& i_param) 00020 { 00021 i_param = OpenHRP::KalmanFilterService::KalmanFilterParam(); 00022 return m_kalman->getKalmanFilterParam(i_param); 00023 } 00024 00025 bool KalmanFilterService_impl::resetKalmanFilterState() 00026 { 00027 return m_kalman->resetKalmanFilterState(); 00028 } 00029 00030 void KalmanFilterService_impl::kalman(KalmanFilter *i_kalman) 00031 { 00032 m_kalman = i_kalman; 00033 } 00034 00035