1 /************************************************************** 2 * 3 * Licensed to the Apache Software Foundation (ASF) under one 4 * or more contributor license agreements. See the NOTICE file 5 * distributed with this work for additional information 6 * regarding copyright ownership. The ASF licenses this file 7 * to you under the Apache License, Version 2.0 (the 8 * "License"); you may not use this file except in compliance 9 * with the License. You may obtain a copy of the License at 10 * 11 * http://www.apache.org/licenses/LICENSE-2.0 12 * 13 * Unless required by applicable law or agreed to in writing, 14 * software distributed under the License is distributed on an 15 * "AS IS" BASIS, WITHOUT WARRANTIES OR CONDITIONS OF ANY 16 * KIND, either express or implied. See the License for the 17 * specific language governing permissions and limitations 18 * under the License. 19 * 20 *************************************************************/ 21 22 23 24 // MARKER(update_precomp.py): autogen include statement, do not remove 25 #include "precompiled_basegfx.hxx" 26 #include <basegfx/vector/b2dvector.hxx> 27 #include <basegfx/matrix/b2dhommatrix.hxx> 28 #include <basegfx/numeric/ftools.hxx> 29 30 namespace basegfx 31 { normalize()32 B2DVector& B2DVector::normalize() 33 { 34 double fLen(scalar(*this)); 35 36 if(fTools::equalZero(fLen)) 37 { 38 mfX = 0.0; 39 mfY = 0.0; 40 } 41 else 42 { 43 const double fOne(1.0); 44 45 if(!fTools::equal(fOne, fLen)) 46 { 47 fLen = sqrt(fLen); 48 49 if(!fTools::equalZero(fLen)) 50 { 51 mfX /= fLen; 52 mfY /= fLen; 53 } 54 } 55 } 56 57 return *this; 58 } 59 operator =(const B2DTuple & rVec)60 B2DVector& B2DVector::operator=( const B2DTuple& rVec ) 61 { 62 mfX = rVec.getX(); 63 mfY = rVec.getY(); 64 return *this; 65 } 66 67 getLength() const68 double B2DVector::getLength() const 69 { 70 if(fTools::equalZero(mfX)) 71 { 72 return fabs(mfY); 73 } 74 else if(fTools::equalZero(mfY)) 75 { 76 return fabs(mfX); 77 } 78 79 return hypot( mfX, mfY ); 80 } 81 scalar(const B2DVector & rVec) const82 double B2DVector::scalar( const B2DVector& rVec ) const 83 { 84 return((mfX * rVec.mfX) + (mfY * rVec.mfY)); 85 } 86 cross(const B2DVector & rVec) const87 double B2DVector::cross( const B2DVector& rVec ) const 88 { 89 return(mfX * rVec.getY() - mfY * rVec.getX()); 90 } 91 angle(const B2DVector & rVec) const92 double B2DVector::angle( const B2DVector& rVec ) const 93 { 94 return atan2(mfX * rVec.getY() - mfY * rVec.getX(), 95 mfX * rVec.getX() + mfY * rVec.getY()); 96 } 97 getEmptyVector()98 const B2DVector& B2DVector::getEmptyVector() 99 { 100 return (const B2DVector&) B2DTuple::getEmptyTuple(); 101 } 102 operator *=(const B2DHomMatrix & rMat)103 B2DVector& B2DVector::operator*=( const B2DHomMatrix& rMat ) 104 { 105 const double fTempX( rMat.get(0,0)*mfX + 106 rMat.get(0,1)*mfY ); 107 const double fTempY( rMat.get(1,0)*mfX + 108 rMat.get(1,1)*mfY ); 109 mfX = fTempX; 110 mfY = fTempY; 111 112 return *this; 113 } 114 setLength(double fLen)115 B2DVector& B2DVector::setLength(double fLen) 116 { 117 double fLenNow(scalar(*this)); 118 119 if(!fTools::equalZero(fLenNow)) 120 { 121 const double fOne(1.0); 122 123 if(!fTools::equal(fOne, fLenNow)) 124 { 125 fLen /= sqrt(fLenNow); 126 } 127 128 mfX *= fLen; 129 mfY *= fLen; 130 } 131 132 return *this; 133 } 134 isNormalized() const135 bool B2DVector::isNormalized() const 136 { 137 const double fOne(1.0); 138 const double fScalar(scalar(*this)); 139 140 return fTools::equal(fOne, fScalar); 141 } 142 areParallel(const B2DVector & rVecA,const B2DVector & rVecB)143 bool areParallel( const B2DVector& rVecA, const B2DVector& rVecB ) 144 { 145 const double fValA(rVecA.getX() * rVecB.getY()); 146 const double fValB(rVecA.getY() * rVecB.getX()); 147 148 return fTools::equal(fValA, fValB); 149 } 150 getOrientation(const B2DVector & rVecA,const B2DVector & rVecB)151 B2VectorOrientation getOrientation( const B2DVector& rVecA, const B2DVector& rVecB ) 152 { 153 double fVal(rVecA.getX() * rVecB.getY() - rVecA.getY() * rVecB.getX()); 154 155 if(fTools::equalZero(fVal)) 156 { 157 return ORIENTATION_NEUTRAL; 158 } 159 160 if(fVal > 0.0) 161 { 162 return ORIENTATION_POSITIVE; 163 } 164 else 165 { 166 return ORIENTATION_NEGATIVE; 167 } 168 } 169 getPerpendicular(const B2DVector & rNormalizedVec)170 B2DVector getPerpendicular( const B2DVector& rNormalizedVec ) 171 { 172 B2DVector aPerpendicular(-rNormalizedVec.getY(), rNormalizedVec.getX()); 173 return aPerpendicular; 174 } 175 getNormalizedPerpendicular(const B2DVector & rVec)176 B2DVector getNormalizedPerpendicular( const B2DVector& rVec ) 177 { 178 B2DVector aPerpendicular(rVec); 179 aPerpendicular.normalize(); 180 const double aTemp(-aPerpendicular.getY()); 181 aPerpendicular.setY(aPerpendicular.getX()); 182 aPerpendicular.setX(aTemp); 183 return aPerpendicular; 184 } 185 operator *(const B2DHomMatrix & rMat,const B2DVector & rVec)186 B2DVector operator*( const B2DHomMatrix& rMat, const B2DVector& rVec ) 187 { 188 B2DVector aRes( rVec ); 189 return aRes*=rMat; 190 } 191 getContinuity(const B2DVector & rBackVector,const B2DVector & rForwardVector)192 B2VectorContinuity getContinuity(const B2DVector& rBackVector, const B2DVector& rForwardVector ) 193 { 194 if(rBackVector.equalZero() || rForwardVector.equalZero()) 195 { 196 return CONTINUITY_NONE; 197 } 198 199 if(fTools::equal(rBackVector.getX(), -rForwardVector.getX()) && fTools::equal(rBackVector.getY(), -rForwardVector.getY())) 200 { 201 // same direction and same length -> C2 202 return CONTINUITY_C2; 203 } 204 205 if(areParallel(rBackVector, rForwardVector) && rBackVector.scalar(rForwardVector) < 0.0) 206 { 207 // parallel and opposite direction -> C1 208 return CONTINUITY_C1; 209 } 210 211 return CONTINUITY_NONE; 212 } 213 } // end of namespace basegfx 214 215 // eof 216