Orocos Real-Time Toolkit  2.6.0
VectorComposition.cpp
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