// Convert from OFF format to StereoLithography StL format.

#include <CGAL/Simple_cartesian.h>
#include <CGAL/Polyhedron_3.h>
#include <CGAL/IO/Polyhedron_iostream.h>
#include <CGAL/IO/Verbose_ostream.h>
#include <cstddef>
#include <cstdlib>
#include <cstring>
#include <iostream>
#include <fstream>

using namespace std;

bool  verbose  = false;
bool  binary    = false;

typedef CGAL::Simple_cartesian<double>  Kernel;
typedef Kernel::Point_3                 Point;
typedef Kernel::Vector_3                Vector;
typedef CGAL::Polyhedron_3<Kernel>      Polyhedron;
typedef Polyhedron::Vertex_iterator     Vertex_iterator;
typedef Polyhedron::Facet_iterator      Facet_iterator;
typedef Polyhedron::Halfedge_handle     Halfedge_handle;


// main function with standard unix commandline arguments
// ------------------------------------------------------
int main( int argc, char **argv) {
    int n = 0; // number of filenames
    char *filename[2];
    bool help = false;
    for (int i = 1; i < argc; i++) { // check commandline options
        if ( strcmp( "-v", argv[i]) == 0)
            verbose = true;
        else if ( strcmp( "-b", argv[i]) == 0)
            binary = true;
        else if ( (strcmp( "-h", argv[i]) == 0) ||
                  (strcmp( "-help", argv[i]) == 0))
            help = true;
        else if ( n < 2 ) {
            filename[ n++] = argv[i];
        } else {
	    ++n;
            break;
	}
    }
    if ((n > 2) || help) {
        if ( ! help)
            cerr << "Error: in parameter list" << endl;
        cerr << "Usage: " << argv[0] << " [<options>] [<infile> [<outfile>]]"
             << endl;
        cerr << "       convert a CGAL object (OFF) to StereoLithography StL "
                "format." << endl;
        cerr << "       -v      verbose." << endl;
        cerr << "       -b      binary." << endl;
        exit( ! help);
    }

    CGAL::Verbose_ostream vout( verbose);
    vout << argv[0] << ": verbosity on." << endl;

    const char*  iname = "cin";
    istream*     p_in  = &cin;
    ifstream     in;
    if ( n > 0) {
        in.open( filename[0]);
        p_in = &in;
        iname = filename[0];
    }
    if ( !*p_in) {
        cerr << argv[0] << ": error: cannot open file '"<< iname
             << "' for reading." <<endl;
        exit( 1);
    }

    vout << "Reading polyhedron ..." << endl;
    Polyhedron P;
    (*p_in) >> P;
    vout << "    .... done." << endl;

    if ( !*p_in) {
        cerr << argv[0] << " read error: while reading file '"<< iname << "'."
             << endl;
        exit( 1);
    }

    const char*  oname = "cout";
    ostream*     p_out = &cout;
    ofstream     out;
    if ( n > 1) {
        out.open( filename[1]);
        p_out = &out;
        oname = filename[1];
    }
    if ( !*p_out) {
        cerr << argv[0] << ": error: cannot open file '"<< oname
             << "' for writing." <<endl;
        exit( 1);
    }

    vout << "Write file ...." << endl;
    *p_out << "solid " << oname << endl;

    // find "bottom/left/front" corner to translate into positive octant
    Vertex_iterator vi = P.vertices_begin();
    Point p = vi->point();
    double minx = p.x();
    double miny = p.y();
    double minz = p.z();
    for ( ; vi != P.vertices_end(); ++vi) {
        p = vi->point();
        if ( p.x() < minx)
            minx = p.x();
        if ( p.y() < miny)
            miny = p.y();
        if ( p.z() < minz)
            minz = p.z();
    }
    // translate into positive octant
    Vector trans( -minx, -miny, -minz);
    for ( Vertex_iterator i = P.vertices_begin(); i != P.vertices_end(); ++i) {
        i->point() = i->point() + trans;
    }
    // write triangles
    for ( Facet_iterator i = P.facets_begin(); i != P.facets_end(); ++i) {
        Halfedge_handle h = i->halfedge();
        if ( h->next()->next()->next() != h) {
            cerr << argv[0] << " format error: polyhedron in file '"<<
                iname << "' is not triangulated." << endl;
            exit( 1);
        }
        Point p = h->vertex()->point();
        Point q = h->next()->vertex()->point();
        Point r = h->next()->next()->vertex()->point();
        // compute normal
        Vector n = CGAL::cross_product( q-p, r-p);
        Vector norm = n / std::sqrt( n * n);
        *p_out << "    facet normal " << norm << endl;
        *p_out << "      outer loop " << endl;
        *p_out << "        vertex " << p << endl;
        *p_out << "        vertex " << q << endl;
        *p_out << "        vertex " << r << endl;
        *p_out << "      endloop " << endl;
        *p_out << "    endfacet " << endl;
    }

    *p_out << "endsolid " << oname << endl;
    vout << "    .... done." << endl;

    if ( !*p_in) {
        cerr << argv[0] << " read error: while reading file '"<< iname << "'."
             << endl;
        exit( 1);
    }
    if ( !*p_out) {
        cerr << argv[0] <<" write error: while writing file '"<< oname << "'."
             << endl;
        exit( 1);
    }

    return 0;
}
// EOF //
