source: Swollen/swwreader/swwreader.cpp @ 44

/*
    SWWReader

    Reader of SWW files from within OpenSceneGraph.

    An SWW file is the visualization output of the pyVolution
    Shallow Water Wave equation solver.  SWW files contain bedslope
    geometry and a sequence of stages at known timesteps.  The
    internal format is NetCDF:

    netcdf demo.sww {
        dimensions:
            number_of_volumes = <integer> ;
            number_of_vertices = 3 ;
            number_of_points = <integer> ;
            number_of_timesteps = UNLIMITED ;
        variables:
            float x(number_of_points) ;
            float y(number_of_points) ;
            float z(number_of_points) ;
            int volumes(number_of_volumes, number_of_vertices) ;
            float time(number_of_timesteps) ;
            float stage(number_of_timesteps, number_of_points) ;

    copyright (C) 2004 Geoscience Australia
*/

#include <SWWReader.h>
#include <string>
#include <fstream>
#include <netcdf.h>
#include <osg/Notify>

#include <stdlib.h>
#include <stdio.h>

#define DEF_CULLNEARZERO    0.001
#define DEF_CULLSTEEPANGLE  0.9
#define DEF_CULLSTART       CULLNONE

#define MIN(a, b) (a < b ? a : b)
#define MAX(a, b) (a > b ? a : b)


