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 typename PointMatcher<T>::DataPoints::Labels Labels; 

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

        typedef std::map<std::string, LabelAssociationPair > SublabelAssociationMap;

        // General
        static SublabelAssociationMap getFeatAssocationMap(); 
        static SublabelAssociationMap getDescAssocationMap(); 
        static bool featSublabelRegistered(const std::string& externalName); 
        static bool descSublabelRegistered(const std::string& externalName); 
        static LabelAssociationPair getFeatAssociationPair(const std::string& externalName); 
        static LabelAssociationPair getDescAssociationPair(const std::string& externalName); 

        static std::string getColLabel(const Label& label, const int row); 
        
        enum PMPropTypes
                {
                        FEATURE,
                        DESCRIPTOR,
                        UNSUPPORTED
                };//TODO: add time here too

        struct SupportedLabel
        {
                const std::string internalName; 
                const std::string externalName; 
                const PMPropTypes type; 

                SupportedLabel(const std::string& internalName, const std::string& externalName, const PMPropTypes& type);
        };

        typedef std::vector<SupportedLabel> SupportedLabels;

        static SupportedLabels getSupportedExternalLabels()
        {
                //Can be read:
                // (internalName, externalName, type)
                const SupportedLabels labels = boost::assign::list_of<SupportedLabel>
                        ("x", "x", FEATURE)
                        ("y", "y", FEATURE)
                        ("z", "z", FEATURE)
                        ("pad", "pad", FEATURE)
                        ("normals", "nx", DESCRIPTOR)
                        ("normals", "ny", DESCRIPTOR)
                        ("normals", "nz", DESCRIPTOR)
                        ("normals", "normal_x", DESCRIPTOR)
                        ("normals", "normal_y", DESCRIPTOR)
                        ("normals", "normal_z", DESCRIPTOR)
                        ("color", "red", DESCRIPTOR)
                        ("color", "green", DESCRIPTOR)
                        ("color", "blue", DESCRIPTOR)
                        ("color", "alpha", DESCRIPTOR)
                        ("eigValues", "eigValues0", DESCRIPTOR)
                        ("eigValues", "eigValues1", DESCRIPTOR)
                        ("eigValues", "eigValues2", DESCRIPTOR)
                        ("eigVectors", "eigVectors0X", DESCRIPTOR)
                        ("eigVectors", "eigVectors0Y", DESCRIPTOR)
                        ("eigVectors", "eigVectors0Z", DESCRIPTOR)
                        ("eigVectors", "eigVectors1X", DESCRIPTOR)
                        ("eigVectors", "eigVectors1Y", DESCRIPTOR)
                        ("eigVectors", "eigVectors1Z", DESCRIPTOR)
                        ("eigVectors", "eigVectors2X", DESCRIPTOR)
                        ("eigVectors", "eigVectors2Y", DESCRIPTOR)
                        ("eigVectors", "eigVectors2Z", DESCRIPTOR)
                        //("", "", DESCRIPTOR)
                        ;

                        return labels;
        }

        class LabelGenerator
        {
                Labels labels; 

        public:
                void add(std::string internalName);

                Labels getLabels() const;
        };


        static PMPropTypes getPMType(const std::string& externalName); 

        // 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
        {
                //PLY information:
                std::string name; 
                std::string type; 
                std::string idx_type; 
                unsigned pos; 
                bool is_list; 
                
                //PointMatcher information:
                PMPropTypes pmType; 
                int pmRowID; 

                //TODO: remove that (now pmType):
                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;
        
        typedef std::vector<PLYProperty> PLYProperties;

        typedef typename PLYProperties::iterator it_PLYProp;

        class PLYElement
        {
        public:
                std::string name; 
                unsigned num; 
                unsigned total_props; 
                unsigned offset; 
                PLYProperties properties; 
                unsigned nbFeatures; 
                unsigned nbDescriptors; 



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

                bool supportsProperty(const PLYProperty& prop) const; 

                void addProperty(PLYProperty& prop); 

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

        };


        class PLYVertex : public PLYElement
        {
        public:

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

        };

        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); 
        };
   
   static std::istream & safeGetLine( std::istream& os, std::string & line);
   
};


#endif // __POINTMATCHER_IO_H