Orocos Real-Time Toolkit
2.6.0
|
00001 /*************************************************************************** 00002 tag: Peter Soetens Mon May 10 19:10:30 CEST 2004 VectorComposition.cxx 00003 00004 VectorComposition.cxx - description 00005 ------------------- 00006 begin : Mon May 10 2004 00007 copyright : (C) 2004 Peter Soetens 00008 email : peter.soetens@mech.kuleuven.ac.be 00009 00010 *************************************************************************** 00011 * This library is free software; you can redistribute it and/or * 00012 * modify it under the terms of the GNU General Public * 00013 * License as published by the Free Software Foundation; * 00014 * version 2 of the License. * 00015 * * 00016 * As a special exception, you may use this file as part of a free * 00017 * software library without restriction. Specifically, if other files * 00018 * instantiate templates or use macros or inline functions from this * 00019 * file, or you compile this file and link it with other files to * 00020 * produce an executable, this file does not by itself cause the * 00021 * resulting executable to be covered by the GNU General Public * 00022 * License. This exception does not however invalidate any other * 00023 * reasons why the executable file might be covered by the GNU General * 00024 * Public License. * 00025 * * 00026 * This library is distributed in the hope that it will be useful, * 00027 * but WITHOUT ANY WARRANTY; without even the implied warranty of * 00028 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * 00029 * Lesser General Public License for more details. * 00030 * * 00031 * You should have received a copy of the GNU General Public * 00032 * License along with this library; if not, write to the Free Software * 00033 * Foundation, Inc., 59 Temple Place, * 00034 * Suite 330, Boston, MA 02111-1307 USA * 00035 * * 00036 ***************************************************************************/ 00037 00038 00039 #include "../Property.hpp" 00040 #include "../PropertyBag.hpp" 00041 #include "VectorComposition.hpp" 00042 #include "../Logger.hpp" 00043 #include <ostream> 00044 #include <sstream> 00045 #include "Types.hpp" 00046 00047 namespace RTT { 00048 namespace types { 00049 using namespace detail; 00050 00051 bool composeProperty(const PropertyBag& bag, std::vector<double>& result) 00052 { 00053 TypeInfoRepository::shared_ptr tir = Types(); 00054 if ( tir->type( bag.getType()) == tir->getTypeInfo<std::vector<double> >() ) { 00055 Property<double>* comp; 00056 int dimension = bag.size(); 00057 result.resize( dimension ); 00058 00059 // Get values 00060 int size_correction = 0; 00061 for (int i = 0; i < dimension ; i++) { 00062 PropertyBase* element = bag.getItem( i ); 00063 comp = dynamic_cast< Property<double>* >( element ); 00064 if ( comp == 0 ) { 00065 // detect LEGACY element: 00066 if ( element->getName() == "Size" ) { 00067 // oops, our result vector will be one smaller. 00068 size_correction += 1; 00069 continue; 00070 } 00071 Logger::log() << Logger::Error << "Aborting composition of Property< vector<double> > " 00072 << ": Exptected data element "<< i << " to be of type double" 00073 <<" got type " << element->getType() 00074 <<Logger::endl; 00075 return false; 00076 } 00077 result[ i - size_correction ] = comp->get(); 00078 } 00079 result.resize( dimension - size_correction ); 00080 } 00081 else { 00082 Logger::log() << Logger::Error << "Composing Property< std::vector<double> > :" 00083 << " type mismatch, got type '"<< bag.getType() 00084 << "', expected type 'array'."<<Logger::endl; 00085 return false; 00086 } 00087 return true; 00088 } 00089 00090 00091 }}; // namespace RTT 00092