// only constructor, requires netcdf file
SWWReader::SWWReader(const std::string& filename)
{
    // assume failure until end of constructor
    _valid = false;

    // netcdf filename
    _filename = new std::string(filename);

    // netcdf open
    _status.push_back( nc_open(_filename->c_str(), NC_NOWRITE, &_ncid) );
    if (this->_statusHasError()) return;

    // dimension ids
    _status.push_back( nc_inq_dimid(_ncid, "number_of_volumes", &_nvolumesid) );
    _status.push_back( nc_inq_dimid(_ncid, "number_of_vertices", &_nverticesid) );
    _status.push_back( nc_inq_dimid(_ncid, "number_of_points", &_npointsid) );
    _status.push_back( nc_inq_dimid(_ncid, "number_of_timesteps", &_ntimestepsid) );
    if (this->_statusHasError()) return;

    // dimension values
    _status.push_back( nc_inq_dimlen(_ncid, _nvolumesid, &_nvolumes) );
    _status.push_back( nc_inq_dimlen(_ncid, _nverticesid, &_nvertices) );
    _status.push_back( nc_inq_dimlen(_ncid, _npointsid, &_npoints) );
    _status.push_back( nc_inq_dimlen(_ncid, _ntimestepsid, &_ntimesteps) );
    if (this->_statusHasError()) return;

    // variable ids
    _status.push_back( nc_inq_varid (_ncid, "x", &_xid) );
    _status.push_back( nc_inq_varid (_ncid, "y", &_yid) );
    _status.push_back( nc_inq_varid (_ncid, "z", &_zid) );
    _status.push_back( nc_inq_varid (_ncid, "volumes", &_volumesid) );
    _status.push_back( nc_inq_varid (_ncid, "time", &_timeid) );
    _status.push_back( nc_inq_varid (_ncid, "stage", &_stageid) );
    if (this->_statusHasError()) return;

    // allocation of variable arrays, destructor responsible for cleanup
    _px = new float[_npoints];
    _py = new float[_npoints];
    _pz = new float[_npoints];
    _ptime = new float[_ntimesteps];
    _pvolumes = new unsigned int[_nvertices * _nvolumes];
    _pstage = new float[_npoints];

    // loading variables from netcdf file
    _status.push_back( nc_get_var_float (_ncid, _xid, _px) );  // x vertices
    _status.push_back( nc_get_var_float (_ncid, _yid, _py) );  // y vertices
    _status.push_back( nc_get_var_float (_ncid, _zid, _pz) );  // bedslope heights
    _status.push_back( nc_get_var_float (_ncid, _timeid, _ptime) );  // time array
    _status.push_back( nc_get_var_int (_ncid, _volumesid, (int *) _pvolumes) );  // triangle indices
    if (this->_statusHasError()) return;

    // loop index
    size_t iv;

    // vertex indices
    unsigned int v1index, v2index, v3index;

    // bedslope extents and resultant scale factors
    float xmin, xmax, xrange;
    float ymin, ymax, yrange;
    float zmin, zmax, zrange;
    float aspect_ratio;
    xmin = _px[0]; xmax = _px[0];
    ymin = _py[0]; ymax = _py[0];
    zmin = _pz[0]; zmax = _pz[0];
    for( iv=1; iv < _npoints; iv++ )
    {
      if( _px[iv] < xmin ) xmin = _px[iv];
      if( _px[iv] > xmax ) xmax = _px[iv];
      if( _py[iv] < ymin ) ymin = _py[iv];
      if( _py[iv] > ymax ) ymax = _py[iv];
      if( _pz[iv] < zmin ) zmin = _pz[iv];
      if( _pz[iv] > zmax ) zmax = _pz[iv];
    }

    xrange = xmax - xmin;
    yrange = ymax - ymin;
    aspect_ratio = xrange/yrange;
    if( aspect_ratio > 1.0 )
    {
            _xscale = 1.0 / xrange;
            _xoffset = xmin;
            _xcenter = 0.5;

            _yscale = _xscale;
            _yoffset = ymin;
            _ycenter = 0.5 / aspect_ratio;

            _zscale = _xscale;
            _zoffset = zmin;
            _zcenter = 0.0;
    }
    else
    {
            _yscale = 1.0 / yrange;
            _yoffset = ymin;
            _ycenter = 0.5;

            _xscale = _yscale;
            _xoffset = xmin;
            _xcenter = 0.5 / aspect_ratio;

            _zscale = _yscale;
            _zoffset = zmin;
            _zcenter = 0.0;
    }

    osg::notify(osg::INFO) << "[SWWReader] xmin: " << xmin <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] xmax: " << xmax <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] xscale: " << _xscale <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] ymin: " << ymin <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] ymax: " << ymax <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] yscale: " << _yscale <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] zmin: " << zmin <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] zmax: " << zmax <<  std::endl;
    osg::notify(osg::INFO) << "[SWWReader] zscale: " << _zscale <<  std::endl;


    // culling defaults
    _cullsetting = DEF_CULLSTART;
    _cullnearzero = DEF_CULLNEARZERO;
    _cullsteepangle = DEF_CULLSTEEPANGLE;

    // compute triangle connectivity, a list (indexed by vertex number) 
    // of lists (indices of triangles sharing this vertex)
    _connectivity = std::vector<triangle_list>(_npoints);
    for (iv=0; iv < _nvolumes; iv++)
    {
        v1index = _pvolumes[3*iv+0];
        v2index = _pvolumes[3*iv+1];
        v3index = _pvolumes[3*iv+2];
        _connectivity.at(v1index).push_back(iv);
        _connectivity.at(v2index).push_back(iv);
        _connectivity.at(v3index).push_back(iv);
    }

    // load bedslope vertex array, shifting and scaling vertices to unit cube
    // centred about the origin
    _bedslopevertices = new osg::Vec3Array;
    for (iv=0; iv < _npoints; iv++)
      _bedslopevertices->push_back( osg::Vec3( (_px[iv]-_xoffset)*_xscale - _xcenter, 
                                               (_py[iv]-_yoffset)*_yscale - _ycenter, 
                                               (_pz[iv]-_zoffset)*_zscale - _zcenter) );

    // load bedslope index array, pvolumes array indexes into x, y and z
    _bedslopeindices = new osg::UIntArray;
    for (iv=0; iv < _nvolumes*_nvertices; iv++)
        _bedslopeindices->push_back( _pvolumes[iv] );

    // calculate bedslope primitive normal and centroid arrays
    _bedslopenormals = new osg::Vec3Array;
    _bedslopecentroids = new osg::Vec3Array;
    osg::Vec3 v1, v2, v3, side1, side2, nrm;
    for (iv=0; iv < _nvolumes; iv++)
    {
        v1index = _pvolumes[3*iv+0];
        v2index = _pvolumes[3*iv+1];
        v3index = _pvolumes[3*iv+2];

        v1 = _bedslopevertices->at(v1index);
        v2 = _bedslopevertices->at(v2index);
        v3 = _bedslopevertices->at(v3index);

        side1 = v2 - v1;
        side2 = v3 - v2;
        nrm = side1^side2;
        nrm.normalize();

        _bedslopenormals->push_back( nrm );
        _bedslopecentroids->push_back( (v1+v2+v3)/3.0 );
    }

    // success!
    _valid = true;

}



