blob: f28c035e128fa516b2fa830d8f10a5d3e3bfcfed (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
|
/*
**************************************************************************
description
--------------------
copyright : (C) 2001 by Andreas Zehender
email : [email protected]
**************************************************************************
**************************************************************************
* *
* This program is free software; you can redistribute it and/or modify *
* it under the terms of the GNU General Public License as published by *
* the Free Software Foundation; either version 2 of the License, or *
* (at your option) any later version. *
* *
**************************************************************************/
#include "pmplanenormalcontrolpoint.h"
#include "pmdistancecontrolpoint.h"
#include "pmmath.h"
#include <math.h>
PMPlaneNormalControlPoint::PMPlaneNormalControlPoint( PMDistanceControlPoint* d,
const PMVector& normal, int id,
const QString& description )
: PMControlPoint( id, description )
{
m_normal = normal;
m_pDistancePoint = d;
}
PMVector PMPlaneNormalControlPoint::position( ) const
{
return m_normal * ( m_pDistancePoint->distance( ) + 1.0 );
}
PMVector PMPlaneNormalControlPoint::extraLineStart( ) const
{
return m_normal * m_pDistancePoint->distance( );
}
PMVector PMPlaneNormalControlPoint::extraLineEnd( ) const
{
return position( );
}
void PMPlaneNormalControlPoint::graphicalChangeStarted( )
{
m_originalNormal = m_normal;
m_originalDistance = m_pDistancePoint->distance( );
}
void PMPlaneNormalControlPoint::graphicalChange( const PMVector& startPoint,
const PMVector& /*viewNormal*/,
const PMVector& endPoint )
{
PMVector p = m_originalNormal * ( m_originalDistance + 1 )
+ endPoint - startPoint;
double pabs = p.abs( );
if( !approxZero( pabs ) )
{
PMVector np = p / pabs;
double nd = m_originalNormal.abs( ) * m_originalDistance;
PMVector normal = p - np * fabs( nd );
double nl = normal.abs( );
if( !approxZero( nl ) )
{
if( ( m_originalDistance * ( pabs - fabs( nd ) ) ) < 0 )
nd = -nd;
nd /= nl;
m_pDistancePoint->setDistance( nd );
m_pDistancePoint->setDirection( normal );
m_normal = normal;
}
}
}
double PMPlaneNormalControlPoint::distance( ) const
{
return m_pDistancePoint->distance( );
}
void PMPlaneNormalControlPoint::snapToGrid( )
{
int i;
double d = moveGrid( );
if( !approxZero( d ) )
for( i = 0; i < 3; i++ )
m_normal[i] = rint( m_normal[i] / d ) * d;
setChanged( );
}
|
