Moved Gui/InputVector,Placement,Transform from float to double Moved Sketcher from float to double more suggestions for moving float -> double
328 lines
12 KiB
C++
328 lines
12 KiB
C++
/***************************************************************************
|
|
* Copyright (c) Juergen Riegel <juergen.riegel@web.de> *
|
|
* *
|
|
* This file is part of the FreeCAD CAx development system. *
|
|
* *
|
|
* This library is free software; you can redistribute it and/or *
|
|
* modify it under the terms of the GNU Library General Public *
|
|
* License as published by the Free Software Foundation; either *
|
|
* version 2 of the License, or (at your option) any later version. *
|
|
* *
|
|
* This library is distributed in the hope that it will be useful, *
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
|
* GNU Library General Public License for more details. *
|
|
* *
|
|
* You should have received a copy of the GNU Library General Public *
|
|
* License along with this library; see the file COPYING.LIB. If not, *
|
|
* write to the Free Software Foundation, Inc., 59 Temple Place, *
|
|
* Suite 330, Boston, MA 02111-1307, USA *
|
|
* *
|
|
***************************************************************************/
|
|
|
|
|
|
#include "PreCompiled.h"
|
|
#ifndef _PreComp_
|
|
# include <cmath>
|
|
# include <iostream>
|
|
# include <algorithm>
|
|
#endif
|
|
|
|
#include <Base/Exception.h>
|
|
#include <Base/Matrix.h>
|
|
#include <Base/Persistence.h>
|
|
#include <Base/Stream.h>
|
|
#include <Base/Writer.h>
|
|
|
|
#include "Points.h"
|
|
#include "Properties.h"
|
|
#include "PointsPy.h"
|
|
|
|
using namespace Points;
|
|
using namespace std;
|
|
|
|
TYPESYSTEM_SOURCE(Points::PropertyGreyValue, App::PropertyFloat);
|
|
TYPESYSTEM_SOURCE(Points::PropertyGreyValueList, App::PropertyFloatList);
|
|
TYPESYSTEM_SOURCE(Points::PropertyNormalList, App::PropertyVectorList);
|
|
TYPESYSTEM_SOURCE(Points::PropertyCurvatureList , App::PropertyLists);
|
|
|
|
void PropertyGreyValueList::removeIndices( const std::vector<unsigned long>& uIndices )
|
|
{
|
|
#if 0
|
|
// We need a sorted array
|
|
std::vector<unsigned long> uSortedInds = uIndices;
|
|
std::sort(uSortedInds.begin(), uSortedInds.end());
|
|
|
|
const std::vector<double>& rValueList = getValues();
|
|
|
|
assert( uSortedInds.size() <= rValueList.size() );
|
|
if ( uSortedInds.size() > rValueList.size() )
|
|
return;
|
|
|
|
std::vector<double> remainValue;
|
|
remainValue.reserve(rValueList.size() - uSortedInds.size());
|
|
|
|
std::vector<unsigned long>::iterator pos = uSortedInds.begin();
|
|
for ( std::vector<double>::const_iterator it = rValueList.begin(); it != rValueList.end(); ++it ) {
|
|
unsigned long index = it - rValueList.begin();
|
|
if (pos == uSortedInds.end())
|
|
remainValue.push_back( *it );
|
|
else if (index != *pos)
|
|
remainValue.push_back( *it );
|
|
else
|
|
pos++;
|
|
}
|
|
|
|
setValues(remainValue);
|
|
#endif
|
|
}
|
|
|
|
void PropertyNormalList::transform(const Base::Matrix4D &mat)
|
|
{
|
|
// A normal vector is only a direction with unit length, so we only need to rotate it
|
|
// (no translations or scaling)
|
|
|
|
// Extract scale factors (assumes an orthogonal rotation matrix)
|
|
// Use the fact that the length of the row vectors of R are all equal to 1
|
|
// And that scaling is applied after rotating
|
|
double s[3];
|
|
s[0] = sqrt(mat[0][0] * mat[0][0] + mat[0][1] * mat[0][1] + mat[0][2] * mat[0][2]);
|
|
s[1] = sqrt(mat[1][0] * mat[1][0] + mat[1][1] * mat[1][1] + mat[1][2] * mat[1][2]);
|
|
s[2] = sqrt(mat[2][0] * mat[2][0] + mat[2][1] * mat[2][1] + mat[2][2] * mat[2][2]);
|
|
|
|
// Set up the rotation matrix: zero the translations and make the scale factors = 1
|
|
Base::Matrix4D rot;
|
|
rot.setToUnity();
|
|
for (unsigned short i = 0; i < 3; i++) {
|
|
for (unsigned short j = 0; j < 3; j++) {
|
|
rot[i][j] = mat[i][j] / s[i];
|
|
}
|
|
}
|
|
|
|
// Rotate the normal vectors
|
|
for (int ii=0; ii<getSize(); ii++) {
|
|
set1Value(ii, rot * operator[](ii));
|
|
}
|
|
}
|
|
|
|
void PropertyNormalList::removeIndices( const std::vector<unsigned long>& uIndices )
|
|
{
|
|
// We need a sorted array
|
|
std::vector<unsigned long> uSortedInds = uIndices;
|
|
std::sort(uSortedInds.begin(), uSortedInds.end());
|
|
|
|
const std::vector<Base::Vector3d>& rValueList = getValues();
|
|
|
|
assert( uSortedInds.size() <= rValueList.size() );
|
|
if ( uSortedInds.size() > rValueList.size() )
|
|
return;
|
|
|
|
std::vector<Base::Vector3d> remainValue;
|
|
remainValue.reserve(rValueList.size() - uSortedInds.size());
|
|
|
|
std::vector<unsigned long>::iterator pos = uSortedInds.begin();
|
|
for ( std::vector<Base::Vector3d>::const_iterator it = rValueList.begin(); it != rValueList.end(); ++it ) {
|
|
unsigned long index = it - rValueList.begin();
|
|
if (pos == uSortedInds.end())
|
|
remainValue.push_back( *it );
|
|
else if (index != *pos)
|
|
remainValue.push_back( *it );
|
|
else
|
|
pos++;
|
|
}
|
|
|
|
setValues(remainValue);
|
|
}
|
|
|
|
PropertyCurvatureList::PropertyCurvatureList()
|
|
{
|
|
|
|
}
|
|
|
|
PropertyCurvatureList::~PropertyCurvatureList()
|
|
{
|
|
|
|
}
|
|
|
|
void PropertyCurvatureList::setValue(const CurvatureInfo& lValue)
|
|
{
|
|
aboutToSetValue();
|
|
_lValueList.resize(1);
|
|
_lValueList[0]=lValue;
|
|
hasSetValue();
|
|
}
|
|
|
|
void PropertyCurvatureList::setValues(const std::vector<CurvatureInfo>& lValues)
|
|
{
|
|
aboutToSetValue();
|
|
_lValueList=lValues;
|
|
hasSetValue();
|
|
}
|
|
|
|
std::vector<float> PropertyCurvatureList::getCurvature( int mode ) const
|
|
{
|
|
const std::vector<Points::CurvatureInfo>& fCurvInfo = getValues();
|
|
std::vector<float> fValues;
|
|
fValues.reserve(fCurvInfo.size());
|
|
|
|
// Mean curvature
|
|
if (mode == MeanCurvature) {
|
|
for (std::vector<Points::CurvatureInfo>::const_iterator it=fCurvInfo.begin();it!=fCurvInfo.end(); ++it) {
|
|
fValues.push_back( 0.5f*(it->fMaxCurvature+it->fMinCurvature) );
|
|
}
|
|
}
|
|
// Gaussian curvature
|
|
else if (mode == GaussCurvature) {
|
|
for (std::vector<Points::CurvatureInfo>::const_iterator it=fCurvInfo.begin();it!=fCurvInfo.end(); ++it) {
|
|
fValues.push_back( it->fMaxCurvature * it->fMinCurvature );
|
|
}
|
|
}
|
|
// Maximum curvature
|
|
else if (mode == MaxCurvature) {
|
|
for (std::vector<Points::CurvatureInfo>::const_iterator it=fCurvInfo.begin();it!=fCurvInfo.end(); ++it) {
|
|
fValues.push_back( it->fMaxCurvature );
|
|
}
|
|
}
|
|
// Minimum curvature
|
|
else if (mode == MinCurvature) {
|
|
for (std::vector<Points::CurvatureInfo>::const_iterator it=fCurvInfo.begin();it!=fCurvInfo.end(); ++it) {
|
|
fValues.push_back( it->fMinCurvature );
|
|
}
|
|
}
|
|
// Absolute curvature
|
|
else if (mode == AbsCurvature) {
|
|
for (std::vector<Points::CurvatureInfo>::const_iterator it=fCurvInfo.begin();it!=fCurvInfo.end(); ++it) {
|
|
if (fabs(it->fMaxCurvature) > fabs(it->fMinCurvature))
|
|
fValues.push_back( it->fMaxCurvature );
|
|
else
|
|
fValues.push_back( it->fMinCurvature );
|
|
}
|
|
}
|
|
|
|
return fValues;
|
|
}
|
|
|
|
void PropertyCurvatureList::transform(const Base::Matrix4D &mat)
|
|
{
|
|
// The principal direction is only a vector with unit length, so we only need to rotate it
|
|
// (no translations or scaling)
|
|
|
|
// Extract scale factors (assumes an orthogonal rotation matrix)
|
|
// Use the fact that the length of the row vectors of R are all equal to 1
|
|
// And that scaling is applied after rotating
|
|
double s[3];
|
|
s[0] = sqrt(mat[0][0] * mat[0][0] + mat[0][1] * mat[0][1] + mat[0][2] * mat[0][2]);
|
|
s[1] = sqrt(mat[1][0] * mat[1][0] + mat[1][1] * mat[1][1] + mat[1][2] * mat[1][2]);
|
|
s[2] = sqrt(mat[2][0] * mat[2][0] + mat[2][1] * mat[2][1] + mat[2][2] * mat[2][2]);
|
|
|
|
// Set up the rotation matrix: zero the translations and make the scale factors = 1
|
|
Base::Matrix4D rot;
|
|
rot.setToUnity();
|
|
for (unsigned short i = 0; i < 3; i++) {
|
|
for (unsigned short j = 0; j < 3; j++) {
|
|
rot[i][j] = mat[i][j] / s[i];
|
|
}
|
|
}
|
|
|
|
// Rotate the principal directions
|
|
for (int ii=0; ii<getSize(); ii++) {
|
|
CurvatureInfo ci = operator[](ii);
|
|
ci.cMaxCurvDir = rot * ci.cMaxCurvDir;
|
|
ci.cMinCurvDir = rot * ci.cMinCurvDir;
|
|
set1Value(ii, ci);
|
|
}
|
|
}
|
|
|
|
void PropertyCurvatureList::removeIndices( const std::vector<unsigned long>& uIndices )
|
|
{
|
|
// We need a sorted array
|
|
std::vector<unsigned long> uSortedInds = uIndices;
|
|
std::sort(uSortedInds.begin(), uSortedInds.end());
|
|
|
|
assert( uSortedInds.size() <= _lValueList.size() );
|
|
if ( uSortedInds.size() > _lValueList.size() )
|
|
return;
|
|
|
|
std::vector<CurvatureInfo> remainValue;
|
|
remainValue.reserve(_lValueList.size() - uSortedInds.size());
|
|
|
|
std::vector<unsigned long>::iterator pos = uSortedInds.begin();
|
|
for ( std::vector<CurvatureInfo>::const_iterator it = _lValueList.begin(); it != _lValueList.end(); ++it ) {
|
|
unsigned long index = it - _lValueList.begin();
|
|
if (pos == uSortedInds.end())
|
|
remainValue.push_back( *it );
|
|
else if (index != *pos)
|
|
remainValue.push_back( *it );
|
|
else
|
|
pos++;
|
|
}
|
|
|
|
setValues(remainValue);
|
|
}
|
|
|
|
void PropertyCurvatureList::Save (Base::Writer &writer) const
|
|
{
|
|
if (!writer.isForceXML()) {
|
|
writer.Stream() << writer.ind() << "<CurvatureList file=\"" << writer.addFile(getName(), this) << "\"/>" << std::endl;
|
|
}
|
|
}
|
|
|
|
void PropertyCurvatureList::Restore(Base::XMLReader &reader)
|
|
{
|
|
reader.readElement("CurvatureList");
|
|
std::string file (reader.getAttribute("file") );
|
|
|
|
if (!file.empty()) {
|
|
// initate a file read
|
|
reader.addFile(file.c_str(),this);
|
|
}
|
|
}
|
|
|
|
void PropertyCurvatureList::SaveDocFile (Base::Writer &writer) const
|
|
{
|
|
Base::OutputStream str(writer.Stream());
|
|
uint32_t uCt = (uint32_t)getSize();
|
|
str << uCt;
|
|
if (uCt > 0)
|
|
for (std::vector<CurvatureInfo>::const_iterator it = _lValueList.begin(); it != _lValueList.end(); ++it) {
|
|
str << it->fMaxCurvature << it->fMinCurvature;
|
|
str << it->cMaxCurvDir.x << it->cMaxCurvDir.y << it->cMaxCurvDir.z;
|
|
str << it->cMinCurvDir.x << it->cMinCurvDir.y << it->cMinCurvDir.z;
|
|
}
|
|
}
|
|
|
|
void PropertyCurvatureList::RestoreDocFile(Base::Reader &reader)
|
|
{
|
|
Base::InputStream str(reader);
|
|
uint32_t uCt=0;
|
|
str >> uCt;
|
|
std::vector<CurvatureInfo> values(uCt);
|
|
for (std::vector<CurvatureInfo>::iterator it = values.begin(); it != values.end(); ++it) {
|
|
str >> it->fMaxCurvature >> it->fMinCurvature;
|
|
str >> it->cMaxCurvDir.x >> it->cMaxCurvDir.y >> it->cMaxCurvDir.z;
|
|
str >> it->cMinCurvDir.x >> it->cMinCurvDir.y >> it->cMinCurvDir.z;
|
|
}
|
|
|
|
setValues(values);
|
|
}
|
|
|
|
App::Property *PropertyCurvatureList::Copy(void) const
|
|
{
|
|
PropertyCurvatureList* prop = new PropertyCurvatureList();
|
|
prop->_lValueList = this->_lValueList;
|
|
return prop;
|
|
}
|
|
|
|
void PropertyCurvatureList::Paste(const App::Property &from)
|
|
{
|
|
aboutToSetValue();
|
|
const PropertyCurvatureList& prop = dynamic_cast<const PropertyCurvatureList&>(from);
|
|
this->_lValueList = prop._lValueList;
|
|
hasSetValue();
|
|
}
|
|
|
|
unsigned int PropertyCurvatureList::getMemSize (void) const
|
|
{
|
|
return sizeof(CurvatureInfo) * this->_lValueList.size();
|
|
}
|