SWWReader::~SWWReader()
{
    _status.push_back( nc_close(_ncid) );
    delete[]( _px, _py, _pz, _ptime, _pvolumes, _pstage );
}



osg::ref_ptr<osg::Vec3Array> SWWReader::getStageVertexArray(unsigned int index)
{
    size_t start[2], count[2], iv;
    const ptrdiff_t stride[2] = {1,1};
    start[0] = index;
    start[1] = 0;
    count[0] = 1;
    count[1] = _npoints;

    // stage heights from netcdf file (x and y are same as bedslope)
    int status = nc_get_vars_float (_ncid, _stageid, start, count, stride, _pstage);

    // load stage vertex array, scaling and shifting vertices to lie in the unit cube
    _stagevertices = new osg::Vec3Array;
    for (iv=0; iv < _npoints; iv++)
        _stagevertices->push_back( osg::Vec3(
                                             (_px[iv]-_xoffset)*_xscale - _xcenter, 
                                             (_py[iv]-_yoffset)*_yscale - _ycenter, 
                                             (_pstage[iv]-_zoffset)*_zscale - _zcenter) );

    // stage index and per primitive normal and centroid arrays
    _stageprimitivenormals = new osg::Vec3Array;
    _stagecentroids = new osg::Vec3Array;
    _stageindices = new osg::UIntArray;
    _stagecolors = new osg::Vec4Array;
    osg::Vec3 v1b, v2b, v3b;
    osg::Vec3 v1s, v2s, v3s;
    osg::Vec3 side1, side2, nrm;
    unsigned int v1index, v2index, v3index;
    osg::ref_ptr<osg::UIntArray> culledlist = new osg::UIntArray;
    std::vector<triangle_list> stageconnectivity = std::vector<triangle_list>(_npoints);

    // over all stage triangles
    unsigned int nonculled = 0;
    float alphamin = 1.0;
    float alphamax = 0.0;
    for (iv=0; iv < _nvolumes; iv++){

        v1index = _pvolumes[3*iv+0];
        v2index = _pvolumes[3*iv+1];
        v3index = _pvolumes[3*iv+2];

        v1s = _stagevertices->at(v1index);
        v2s = _stagevertices->at(v2index);
        v3s = _stagevertices->at(v3index);
        v1b = _bedslopevertices->at(v1index);
        v2b = _bedslopevertices->at(v2index);
        v3b = _bedslopevertices->at(v3index);

        // shallow water depth culling test
        if( (_cullsetting == CULLALL || _cullsetting == CULLNEARZERO) && 
            ((v1s.z()+v2s.z()+v3s.z())/3.0 - _bedslopecentroids->at(iv).z()) < _cullnearzero )
        {
            culledlist->push_back( iv );
            continue;
        }

        // steep bedslope culling test
        if( _cullsetting == CULLALL || _cullsetting == CULLSTEEPANGLE ) 
        {
            if( _bedslopenormals->at(iv) * osg::Vec3f(0,0,1) < _cullsteepangle )
            {
                culledlist->push_back( iv );
                continue;
            }
        }

        // pass through, current triangle is visible (not culled)
        _stageindices->push_back( v1index );
        _stageindices->push_back( v2index );
        _stageindices->push_back( v3index );

        // alpha value based on stage-bedslope height difference
        float alpha1 = ( v1s.z()-v1b.z() )*10.0;
        float alpha2 = ( v2s.z()-v2b.z() )*10.0;
        float alpha3 = ( v3s.z()-v3b.z() )*10.0;
        alphamax = MAX( alphamax, alpha1 );
        alphamax = MAX( alphamax, alpha2 );
        alphamax = MAX( alphamax, alpha3 );
        alphamin = MIN( alphamin, alpha1 );
        alphamin = MIN( alphamin, alpha2 );
        alphamin = MIN( alphamin, alpha3 );

        osg::Vec4 color1, color2, color3;
        color1.set( alpha1,alpha1,alpha1, 1.0 );
        color2.set( alpha2,alpha2,alpha2, 1.0 );
        color3.set( alpha3,alpha3,alpha3, 1.0 );
        //color1.set( alpha1,alpha1,alpha1, alpha1 );
        //color2.set( alpha2,alpha2,alpha2, alpha2 );
        //color3.set( alpha3,alpha3,alpha3, alpha3 );
        _stagecolors->push_back( color1 );
        _stagecolors->push_back( color2 );
        _stagecolors->push_back( color3 );

        // current triangle primitive normal
        side1 = v2s - v1s;
        side2 = v3s - v2s;
        nrm = side1^side2;
        nrm.normalize();

        // stage triangle connectivity, a list (indexed by vertex number) 
        // of lists (indices of non-culled triangles sharing this vertex)
        stageconnectivity.at(v1index).push_back(nonculled);
        stageconnectivity.at(v2index).push_back(nonculled);
        stageconnectivity.at(v3index).push_back(nonculled);

        // store centroid and primitive normal (both needed to visualize vectors)
        _stagecentroids->push_back( (v1s+v2s+v3s)/3.0 );
        _stageprimitivenormals->push_back( nrm );

        // non-culled triangle count
        nonculled++;

    }

    std::cout << "index: " << index << "    AlphaMax: " << alphamax << std::endl;
    std::cout << "index: " << index << "    AlphaMin: " << alphamin << std::endl;

    // per-vertex normals
    _stagevertexnormals = new osg::Vec3Array;
    int num_shared_triangles, triangle_index;
    for (iv=0; iv < _npoints; iv++)
    {
        nrm.set(0,0,0);
        num_shared_triangles = stageconnectivity.at(iv).size();
        for (int i=0; i<num_shared_triangles; i++ )
        {
            triangle_index = stageconnectivity.at(iv).at(i);

            // summing of contributing primitive normals
            nrm += _stageprimitivenormals->at(triangle_index);
        }

        // FIXME: Length of this list has to match vertex list length.
        // We have vertices and normals that aren't being referenced.
        if( 1 || num_shared_triangles )  // avoid vertices belonging only to culled triangles
        {
            nrm = nrm / num_shared_triangles;  // average
            nrm.normalize();
            _stagevertexnormals->push_back(nrm);
        }
    }

    return _stagevertices;
}



