Line data Source code
1 : /* -*- Mode: C++; tab-width: 4; indent-tabs-mode: nil; c-basic-offset: 4 -*- */
2 : /*
3 : * This file is part of the LibreOffice project.
4 : *
5 : * This Source Code Form is subject to the terms of the Mozilla Public
6 : * License, v. 2.0. If a copy of the MPL was not distributed with this
7 : * file, You can obtain one at http://mozilla.org/MPL/2.0/.
8 : *
9 : * This file incorporates work covered by the following license notice:
10 : *
11 : * Licensed to the Apache Software Foundation (ASF) under one or more
12 : * contributor license agreements. See the NOTICE file distributed
13 : * with this work for additional information regarding copyright
14 : * ownership. The ASF licenses this file to you under the Apache
15 : * License, Version 2.0 (the "License"); you may not use this file
16 : * except in compliance with the License. You may obtain a copy of
17 : * the License at http://www.apache.org/licenses/LICENSE-2.0 .
18 : */
19 :
20 : #include <basegfx/vector/b2dvector.hxx>
21 : #include <basegfx/matrix/b2dhommatrix.hxx>
22 : #include <basegfx/numeric/ftools.hxx>
23 :
24 : namespace basegfx
25 : {
26 1727124 : B2DVector& B2DVector::normalize()
27 : {
28 1727124 : double fLen(scalar(*this));
29 :
30 1727124 : if(fTools::equalZero(fLen))
31 : {
32 8803 : mfX = 0.0;
33 8803 : mfY = 0.0;
34 : }
35 : else
36 : {
37 1718321 : const double fOne(1.0);
38 :
39 1718321 : if(!fTools::equal(fOne, fLen))
40 : {
41 1617455 : fLen = sqrt(fLen);
42 :
43 1617455 : if(!fTools::equalZero(fLen))
44 : {
45 1617455 : mfX /= fLen;
46 1617455 : mfY /= fLen;
47 : }
48 : }
49 : }
50 :
51 1727124 : return *this;
52 : }
53 :
54 106238 : B2DVector& B2DVector::operator=( const B2DTuple& rVec )
55 : {
56 106238 : mfX = rVec.getX();
57 106238 : mfY = rVec.getY();
58 106238 : return *this;
59 : }
60 :
61 794448 : double B2DVector::getLength() const
62 : {
63 794448 : if(fTools::equalZero(mfX))
64 : {
65 170956 : return fabs(mfY);
66 : }
67 623492 : else if(fTools::equalZero(mfY))
68 : {
69 306691 : return fabs(mfX);
70 : }
71 :
72 316801 : return hypot( mfX, mfY );
73 : }
74 :
75 167827 : double B2DVector::angle( const B2DVector& rVec ) const
76 : {
77 167827 : return atan2(mfX * rVec.getY() - mfY * rVec.getX(),
78 335654 : mfX * rVec.getX() + mfY * rVec.getY());
79 : }
80 :
81 614 : const B2DVector& B2DVector::getEmptyVector()
82 : {
83 614 : return static_cast<const B2DVector&>( B2DTuple::getEmptyTuple() );
84 : }
85 :
86 961232 : B2DVector& B2DVector::operator*=( const B2DHomMatrix& rMat )
87 : {
88 961232 : const double fTempX( rMat.get(0,0)*mfX +
89 961232 : rMat.get(0,1)*mfY );
90 961232 : const double fTempY( rMat.get(1,0)*mfX +
91 961232 : rMat.get(1,1)*mfY );
92 961232 : mfX = fTempX;
93 961232 : mfY = fTempY;
94 :
95 961232 : return *this;
96 : }
97 :
98 28009 : B2DVector& B2DVector::setLength(double fLen)
99 : {
100 28009 : double fLenNow(scalar(*this));
101 :
102 28009 : if(!fTools::equalZero(fLenNow))
103 : {
104 27597 : const double fOne(1.0);
105 :
106 27597 : if(!fTools::equal(fOne, fLenNow))
107 : {
108 27461 : fLen /= sqrt(fLenNow);
109 : }
110 :
111 27597 : mfX *= fLen;
112 27597 : mfY *= fLen;
113 : }
114 :
115 28009 : return *this;
116 : }
117 :
118 3914195 : bool areParallel( const B2DVector& rVecA, const B2DVector& rVecB )
119 : {
120 3914195 : const double fValA(rVecA.getX() * rVecB.getY());
121 3914195 : const double fValB(rVecA.getY() * rVecB.getX());
122 :
123 3914195 : return fTools::equal(fValA, fValB);
124 : }
125 :
126 16592 : B2VectorOrientation getOrientation( const B2DVector& rVecA, const B2DVector& rVecB )
127 : {
128 16592 : double fVal(rVecA.getX() * rVecB.getY() - rVecA.getY() * rVecB.getX());
129 :
130 16592 : if(fTools::equalZero(fVal))
131 : {
132 3017 : return B2VectorOrientation::Neutral;
133 : }
134 :
135 13575 : if(fVal > 0.0)
136 : {
137 10966 : return B2VectorOrientation::Positive;
138 : }
139 : else
140 : {
141 2609 : return B2VectorOrientation::Negative;
142 : }
143 : }
144 :
145 27870 : B2DVector getPerpendicular( const B2DVector& rNormalizedVec )
146 : {
147 27870 : B2DVector aPerpendicular(-rNormalizedVec.getY(), rNormalizedVec.getX());
148 27870 : return aPerpendicular;
149 : }
150 :
151 49228 : B2DVector getNormalizedPerpendicular( const B2DVector& rVec )
152 : {
153 49228 : B2DVector aPerpendicular(rVec);
154 49228 : aPerpendicular.normalize();
155 49228 : const double aTemp(-aPerpendicular.getY());
156 49228 : aPerpendicular.setY(aPerpendicular.getX());
157 49228 : aPerpendicular.setX(aTemp);
158 49228 : return aPerpendicular;
159 : }
160 :
161 961232 : B2DVector operator*( const B2DHomMatrix& rMat, const B2DVector& rVec )
162 : {
163 961232 : B2DVector aRes( rVec );
164 961232 : return aRes*=rMat;
165 : }
166 :
167 155326 : B2VectorContinuity getContinuity(const B2DVector& rBackVector, const B2DVector& rForwardVector )
168 : {
169 155326 : if(rBackVector.equalZero() || rForwardVector.equalZero())
170 : {
171 31700 : return B2VectorContinuity::NONE;
172 : }
173 :
174 123626 : if(fTools::equal(rBackVector.getX(), -rForwardVector.getX()) && fTools::equal(rBackVector.getY(), -rForwardVector.getY()))
175 : {
176 : // same direction and same length -> C2
177 61455 : return B2VectorContinuity::C2;
178 : }
179 :
180 62171 : if(areParallel(rBackVector, rForwardVector) && rBackVector.scalar(rForwardVector) < 0.0)
181 : {
182 : // parallel and opposite direction -> C1
183 23842 : return B2VectorContinuity::C1;
184 : }
185 :
186 38329 : return B2VectorContinuity::NONE;
187 : }
188 : } // end of namespace basegfx
189 :
190 : /* vim:set shiftwidth=4 softtabstop=4 expandtab: */
|
