GridIO.cpp

Go to the documentation of this file.

#include "lvr2/io/GridIO.hpp"
#include "lvr2/io/DataStruct.hpp"

#include <fstream>
using std::ifstream;

namespace lvr2
{

GridIO::GridIO()
{
    // TODO Auto-generated constructor stub

}

void GridIO::read( std::string filename )
{
    ifstream in(filename.c_str());

    if(in.good())
    {
        size_t n_points;
        size_t n_cells;
        float voxelsize;

        // Read header
        in >> n_points >> voxelsize >> n_cells;

        // Alloc and read points
        m_points = floatArr( new float[4 * n_points] );
        m_numPoints = n_points;
        for(size_t i = 0; i < n_points; i++)
        {
            in >> m_points[i * 4] >> m_points[i * 4 + 1] >> m_points[i * 4 + 2] >> m_points[i * 4 + 3];
        }

        // Alloc and read box indices
        m_boxes = uintArr( new unsigned int[8 * n_cells] );
        m_numBoxes = n_cells;
        for(size_t i = 0; i < n_cells; i++)
        {
            size_t pos = i * 8;
            for(size_t j = 0; j < 8; j++)
            {
                in >> m_boxes[pos + j];
            }
        }

    }
}


floatArr GridIO::getPoints( size_t &n )
{
    n = m_numPoints;
    return m_points;
}


uintArr GridIO::getBoxes( size_t &n )
{
    n = m_numBoxes;
    return m_boxes;
}


GridIO::~GridIO()
{
    // TODO Auto-generated destructor stub
}

} /* namespace lvr2 */