IO.h

Go to the documentation of this file.

// kate: replace-tabs off; indent-width 4; indent-mode normal
// vim: ts=4:sw=4:noexpandtab
/*

Copyright (c) 2010--2012,
François Pomerleau and Stephane Magnenat, ASL, ETHZ, Switzerland
You can contact the authors at <f dot pomerleau at gmail dot com> and
<stephane at magnenat dot net>

All rights reserved.

Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are met:
 * Redistributions of source code must retain the above copyright
      notice, this list of conditions and the following disclaimer.
 * Redistributions in binary form must reproduce the above copyright
      notice, this list of conditions and the following disclaimer in the
      documentation and/or other materials provided with the distribution.
 * Neither the name of the <organization> nor the
      names of its contributors may be used to endorse or promote products
      derived from this software without specific prior written permission.

THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
DISCLAIMED. IN NO EVENT SHALL ETH-ASL BE LIABLE FOR ANY
DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 */

#ifndef __POINTMATCHER_IO_H
#define __POINTMATCHER_IO_H

#include "PointMatcher.h"

template<typename T>
struct PointMatcherIO
{
        typedef typename PointMatcher<T>::Vector Vector; 
        typedef typename PointMatcher<T>::Matrix Matrix; 
        typedef typename PointMatcher<T>::DataPoints DataPoints; 
        typedef typename PointMatcher<T>::TransformationParameters TransformationParameters; 
        typedef typename PointMatcher<T>::Matrix Parameters; 
        typedef typename PointMatcher<T>::DataPoints::Label Label; 

        typedef std::pair<int, std::string >DescAssociationPair;

        typedef std::map<std::string, DescAssociationPair > DescAssociationMap;

        // General
        static DescAssociationMap getDescAssocationMap(); 
        static bool colLabelRegistered(const std::string& colLabel); 
        static DescAssociationPair getDescAssociationPair(const std::string& colLabel); 

        static std::string getColLabel(const Label& label, const int row); 

        // CSV
        static DataPoints loadCSV(const std::string& fileName);
        static DataPoints loadCSV(std::istream& is);

        static void saveCSV(const DataPoints& data, const std::string& fileName);
        static void saveCSV(const DataPoints& data, std::ostream& os);

        // VTK
        enum SupportedVTKDataTypes
        {
                POLYDATA,
                UNSTRUCTURED_GRID
        };

        static DataPoints loadVTK(const std::string& fileName);
        static DataPoints loadVTK(std::istream& is);

        static void saveVTK(const DataPoints& data, const std::string& fileName);

        // PLY
        static DataPoints loadPLY(const std::string& fileName);
        static DataPoints loadPLY(std::istream& is);

        static void savePLY(const DataPoints& data, const std::string& fileName); 

        // PCD
        static DataPoints loadPCD(const std::string& fileName);
        static DataPoints loadPCD(std::istream& is);

        static void savePCD(const DataPoints& data, const std::string& fileName); 

        struct FileInfo
        {
                typedef Eigen::Matrix<T, 3, 1> Vector3; 

                std::string readingFileName; 
                std::string referenceFileName; 
                std::string configFileName; 
                TransformationParameters initialTransformation; 
                TransformationParameters groundTruthTransformation; 
                Vector3 gravity; 

                FileInfo(const std::string& readingPath="", const std::string& referencePath="", const std::string& configFileName="", const TransformationParameters& initialTransformation=TransformationParameters(), const TransformationParameters& groundTruthTransformation=TransformationParameters(),  const Vector& grativity=Vector3::Zero());
        };

        struct FileInfoVector: public std::vector<FileInfo>
        {
                FileInfoVector();
                FileInfoVector(const std::string& fileName, std::string dataPath = "", std::string configPath = "");

        protected:
                std::string localToGlobalFileName(const std::string& path, const std::string& fileName);
                bool findTransform(const PointMatcherSupport::CsvElements& data, const std::string& prefix, unsigned dim);
                TransformationParameters getTransform(const PointMatcherSupport::CsvElements& data, const std::string& prefix, unsigned dim, unsigned line);
        };

        struct CsvDescriptor {
                std::string name; 
                unsigned        start_col; 
                unsigned        span; 
        };

        static bool plyPropTypeValid (const std::string& type);

        struct PLYProperty
        {

                std::string name; 
                std::string type; 
                std::string idx_type; 
                unsigned pos; 
                bool is_list; 
                bool is_feature; 

                PLYProperty() { } 

                // regular property
                PLYProperty(const std::string& type, const std::string& name, const unsigned pos, const bool is_feature = false);

                // list property
                PLYProperty(const std::string& idx_type, const std::string& type, const std::string& name, const unsigned pos, const bool is_feature = false); 

                bool operator==(const PLYProperty& other) const; 
        };


        typedef std::map<std::string, std::vector<PLYProperty> > PLYDescPropMap;

        class PLYElement
        {
        public:
                std::string name; 
                unsigned num; 
                unsigned total_props; 
                unsigned offset; 


                PLYElement(const std::string& name, const unsigned num, const unsigned offset) :
                        name(name), num(num), total_props(0), offset(offset) {}

                bool supportsProperty(const PLYProperty& prop) const; 

                void addProperty(PLYProperty& prop); 

                const std::vector<PLYProperty>& getFeatureProps() const; 

                const std::vector<PLYProperty>& getDescriptorProps() const; 

                const PLYDescPropMap& getDescPropMap() const; 

                size_t getNumSupportedProperties() const; 

                int getNumFeatures() const; 

                int getNumDescriptors() const; 

                int getNumDescProp() const; 

                bool operator==(const PLYElement& other) const; 

        protected:
                enum PMPropTypes
                {
                        FEATURE,
                        DESCRIPTOR,
                        UNSUPPORTED
                };

                std::vector<PLYProperty> features; 
                std::vector<PLYProperty> descriptors; 
                PLYDescPropMap descriptor_map; 

                virtual PMPropTypes getPMType(const PLYProperty& prop) const = 0; 

                //virtual std::string getDescName(const PLYProperty& prop) const = 0; //!< for descriptor properties return name of pointmatcher descriptor

        };


        class PLYVertex : public PLYElement
        {
        public:

                PLYVertex(const unsigned num, const unsigned offset) : PLYElement("vertex", num, offset) {}

                typename PLYElement::PMPropTypes getPMType(const PLYProperty& prop) const; 

                //typename std::string getDescName(const PLYProperty& prop) const; //! implements element interface
        };

        class PLYElementF
        {
                enum ElementTypes
                {
                        VERTEX,
                        UNSUPPORTED
                };

                static ElementTypes getElementType(const std::string& elem_name);
        public:
                bool elementSupported(const std::string& elem_name); 
                static PLYElement* createElement(const std::string& elem_name, const int elem_num, const unsigned offset); 
        };

};

#endif // __POINTMATCHER_IO_H