#include "HYDROData_Bathymetry.h"
+#include "HYDROData_Document.h"
+#include "HYDROData_Tool.h"
+#include "HYDROData_PolylineXY.h"
+
+#include <boost/math/special_functions/fpclassify.hpp>
#include <gp_XY.hxx>
#include <gp_XYZ.hxx>
#include <TDataStd_RealArray.hxx>
+#include <TDataStd_AsciiString.hxx>
+#include <TDataStd_Integer.hxx>
#include <QFile>
#include <QFileInfo>
#include <QPointF>
+#include <QPolygonF>
#include <QStringList>
-IMPLEMENT_STANDARD_HANDLE(HYDROData_Bathymetry, HYDROData_Object)
-IMPLEMENT_STANDARD_RTTIEXT(HYDROData_Bathymetry, HYDROData_Object)
+#include <math.h>
+
+// #define _TIMER
+#ifdef _TIMER
+#include <OSD_Timer.hxx>
+#endif
+
+IMPLEMENT_STANDARD_HANDLE(HYDROData_Bathymetry, HYDROData_IAltitudeObject)
+IMPLEMENT_STANDARD_RTTIEXT(HYDROData_Bathymetry, HYDROData_IAltitudeObject)
HYDROData_Bathymetry::HYDROData_Bathymetry()
+: HYDROData_IAltitudeObject()
{
}
{
}
+QStringList HYDROData_Bathymetry::DumpToPython( MapOfTreatedObjects& theTreatedObjects ) const
+{
+ QStringList aResList = dumpObjectCreation( theTreatedObjects );
+ QString aBathymetryName = GetObjPyName();
+
+ aResList << QString( "%1.SetAltitudesInverted( %2 );" )
+ .arg( aBathymetryName ).arg( IsAltitudesInverted() );
+
+ TCollection_AsciiString aFilePath = GetFilePath();
+ aResList << QString( "%1.ImportFromFile( \"%2\" );" )
+ .arg( aBathymetryName ).arg( aFilePath.ToCString() );
+
+ aResList << QString( "" );
+ aResList << QString( "%1.Update();" ).arg( aBathymetryName );
+ aResList << QString( "" );
+
+ return aResList;
+}
+
void HYDROData_Bathymetry::SetAltitudePoints( const AltitudePoints& thePoints )
{
RemoveAltitudePoints();
- if ( thePoints.isEmpty() )
+ if ( thePoints.IsEmpty() )
return;
// Save coordinates
Handle(TDataStd_RealArray) aCoordsArray =
- TDataStd_RealArray::Set( myLab.FindChild( DataTag_AltitudePoints ), 0, thePoints.size() * 3 - 1 );
+ TDataStd_RealArray::Set( myLab.FindChild( DataTag_AltitudePoints ), 0, thePoints.Length() * 3 - 1 );
- AltitudePoints::const_iterator aListItBeg = thePoints.constBegin();
- AltitudePoints::const_iterator aListItEnd = thePoints.constEnd();
- for ( int i = 0 ; aListItBeg != aListItEnd; ++i, ++aListItBeg )
+ AltitudePoints::Iterator anIter( thePoints );
+ for ( int i = 0 ; anIter.More(); ++i, anIter.Next() )
{
- const AltitudePoint& aPoint = *aListItBeg;
+ const AltitudePoint& aPoint = anIter.Value();
aCoordsArray->SetValue( i * 3, aPoint.X() );
aCoordsArray->SetValue( i * 3 + 1, aPoint.Y() );
aCoordsArray->SetValue( i * 3 + 2, aPoint.Z() );
}
+
+ SetToUpdate( true );
}
HYDROData_Bathymetry::AltitudePoints HYDROData_Bathymetry::GetAltitudePoints() const
{
AltitudePoints aPoints;
+ TDF_Label aLabel = myLab.FindChild( DataTag_AltitudePoints, false );
+ if ( aLabel.IsNull() )
+ return aPoints;
+
Handle(TDataStd_RealArray) aCoordsArray;
- if ( !myLab.FindChild( DataTag_AltitudePoints ).FindAttribute( TDataStd_RealArray::GetID(), aCoordsArray ) )
+ if ( !aLabel.FindAttribute( TDataStd_RealArray::GetID(), aCoordsArray ) )
return aPoints;
- int aLowerIdx = aCoordsArray->Lower();
- int anUpperIdx = aCoordsArray->Upper();
for ( int i = aCoordsArray->Lower(), n = aCoordsArray->Upper(); i <= n; )
{
- if ( i + 3 > n )
+ if ( i + 3 > n + 1 )
break;
AltitudePoint aPoint;
aPoint.SetY( aCoordsArray->Value( i++ ) );
aPoint.SetZ( aCoordsArray->Value( i++ ) );
- aPoints << aPoint;
+ aPoints.Append( aPoint );
}
return aPoints;
void HYDROData_Bathymetry::RemoveAltitudePoints()
{
- TDF_Label aLab = myLab.FindChild( DataTag_AltitudePoints );
- aLab.ForgetAllAttributes();
+ TDF_Label aLabel = myLab.FindChild( DataTag_AltitudePoints, false );
+ if ( !aLabel.IsNull() )
+ {
+ aLabel.ForgetAllAttributes();
+ SetToUpdate( true );
+ }
}
-double HYDROData_Bathymetry::GetAltitudeForPoint( const QPointF& thePoint ) const
+void interpolateAltitudeForPoints( const gp_XY& thePoint,
+ const HYDROData_Bathymetry::AltitudePoint& theFirstPoint,
+ const HYDROData_Bathymetry::AltitudePoint& theSecPoint,
+ HYDROData_Bathymetry::AltitudePoint& theResPoint,
+ const bool& theIsVertical )
{
- gp_XY aGpPoint( thePoint.x(), thePoint.y() );
- return GetAltitudeForPoint( aGpPoint );
+ double aCoordX = thePoint.X();
+ double aCoordY = thePoint.Y();
+
+ if ( theIsVertical )
+ {
+ aCoordX = theFirstPoint.X();
+
+ if ( !ValuesEquals( theFirstPoint.X(), theSecPoint.X() ) )
+ {
+ // Recalculate X coordinate by equation of line from two points
+ aCoordX = ( ( ( thePoint.Y() - theFirstPoint.Y() ) * ( theSecPoint.X() - theFirstPoint.X() ) ) /
+ ( theSecPoint.Y() - theFirstPoint.Y() ) ) + theFirstPoint.X();
+ }
+ }
+ else
+ {
+ aCoordY = theFirstPoint.Y();
+
+ if ( !ValuesEquals( theFirstPoint.Y(), theSecPoint.Y() ) )
+ {
+ // Recalculate y by equation of line from two points
+ aCoordY = ( ( ( thePoint.X() - theFirstPoint.X() ) * ( theSecPoint.Y() - theFirstPoint.Y() ) ) /
+ ( theSecPoint.X() - theFirstPoint.X() ) ) + theFirstPoint.Y();
+ }
+ }
+
+ theResPoint.SetX( aCoordX );
+ theResPoint.SetY( aCoordY );
+
+ // Calculate coefficient for interpolation
+ double aLength = Sqrt( Pow( theSecPoint.Y() - theFirstPoint.Y(), 2 ) +
+ Pow( theSecPoint.X() - theFirstPoint.X(), 2 ) );
+
+ double aInterCoeff = 0;
+ if ( aLength != 0 )
+ aInterCoeff = ( theSecPoint.Z() - theFirstPoint.Z() ) / aLength;
+
+
+ double aNewLength = Sqrt( Pow( theResPoint.Y() - theFirstPoint.Y(), 2 ) +
+ Pow( theResPoint.X() - theFirstPoint.X(), 2 ) );
+
+ // Calculate interpolated value
+ double aResVal = theFirstPoint.Z() + aInterCoeff * aNewLength;
+
+ theResPoint.SetZ( aResVal );
}
double HYDROData_Bathymetry::GetAltitudeForPoint( const gp_XY& thePoint ) const
{
- double aResAltitude = -9999.90;
+ double anInvalidAltitude = GetInvalidAltitude();
+ double aResAltitude = anInvalidAltitude;
AltitudePoints anAltitudePoints = GetAltitudePoints();
+ if ( anAltitudePoints.IsEmpty() )
+ return aResAltitude;
+
+ QPolygonF aBoundingRect;
+
+ // Boundary plane
+ // [ 0 (top-left) ] [ 1 (top-right) ]
+ // thePoint
+ // [ 2 (bot-left) ] [ 3 (bot-right) ]
+ AltitudePoint aBounds[ 4 ] = { AltitudePoint( -DBL_MAX, -DBL_MAX, anInvalidAltitude ),
+ AltitudePoint( DBL_MAX, -DBL_MAX, anInvalidAltitude ),
+ AltitudePoint( -DBL_MAX, DBL_MAX, anInvalidAltitude ),
+ AltitudePoint( DBL_MAX, DBL_MAX, anInvalidAltitude ) };
+
+ AltitudePoints::Iterator anIter( anAltitudePoints );
+ for ( ; anIter.More(); anIter.Next() )
+ {
+ const AltitudePoint& aPoint = anIter.Value();
+
+ double aDeltaX = Abs( aPoint.X() ) - Abs( thePoint.X() );
+ double aDeltaY = Abs( aPoint.Y() ) - Abs( thePoint.Y() );
+
+ if ( ValuesEquals( aDeltaX, 0.0 ) ) // Both left and right sides
+ {
+ if ( ValuesEquals( aDeltaY, 0.0 ) ) // Both top and bottom sides
+ {
+ aResAltitude = aPoint.Z();
+ return aResAltitude;
+ }
+ else if ( aDeltaY < 0 ) // top side
+ {
+ // top border
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 0 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 0 ].Y() ) )
+ aBounds[ 0 ] = aPoint;
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 1 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 1 ].Y() ) )
+ aBounds[ 1 ] = aPoint;
+ }
+ else
+ {
+ // bottom border
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 2 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 2 ].Y() ) )
+ aBounds[ 2 ] = aPoint;
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 3 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 3 ].Y() ) )
+ aBounds[ 3 ] = aPoint;
+ }
+ }
+ else if ( aDeltaX < 0 ) // left side
+ {
+ if ( ValuesEquals( aDeltaY, 0.0 ) )
+ {
+ // Left border
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 0 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 0 ].Y() ) )
+ aBounds[ 0 ] = aPoint;
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 2 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 2 ].Y() ) )
+ aBounds[ 2 ] = aPoint;
+ }
+ else if ( aDeltaY < 0 )
+ {
+ // top left corner
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 0 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 0 ].Y() ) )
+ aBounds[ 0 ] = aPoint;
+ }
+ else
+ {
+ // bottom left corner
+ if ( ValuesMoreEquals( aPoint.X(), aBounds[ 2 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 2 ].Y() ) )
+ aBounds[ 2 ] = aPoint;
+ }
+ }
+ else // right side
+ {
+ if ( ValuesEquals( aDeltaY, 0.0 ) )
+ {
+ // Right border
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 1 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 1 ].Y() ) )
+ aBounds[ 1 ] = aPoint;
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 3 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 3 ].Y() ) )
+ aBounds[ 3 ] = aPoint;
+ }
+ else if ( aDeltaY < 0 )
+ {
+ // top right corner
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 1 ].X() ) && ValuesMoreEquals( aPoint.Y(), aBounds[ 1 ].Y() ) )
+ aBounds[ 1 ] = aPoint;
+ }
+ else
+ {
+ // bottom right corner
+ if ( ValuesLessEquals( aPoint.X(), aBounds[ 3 ].X() ) && ValuesLessEquals( aPoint.Y(), aBounds[ 3 ].Y() ) )
+ aBounds[ 3 ] = aPoint;
+ }
+ }
+
+ // Update bounding rectangle of our global grid
+ aBoundingRect << QPointF( aPoint.X(), aPoint.Y() );
+ }
+
+ const double LIMIT = 1E300;
+ if( fabs( aBounds[ 0 ].X() ) > LIMIT || fabs( aBounds[ 0 ].Y() ) > LIMIT ||
+ fabs( aBounds[ 1 ].X() ) > LIMIT || fabs( aBounds[ 1 ].Y() ) > LIMIT ||
+ fabs( aBounds[ 2 ].X() ) > LIMIT || fabs( aBounds[ 2 ].Y() ) > LIMIT ||
+ fabs( aBounds[ 3 ].X() ) > LIMIT || fabs( aBounds[ 3 ].Y() ) > LIMIT )
+ return anInvalidAltitude;
+
+
+ // Check if requested point is inside of our bounding rectangle
+ if ( !aBoundingRect.boundingRect().contains( thePoint.X(), thePoint.Y() ) )
+ return aResAltitude;
+
+ // Calculate result altitude for point
+ AltitudePoint aFirstPoint( aBounds[ 0 ] ), aSecPoint( aBounds[ 1 ] );
+
+ // At first we merge top and bottom borders
+ if ( aBounds[ 0 ].Y() != aBounds[ 2 ].Y() || aBounds[ 0 ].X() != aBounds[ 2 ].X() )
+ interpolateAltitudeForPoints( thePoint, aBounds[ 0 ], aBounds[ 2 ], aFirstPoint, true );
+
+ if ( aBounds[ 1 ].Y() != aBounds[ 3 ].Y() || aBounds[ 1 ].X() != aBounds[ 3 ].X() )
+ interpolateAltitudeForPoints( thePoint, aBounds[ 1 ], aBounds[ 3 ], aSecPoint, true );
+
+ AltitudePoint aResPoint( aFirstPoint );
- // TODO : implement
+ // At last we merge left and right borders
+ if ( aFirstPoint.Y() != aSecPoint.Y() || aFirstPoint.X() != aSecPoint.X() )
+ interpolateAltitudeForPoints( thePoint, aFirstPoint, aSecPoint, aResPoint, false );
+
+ aResAltitude = aResPoint.Z();
return aResAltitude;
}
-bool HYDROData_Bathymetry::ImportFromFile( const QString& theFileName )
+void HYDROData_Bathymetry::SetFilePath( const TCollection_AsciiString& theFilePath )
+{
+ TDataStd_AsciiString::Set( myLab.FindChild( DataTag_FilePath ), theFilePath );
+}
+
+TCollection_AsciiString HYDROData_Bathymetry::GetFilePath() const
+{
+ TCollection_AsciiString aRes;
+
+ TDF_Label aLabel = myLab.FindChild( DataTag_FilePath, false );
+ if ( !aLabel.IsNull() )
+ {
+ Handle(TDataStd_AsciiString) anAsciiStr;
+ if ( aLabel.FindAttribute( TDataStd_AsciiString::GetID(), anAsciiStr ) )
+ aRes = anAsciiStr->Get();
+ }
+
+ return aRes;
+}
+
+void HYDROData_Bathymetry::SetAltitudesInverted( const bool theIsInverted,
+ const bool theIsUpdate )
+{
+ bool anIsAltitudesInverted = IsAltitudesInverted();
+ if ( anIsAltitudesInverted == theIsInverted )
+ return;
+
+ TDataStd_Integer::Set( myLab.FindChild( DataTag_AltitudesInverted ), (Standard_Integer)theIsInverted );
+
+ SetToUpdate( true );
+
+ if ( !theIsUpdate )
+ return;
+
+ // Update altitude points
+ AltitudePoints anAltitudePoints = GetAltitudePoints();
+ if ( anAltitudePoints.IsEmpty() )
+ return;
+
+ AltitudePoints::Iterator anIter( anAltitudePoints );
+ for ( ; anIter.More(); anIter.Next() )
+ {
+ AltitudePoint& aPoint = anIter.ChangeValue();
+ aPoint.SetZ( aPoint.Z() * -1 );
+ }
+
+ SetAltitudePoints( anAltitudePoints );
+}
+
+bool HYDROData_Bathymetry::IsAltitudesInverted() const
+{
+ bool aRes = false;
+
+ TDF_Label aLabel = myLab.FindChild( DataTag_AltitudesInverted, false );
+ if ( !aLabel.IsNull() )
+ {
+ Handle(TDataStd_Integer) anIntVal;
+ if ( aLabel.FindAttribute( TDataStd_Integer::GetID(), anIntVal ) )
+ aRes = (bool)anIntVal->Get();
+ }
+
+ return aRes;
+}
+
+bool HYDROData_Bathymetry::ImportFromFile( const TCollection_AsciiString& theFileName )
{
// Try to open the file
- QFile aFile( theFileName );
+ QFile aFile( theFileName.ToCString() );
if ( !aFile.exists() || !aFile.open( QIODevice::ReadOnly ) )
return false;
// Try to import the file
if ( aFileSuf == "xyz" )
aRes = importFromXYZFile( aFile, aPoints );
-
+
// Close the file
aFile.close();
+
+
+ // Convert from global to local CS
+ Handle_HYDROData_Document aDoc = HYDROData_Document::Document( myLab );
+ AltitudePoints::Iterator anIter( aPoints );
+ for ( ; anIter.More(); anIter.Next() )
+ {
+ AltitudePoint& aPoint = anIter.ChangeValue();
+ aDoc->Transform( aPoint, true );
+ }
if ( aRes )
{
- // Update altitude points of this Bathymetry
+ // Update file path and altitude points of this Bathymetry
+ SetFilePath( theFileName );
SetAltitudePoints( aPoints );
}
- return aRes && !aPoints.isEmpty();
+ return aRes && !aPoints.IsEmpty();
}
bool HYDROData_Bathymetry::importFromXYZFile( QFile& theFile,
- AltitudePoints& thePoints )
+ AltitudePoints& thePoints ) const
{
if ( !theFile.isOpen() )
return false;
// 2. X(float) Y(float) Z(float)
// ...
+#ifdef _TIMER
+ OSD_Timer aTimer;
+ aTimer.Start();
+#endif
+
+ bool anIsAltitudesInverted = IsAltitudesInverted();
while ( !theFile.atEnd() )
{
- QString aLine = theFile.readLine();
+ QString aLine = theFile.readLine().simplified();
if ( aLine.isEmpty() )
continue;
- QStringList aValues = aLine.split( QRegExp( "\\s+" ), QString::SkipEmptyParts );
+ QStringList aValues = aLine.split( ' ', QString::SkipEmptyParts );
if ( aValues.length() < 3 )
return false;
aPoint.SetX( anX.toDouble( &isXOk ) );
aPoint.SetY( anY.toDouble( &isYOk ) );
- aPoint.SetZ( aZ.toDouble( &isZOk ) );
+ aPoint.SetZ( aZ.toDouble( &isZOk ) );
if ( !isXOk || !isYOk || !isZOk )
return false;
- thePoints << aPoint;
+ if ( boost::math::isnan( aPoint.X() ) || boost::math::isinf( aPoint.X() ) ||
+ boost::math::isnan( aPoint.Y() ) || boost::math::isinf( aPoint.Y() ) ||
+ boost::math::isnan( aPoint.Z() ) || boost::math::isinf( aPoint.Z() ) )
+ return false;
+
+ // Invert the z value if requested
+ if ( anIsAltitudesInverted )
+ aPoint.SetZ( -aPoint.Z() );
+
+ thePoints.Append( aPoint );
}
+#ifdef _TIMER
+ aTimer.Stop();
+ std::ofstream stream( "W:/HYDRO/WORK/log.txt", std::ofstream::out );
+ aTimer.Show( stream );
+#endif
+
return true;
}
+Handle_HYDROData_PolylineXY HYDROData_Bathymetry::CreateBoundaryPolyline() const
+{
+ Handle(HYDROData_Document) aDocument = HYDROData_Document::Document( myLab );
+ Handle_HYDROData_PolylineXY aResult =
+ Handle_HYDROData_PolylineXY::DownCast( aDocument->CreateObject( KIND_POLYLINEXY ) );
+
+ if( aResult.IsNull() )
+ return aResult;
+
+ //search free name
+ QString aPolylinePref = GetName() + "_Boundary";
+ QString aPolylineName = HYDROData_Tool::GenerateObjectName( aDocument, aPolylinePref );
+ aResult->SetName( aPolylineName );
+ double Xmin = 0.0, Xmax = 0.0, Ymin = 0.0, Ymax = 0.0;
+ bool isFirst = true;
+ AltitudePoints aPoints = GetAltitudePoints();
+
+ AltitudePoints::Iterator anIter( aPoints );
+ for ( ; anIter.More(); anIter.Next() )
+ {
+ const AltitudePoint& aPoint = anIter.Value();
+
+ double x = aPoint.X(), y = aPoint.Y();
+ if( isFirst || x<Xmin )
+ Xmin = x;
+ if( isFirst || x>Xmax )
+ Xmax = x;
+ if( isFirst || y<Ymin )
+ Ymin = y;
+ if( isFirst || y>Ymax )
+ Ymax = y;
+ isFirst = false;
+ }
+
+ aResult->AddSection( "bound", HYDROData_IPolyline::SECTION_POLYLINE, true );
+ aResult->AddPoint( 0, HYDROData_IPolyline::Point( Xmin, Ymin ) );
+ aResult->AddPoint( 0, HYDROData_IPolyline::Point( Xmin, Ymax ) );
+ aResult->AddPoint( 0, HYDROData_IPolyline::Point( Xmax, Ymax ) );
+ aResult->AddPoint( 0, HYDROData_IPolyline::Point( Xmax, Ymin ) );
+ aResult->Update();
+
+ return aResult;
+}
+
+void HYDROData_Bathymetry::UpdateLocalCS( double theDx, double theDy )
+{
+ gp_XYZ aDelta( theDx, theDy, 0 );
+ AltitudePoints aPoints = GetAltitudePoints();
+ AltitudePoints::Iterator anIter( aPoints );
+ for ( int i = 0 ; anIter.More(); ++i, anIter.Next() )
+ {
+ AltitudePoint& aPoint = anIter.ChangeValue();
+ aPoint += aDelta;
+ }
+ SetAltitudePoints( aPoints );
+}