void SWWReader::toggleCullSetting()
{

  switch( _cullsetting )
    {

    case CULLALL:
      _cullsetting = CULLNEARZERO;
      osg::notify(osg::INFO) << "[SWWReader::toggleCullSetting] CULLNEARZERO" <<  std::endl;
      break;

    case CULLNEARZERO:
      _cullsetting = CULLSTEEPANGLE;
      osg::notify(osg::INFO) << "[SWWReader::toggleCullSetting] CULLSTEEPANGLE" <<  std::endl;
      break;

    case CULLSTEEPANGLE:
      _cullsetting = CULLNONE;
      osg::notify(osg::INFO) << "[SWWReader::toggleCullSetting] CULLNONE" <<  std::endl;
      break;

    case CULLNONE:
      _cullsetting = CULLALL;
      osg::notify(osg::INFO) << "[SWWReader::toggleCullSetting] CULLALL" <<  std::endl;
      break;

    }
}



bool SWWReader::_statusHasError()
{
    bool haserror = false;  // assume success, trap failure

    std::vector<int>::iterator iter;
    for (iter=_status.begin(); iter != _status.end(); iter++)
    {
        if (*iter != NC_NOERR)
        {
            osg::notify(osg::WARN) << nc_strerror(*iter) <<  std::endl;
            haserror = true;
            nc_close(_ncid);
            break;
        }
    }

    // on return start gathering result values afresh
    _status.clear();

    return haserror;
}