139 lines
3.7 KiB
C++
139 lines
3.7 KiB
C++
/*
|
|
* This program source code file is part of KiCad, a free EDA CAD application.
|
|
*
|
|
* Copyright (C) 2010 Wayne Stambaugh <stambaughw@gmail.com>
|
|
* Copyright (C) 2015-2021 KiCad Developers, see AUTHORS.txt for contributors.
|
|
*
|
|
* 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.
|
|
*
|
|
* This program 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 General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, you may find one here:
|
|
* http://www.gnu.org/licenses/old-licenses/gpl-2.0.html
|
|
* or you may search the http://www.gnu.org website for the version 2 license,
|
|
* or you may write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
|
|
*/
|
|
|
|
#include <macros.h>
|
|
#include <trigo.h>
|
|
#include <transform.h>
|
|
#include <common.h>
|
|
#include <eda_rect.h>
|
|
#include <math/util.h> // for KiROUND
|
|
|
|
|
|
bool TRANSFORM::operator==( const TRANSFORM& aTransform ) const
|
|
{
|
|
return ( x1 == aTransform.x1 &&
|
|
y1 == aTransform.y1 &&
|
|
x2 == aTransform.x2 &&
|
|
y2 == aTransform.y2 );
|
|
}
|
|
|
|
|
|
VECTOR2I TRANSFORM::TransformCoordinate( const VECTOR2I& aPoint ) const
|
|
{
|
|
return VECTOR2I( ( x1 * aPoint.x ) + ( y1 * aPoint.y ), ( x2 * aPoint.x ) + ( y2 * aPoint.y ) );
|
|
}
|
|
|
|
|
|
EDA_RECT TRANSFORM::TransformCoordinate( const EDA_RECT& aRect ) const
|
|
{
|
|
EDA_RECT rect;
|
|
rect.SetOrigin( TransformCoordinate( aRect.GetOrigin() ) );
|
|
rect.SetEnd( TransformCoordinate( aRect.GetEnd() ) );
|
|
return rect;
|
|
}
|
|
|
|
|
|
TRANSFORM TRANSFORM::InverseTransform() const
|
|
{
|
|
int invx1;
|
|
int invx2;
|
|
int invy1;
|
|
int invy2;
|
|
|
|
/* Calculates the inverse matrix coeffs:
|
|
* for a matrix m{x1, x2, y1, y2}
|
|
* the inverse matrix is 1/(x1*y2 -x2*y1) m{y2,-x2,-y1,x1)
|
|
*/
|
|
int det = x1*y2 -x2*y1; // Is never null, because the inverse matrix exists
|
|
invx1 = y2/det;
|
|
invx2 = -x2/det;
|
|
invy1 = -y1/det;
|
|
invy2 = x1/det;
|
|
|
|
TRANSFORM invtransform( invx1, invy1, invx2, invy2 );
|
|
return invtransform;
|
|
}
|
|
|
|
|
|
bool TRANSFORM::MapAngles( int* aAngle1, int* aAngle2 ) const
|
|
{
|
|
wxCHECK_MSG( aAngle1 != nullptr && aAngle2 != nullptr, false,
|
|
wxT( "Cannot map NULL point angles." ) );
|
|
|
|
int Angle, Delta;
|
|
double x, y, t;
|
|
bool swap = false;
|
|
|
|
Delta = *aAngle2 - *aAngle1;
|
|
|
|
if( Delta >= 1800 )
|
|
{
|
|
*aAngle1 -= 1;
|
|
*aAngle2 += 1;
|
|
}
|
|
|
|
x = cos( DECIDEG2RAD( *aAngle1 ) );
|
|
y = sin( DECIDEG2RAD( *aAngle1 ) );
|
|
t = x * x1 + y * y1;
|
|
y = x * x2 + y * y2;
|
|
x = t;
|
|
*aAngle1 = KiROUND( RAD2DECIDEG( atan2( y, x ) ) );
|
|
|
|
x = cos( DECIDEG2RAD( *aAngle2 ) );
|
|
y = sin( DECIDEG2RAD( *aAngle2 ) );
|
|
t = x * x1 + y * y1;
|
|
y = x * x2 + y * y2;
|
|
x = t;
|
|
*aAngle2 = KiROUND( RAD2DECIDEG( atan2( y, x ) ) );
|
|
|
|
NORMALIZE_ANGLE_POS( *aAngle1 );
|
|
NORMALIZE_ANGLE_POS( *aAngle2 );
|
|
|
|
if( *aAngle2 < *aAngle1 )
|
|
*aAngle2 += 3600;
|
|
|
|
if( *aAngle2 - *aAngle1 > 1800 ) // Need to swap the two angles
|
|
{
|
|
Angle = (*aAngle1);
|
|
*aAngle1 = (*aAngle2);
|
|
*aAngle2 = Angle;
|
|
|
|
NORMALIZE_ANGLE_POS( *aAngle1 );
|
|
NORMALIZE_ANGLE_POS( *aAngle2 );
|
|
|
|
if( *aAngle2 < *aAngle1 )
|
|
*aAngle2 += 3600;
|
|
|
|
swap = true;
|
|
}
|
|
|
|
if( Delta >= 1800 )
|
|
{
|
|
*aAngle1 += 1;
|
|
*aAngle2 -= 1;
|
|
}
|
|
|
|
return swap;
|
|
}
|