2013-05-26 04:36:44 +00:00
|
|
|
/*
|
|
|
|
* This program source code file is part of KiCad, a free EDA CAD application.
|
|
|
|
*
|
2018-01-19 20:10:40 +00:00
|
|
|
* Copyright (C) 2018 Jean-Pierre Charras, jp.charras at wanadoo.fr
|
2022-01-18 10:14:52 +00:00
|
|
|
* Copyright (C) 1992-2022 KiCad Developers, see AUTHORS.txt for contributors.
|
2013-05-26 04:36:44 +00:00
|
|
|
*
|
|
|
|
* 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
|
|
|
|
*/
|
|
|
|
|
2020-01-07 17:12:59 +00:00
|
|
|
#include <algorithm> // for max, min
|
2021-07-04 12:48:32 +00:00
|
|
|
#include <bitset> // for bitset::count
|
2020-01-07 17:12:59 +00:00
|
|
|
#include <math.h> // for atan2
|
|
|
|
|
2013-05-26 04:36:44 +00:00
|
|
|
#include <convert_basic_shapes_to_polygon.h>
|
2019-05-22 13:33:48 +00:00
|
|
|
#include <geometry/geometry_utils.h>
|
2020-01-07 17:12:59 +00:00
|
|
|
#include <geometry/shape_line_chain.h> // for SHAPE_LINE_CHAIN
|
|
|
|
#include <geometry/shape_poly_set.h> // for SHAPE_POLY_SET, SHAPE_POLY_SE...
|
|
|
|
#include <math/util.h>
|
|
|
|
#include <math/vector2d.h> // for VECTOR2I
|
|
|
|
#include <trigo.h>
|
2019-05-22 13:33:48 +00:00
|
|
|
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2022-01-01 06:04:08 +00:00
|
|
|
void TransformCircleToPolygon( SHAPE_LINE_CHAIN& aCornerBuffer, const VECTOR2I& aCenter,
|
|
|
|
int aRadius, int aError, ERROR_LOC aErrorLoc, int aMinSegCount )
|
2019-05-09 14:23:18 +00:00
|
|
|
{
|
2022-01-01 06:04:08 +00:00
|
|
|
VECTOR2I corner_position;
|
2022-01-14 15:34:41 +00:00
|
|
|
int numSegs = GetArcToSegmentCount( aRadius, aError, FULL_CIRCLE );
|
2021-07-05 15:40:26 +00:00
|
|
|
numSegs = std::max( aMinSegCount, numSegs );
|
2021-06-26 11:18:46 +00:00
|
|
|
|
|
|
|
// The shape will be built with a even number of segs. Reason: the horizontal
|
|
|
|
// diameter begins and ends to points on the actual circle, or circle
|
|
|
|
// expanded by aError if aErrorLoc == ERROR_OUTSIDE.
|
|
|
|
// This is used by Arc to Polygon shape convert.
|
|
|
|
if( numSegs & 1 )
|
|
|
|
numSegs++;
|
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
EDA_ANGLE delta = ANGLE_360 / numSegs;
|
|
|
|
int radius = aRadius;
|
2020-10-13 10:55:24 +00:00
|
|
|
|
|
|
|
if( aErrorLoc == ERROR_OUTSIDE )
|
2021-06-28 13:50:16 +00:00
|
|
|
{
|
2021-06-28 16:51:37 +00:00
|
|
|
// The outer radius should be radius+aError
|
|
|
|
// Recalculate the actual approx error, as it can be smaller than aError
|
|
|
|
// because numSegs is clamped to a minimal value
|
|
|
|
int actual_delta_radius = CircleToEndSegmentDeltaRadius( radius, numSegs );
|
|
|
|
radius += GetCircleToPolyCorrection( actual_delta_radius );
|
2021-06-28 13:50:16 +00:00
|
|
|
}
|
2019-05-09 14:23:18 +00:00
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
for( EDA_ANGLE angle = ANGLE_0; angle < ANGLE_360; angle += delta )
|
2019-05-09 14:23:18 +00:00
|
|
|
{
|
2022-01-18 10:14:52 +00:00
|
|
|
corner_position.x = radius;
|
|
|
|
corner_position.y = 0;
|
2022-01-01 06:04:08 +00:00
|
|
|
RotatePoint( corner_position, angle );
|
2019-05-09 14:23:18 +00:00
|
|
|
corner_position += aCenter;
|
2020-06-22 19:35:09 +00:00
|
|
|
aCornerBuffer.Append( corner_position.x, corner_position.y );
|
2019-05-09 14:23:18 +00:00
|
|
|
}
|
|
|
|
|
2020-06-22 19:35:09 +00:00
|
|
|
aCornerBuffer.SetClosed( true );
|
2019-05-09 14:23:18 +00:00
|
|
|
}
|
|
|
|
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2022-01-01 06:04:08 +00:00
|
|
|
void TransformCircleToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aCenter, int aRadius,
|
2021-07-05 15:40:26 +00:00
|
|
|
int aError, ERROR_LOC aErrorLoc, int aMinSegCount )
|
2013-05-26 04:36:44 +00:00
|
|
|
{
|
2022-01-01 06:04:08 +00:00
|
|
|
VECTOR2I corner_position;
|
2022-01-14 15:34:41 +00:00
|
|
|
int numSegs = GetArcToSegmentCount( aRadius, aError, FULL_CIRCLE );
|
2022-01-01 06:04:08 +00:00
|
|
|
numSegs = std::max( aMinSegCount, numSegs );
|
2021-06-26 11:18:46 +00:00
|
|
|
|
|
|
|
// The shape will be built with a even number of segs. Reason: the horizontal
|
|
|
|
// diameter begins and ends to points on the actual circle, or circle
|
|
|
|
// expanded by aError if aErrorLoc == ERROR_OUTSIDE.
|
|
|
|
// This is used by Arc to Polygon shape convert.
|
|
|
|
if( numSegs & 1 )
|
|
|
|
numSegs++;
|
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
EDA_ANGLE delta = ANGLE_360 / numSegs;
|
|
|
|
int radius = aRadius;
|
2020-10-13 10:55:24 +00:00
|
|
|
|
|
|
|
if( aErrorLoc == ERROR_OUTSIDE )
|
2021-06-28 16:51:37 +00:00
|
|
|
{
|
|
|
|
// The outer radius should be radius+aError
|
|
|
|
// Recalculate the actual approx error, as it can be smaller than aError
|
|
|
|
// because numSegs is clamped to a minimal value
|
|
|
|
int actual_delta_radius = CircleToEndSegmentDeltaRadius( radius, numSegs );
|
|
|
|
radius += GetCircleToPolyCorrection( actual_delta_radius );
|
|
|
|
}
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2015-07-27 19:45:57 +00:00
|
|
|
aCornerBuffer.NewOutline();
|
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
for( EDA_ANGLE angle = ANGLE_0; angle < ANGLE_360; angle += delta )
|
2013-05-26 04:36:44 +00:00
|
|
|
{
|
2020-09-10 23:05:20 +00:00
|
|
|
corner_position.x = radius;
|
|
|
|
corner_position.y = 0;
|
2022-01-01 06:04:08 +00:00
|
|
|
RotatePoint( corner_position, angle );
|
2013-05-26 04:36:44 +00:00
|
|
|
corner_position += aCenter;
|
2015-07-27 19:45:57 +00:00
|
|
|
aCornerBuffer.Append( corner_position.x, corner_position.y );
|
2013-05-26 04:36:44 +00:00
|
|
|
}
|
2020-09-10 23:05:20 +00:00
|
|
|
|
|
|
|
// Finish circle
|
|
|
|
corner_position.x = radius;
|
|
|
|
corner_position.y = 0;
|
|
|
|
corner_position += aCenter;
|
|
|
|
aCornerBuffer.Append( corner_position.x, corner_position.y );
|
2013-05-26 04:36:44 +00:00
|
|
|
}
|
|
|
|
|
2019-05-22 13:33:48 +00:00
|
|
|
|
2021-12-29 19:02:50 +00:00
|
|
|
void TransformOvalToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aStart,
|
|
|
|
const VECTOR2I& aEnd, int aWidth, int aError, ERROR_LOC aErrorLoc,
|
2021-07-26 19:35:12 +00:00
|
|
|
int aMinSegCount )
|
2018-01-20 18:34:50 +00:00
|
|
|
{
|
2018-01-20 19:44:04 +00:00
|
|
|
// To build the polygonal shape outside the actual shape, we use a bigger
|
|
|
|
// radius to build rounded ends.
|
|
|
|
// However, the width of the segment is too big.
|
|
|
|
// so, later, we will clamp the polygonal shape with the bounding box
|
|
|
|
// of the segment.
|
2020-09-10 23:05:20 +00:00
|
|
|
int radius = aWidth / 2;
|
2022-01-14 15:34:41 +00:00
|
|
|
int numSegs = GetArcToSegmentCount( radius, aError, FULL_CIRCLE );
|
2021-07-05 15:40:26 +00:00
|
|
|
numSegs = std::max( aMinSegCount, numSegs );
|
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
EDA_ANGLE delta = ANGLE_360 / numSegs;
|
2020-01-26 17:01:11 +00:00
|
|
|
|
2020-10-13 10:55:24 +00:00
|
|
|
if( aErrorLoc == ERROR_OUTSIDE )
|
2021-07-05 15:40:26 +00:00
|
|
|
{
|
|
|
|
// The outer radius should be radius+aError
|
|
|
|
// Recalculate the actual approx error, as it can be smaller than aError
|
|
|
|
// because numSegs is clamped to a minimal value
|
|
|
|
int actual_delta_radius = CircleToEndSegmentDeltaRadius( radius, numSegs );
|
|
|
|
int correction = GetCircleToPolyCorrection( actual_delta_radius );
|
2020-10-13 10:55:24 +00:00
|
|
|
radius += correction;
|
2021-07-05 15:40:26 +00:00
|
|
|
}
|
2018-01-20 19:44:04 +00:00
|
|
|
|
|
|
|
// end point is the coordinate relative to aStart
|
2021-12-29 19:02:50 +00:00
|
|
|
VECTOR2I endp = aEnd - aStart;
|
|
|
|
VECTOR2I startp = aStart;
|
2022-01-04 01:00:40 +00:00
|
|
|
VECTOR2I corner;
|
2018-01-20 19:44:04 +00:00
|
|
|
SHAPE_POLY_SET polyshape;
|
2018-01-20 18:34:50 +00:00
|
|
|
|
2018-01-20 19:44:04 +00:00
|
|
|
polyshape.NewOutline();
|
2018-01-20 18:34:50 +00:00
|
|
|
|
2018-01-20 19:44:04 +00:00
|
|
|
// normalize the position in order to have endp.x >= 0
|
|
|
|
// it makes calculations more easy to understand
|
2018-01-20 18:34:50 +00:00
|
|
|
if( endp.x < 0 )
|
|
|
|
{
|
|
|
|
endp = aStart - aEnd;
|
|
|
|
startp = aEnd;
|
|
|
|
}
|
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
EDA_ANGLE delta_angle( endp );
|
|
|
|
int seg_len = KiROUND( EuclideanNorm( endp ) );
|
2018-01-20 18:34:50 +00:00
|
|
|
|
|
|
|
// Compute the outlines of the segment, and creates a polygon
|
2018-01-20 19:44:04 +00:00
|
|
|
// Note: the polygonal shape is built from the equivalent horizontal
|
2020-09-10 23:05:20 +00:00
|
|
|
// segment starting at {0,0}, and ending at {seg_len,0}
|
2018-01-20 19:44:04 +00:00
|
|
|
|
2018-01-20 18:34:50 +00:00
|
|
|
// add right rounded end:
|
2020-09-10 23:05:20 +00:00
|
|
|
|
2022-01-18 10:14:52 +00:00
|
|
|
for( EDA_ANGLE angle = ANGLE_0; angle < ANGLE_180; angle += delta )
|
2018-01-20 18:34:50 +00:00
|
|
|
{
|
2022-01-04 01:00:40 +00:00
|
|
|
corner = VECTOR2I( 0, radius );
|
|
|
|
RotatePoint( corner, angle );
|
2018-01-20 18:34:50 +00:00
|
|
|
corner.x += seg_len;
|
|
|
|
polyshape.Append( corner.x, corner.y );
|
|
|
|
}
|
|
|
|
|
|
|
|
// Finish arc:
|
2022-01-04 01:00:40 +00:00
|
|
|
corner = VECTOR2I( seg_len, -radius );
|
2018-01-20 18:34:50 +00:00
|
|
|
polyshape.Append( corner.x, corner.y );
|
|
|
|
|
|
|
|
// add left rounded end:
|
2022-01-18 10:14:52 +00:00
|
|
|
for( EDA_ANGLE angle = ANGLE_0; angle < ANGLE_180; angle += delta )
|
2018-01-20 18:34:50 +00:00
|
|
|
{
|
2022-01-04 01:00:40 +00:00
|
|
|
corner = VECTOR2I( 0, -radius );
|
|
|
|
RotatePoint( corner, angle );
|
2018-01-20 18:34:50 +00:00
|
|
|
polyshape.Append( corner.x, corner.y );
|
|
|
|
}
|
|
|
|
|
|
|
|
// Finish arc:
|
2022-01-04 01:00:40 +00:00
|
|
|
corner = VECTOR2I( 0, radius );
|
2018-01-20 18:34:50 +00:00
|
|
|
polyshape.Append( corner.x, corner.y );
|
2018-01-20 19:44:04 +00:00
|
|
|
|
2020-09-10 23:05:20 +00:00
|
|
|
// Now trim the edges of the polygonal shape which will be slightly outside the
|
|
|
|
// track width.
|
|
|
|
SHAPE_POLY_SET bbox;
|
|
|
|
bbox.NewOutline();
|
|
|
|
// Build the bbox (a horizontal rectangle).
|
|
|
|
int halfwidth = aWidth / 2; // Use the exact segment width for the bbox height
|
|
|
|
corner.x = -radius - 2; // use a bbox width slightly bigger to avoid
|
|
|
|
// creating useless corner at segment ends
|
|
|
|
corner.y = halfwidth;
|
|
|
|
bbox.Append( corner.x, corner.y );
|
|
|
|
corner.y = -halfwidth;
|
|
|
|
bbox.Append( corner.x, corner.y );
|
|
|
|
corner.x = radius + seg_len + 2;
|
|
|
|
bbox.Append( corner.x, corner.y );
|
|
|
|
corner.y = halfwidth;
|
|
|
|
bbox.Append( corner.x, corner.y );
|
|
|
|
|
|
|
|
// Now, clamp the shape
|
|
|
|
polyshape.BooleanIntersection( bbox, SHAPE_POLY_SET::PM_STRICTLY_SIMPLE );
|
|
|
|
// Note the final polygon is a simple, convex polygon with no hole
|
|
|
|
// due to the shape of initial polygons
|
2018-01-20 18:34:50 +00:00
|
|
|
|
|
|
|
// Rotate and move the polygon to its right location
|
2022-01-20 20:54:22 +00:00
|
|
|
polyshape.Rotate( -delta_angle );
|
2018-01-20 18:34:50 +00:00
|
|
|
polyshape.Move( startp );
|
|
|
|
|
2018-01-20 19:44:04 +00:00
|
|
|
aCornerBuffer.Append( polyshape);
|
2018-01-20 18:34:50 +00:00
|
|
|
}
|
|
|
|
|
2019-05-22 13:33:48 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
struct ROUNDED_CORNER
|
2016-02-10 16:02:40 +00:00
|
|
|
{
|
2021-07-04 12:48:32 +00:00
|
|
|
VECTOR2I m_position;
|
|
|
|
int m_radius;
|
|
|
|
ROUNDED_CORNER( int x, int y ) : m_position( VECTOR2I( x, y ) ), m_radius( 0 ) {}
|
|
|
|
ROUNDED_CORNER( int x, int y, int radius ) : m_position( VECTOR2I( x, y ) ), m_radius( radius ) {}
|
|
|
|
};
|
2020-11-14 07:50:58 +00:00
|
|
|
|
2016-02-10 16:02:40 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
// Corner List requirements: no concave shape, corners in clockwise order, no duplicate corners
|
|
|
|
void CornerListToPolygon( SHAPE_POLY_SET& outline, std::vector<ROUNDED_CORNER>& aCorners,
|
|
|
|
int aInflate, int aError, ERROR_LOC aErrorLoc )
|
|
|
|
{
|
|
|
|
assert( aInflate >= 0 );
|
|
|
|
outline.NewOutline();
|
|
|
|
VECTOR2I incoming = aCorners[0].m_position - aCorners.back().m_position;
|
2016-02-10 16:02:40 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
for( int n = 0, count = aCorners.size(); n < count; n++ )
|
|
|
|
{
|
|
|
|
ROUNDED_CORNER& cur = aCorners[n];
|
|
|
|
ROUNDED_CORNER& next = aCorners[( n + 1 ) % count];
|
|
|
|
VECTOR2I outgoing = next.m_position - cur.m_position;
|
2016-02-10 16:02:40 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
if( !( aInflate || cur.m_radius ) )
|
2022-01-18 10:14:52 +00:00
|
|
|
{
|
2021-07-04 12:48:32 +00:00
|
|
|
outline.Append( cur.m_position );
|
2022-01-18 10:14:52 +00:00
|
|
|
}
|
2021-07-04 12:48:32 +00:00
|
|
|
else
|
|
|
|
{
|
2022-01-18 10:14:52 +00:00
|
|
|
VECTOR2I cornerPosition = cur.m_position;
|
|
|
|
int radius = cur.m_radius;
|
|
|
|
EDA_ANGLE endAngle;
|
|
|
|
double tanAngle2;
|
2021-07-21 22:01:09 +00:00
|
|
|
|
2021-07-22 12:03:17 +00:00
|
|
|
if( ( incoming.x == 0 && outgoing.y == 0 ) || ( incoming.y == 0 && outgoing.x == 0 ) )
|
2021-07-21 22:01:09 +00:00
|
|
|
{
|
2022-01-18 10:14:52 +00:00
|
|
|
endAngle = ANGLE_90;
|
2021-07-21 22:01:09 +00:00
|
|
|
tanAngle2 = 1.0;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
double cosNum = (double) incoming.x * outgoing.x + (double) incoming.y * outgoing.y;
|
|
|
|
double cosDen = (double) incoming.EuclideanNorm() * outgoing.EuclideanNorm();
|
|
|
|
double angle = acos( cosNum / cosDen );
|
|
|
|
tanAngle2 = tan( ( M_PI - angle ) / 2 );
|
2022-01-18 10:14:52 +00:00
|
|
|
endAngle = EDA_ANGLE( angle, RADIANS_T );
|
2021-07-21 22:01:09 +00:00
|
|
|
}
|
2021-07-04 12:48:32 +00:00
|
|
|
|
|
|
|
if( aInflate )
|
|
|
|
{
|
|
|
|
radius += aInflate;
|
2021-07-21 22:01:09 +00:00
|
|
|
cornerPosition += incoming.Resize( aInflate / tanAngle2 )
|
|
|
|
+ incoming.Perpendicular().Resize( -aInflate );
|
2021-07-04 12:48:32 +00:00
|
|
|
}
|
2016-02-10 16:02:40 +00:00
|
|
|
|
2021-07-21 22:01:09 +00:00
|
|
|
// Ensure 16+ segments per 360deg and ensure first & last segment are the same size
|
2022-01-18 10:14:52 +00:00
|
|
|
int numSegs = std::max( 16, GetArcToSegmentCount( radius, aError, FULL_CIRCLE ) );
|
|
|
|
EDA_ANGLE angDelta = ANGLE_360 / numSegs;
|
|
|
|
EDA_ANGLE lastSeg = endAngle;
|
|
|
|
|
|
|
|
if( lastSeg > ANGLE_0 )
|
|
|
|
{
|
|
|
|
while( lastSeg > angDelta )
|
|
|
|
lastSeg -= angDelta;
|
|
|
|
}
|
|
|
|
else
|
|
|
|
{
|
|
|
|
while( lastSeg < -angDelta )
|
|
|
|
lastSeg += angDelta;
|
|
|
|
}
|
|
|
|
|
|
|
|
EDA_ANGLE angPos = lastSeg.IsZero() ? angDelta : ( angDelta + lastSeg ) / 2;
|
2020-07-05 16:16:33 +00:00
|
|
|
|
2021-07-21 22:01:09 +00:00
|
|
|
double arcTransitionDistance = radius / tanAngle2;
|
|
|
|
VECTOR2I arcStart = cornerPosition - incoming.Resize( arcTransitionDistance );
|
2021-07-04 12:48:32 +00:00
|
|
|
VECTOR2I arcCenter = arcStart + incoming.Perpendicular().Resize( radius );
|
2021-07-21 22:01:09 +00:00
|
|
|
VECTOR2I arcEnd, arcStartOrigin;
|
2020-09-11 13:41:45 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
if( aErrorLoc == ERROR_INSIDE )
|
|
|
|
{
|
2021-07-21 22:01:09 +00:00
|
|
|
arcEnd = SEG( cornerPosition, arcCenter ).ReflectPoint( arcStart );
|
|
|
|
arcStartOrigin = arcStart - arcCenter;
|
2021-07-04 12:48:32 +00:00
|
|
|
outline.Append( arcStart );
|
|
|
|
}
|
|
|
|
else
|
2021-04-08 22:50:40 +00:00
|
|
|
{
|
2021-07-04 12:48:32 +00:00
|
|
|
// The outer radius should be radius+aError, recalculate because numSegs is clamped
|
2021-07-21 22:01:09 +00:00
|
|
|
int actualDeltaRadius = CircleToEndSegmentDeltaRadius( radius, numSegs );
|
|
|
|
int radiusExtend = GetCircleToPolyCorrection( actualDeltaRadius );
|
|
|
|
arcStart += incoming.Perpendicular().Resize( -radiusExtend );
|
|
|
|
arcStartOrigin = arcStart - arcCenter;
|
|
|
|
|
|
|
|
// To avoid "ears", we only add segments crossing/within the non-rounded outline
|
|
|
|
// Note: outlineIn is short and must be treated as defining an infinite line
|
|
|
|
SEG outlineIn( cornerPosition - incoming, cornerPosition );
|
|
|
|
VECTOR2I prevPt = arcStart;
|
|
|
|
arcEnd = cornerPosition; // default if no points within the outline are found
|
|
|
|
|
|
|
|
while( angPos < endAngle )
|
2021-04-08 22:50:40 +00:00
|
|
|
{
|
2021-07-21 22:01:09 +00:00
|
|
|
VECTOR2I pt = arcStartOrigin;
|
2021-07-04 12:48:32 +00:00
|
|
|
RotatePoint( pt, -angPos );
|
|
|
|
pt += arcCenter;
|
2021-07-21 22:01:09 +00:00
|
|
|
angPos += angDelta;
|
|
|
|
|
|
|
|
if( outlineIn.Side( pt ) > 0 )
|
|
|
|
{
|
|
|
|
VECTOR2I intersect = outlineIn.IntersectLines( SEG( prevPt, pt ) ).get();
|
|
|
|
outline.Append( intersect );
|
|
|
|
outline.Append( pt );
|
|
|
|
arcEnd = SEG( cornerPosition, arcCenter ).ReflectPoint( intersect );
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
endAngle -= angDelta; // if skipping first, also skip last
|
|
|
|
prevPt = pt;
|
2021-04-08 22:50:40 +00:00
|
|
|
}
|
2021-07-21 22:01:09 +00:00
|
|
|
}
|
2018-08-29 07:13:07 +00:00
|
|
|
|
2021-07-21 22:01:09 +00:00
|
|
|
for( ; angPos < endAngle; angPos += angDelta )
|
|
|
|
{
|
|
|
|
VECTOR2I pt = arcStartOrigin;
|
|
|
|
RotatePoint( pt, -angPos );
|
|
|
|
outline.Append( pt + arcCenter );
|
2021-07-04 12:48:32 +00:00
|
|
|
}
|
2021-07-21 22:01:09 +00:00
|
|
|
|
|
|
|
outline.Append( arcEnd );
|
2021-07-04 12:48:32 +00:00
|
|
|
}
|
2018-08-29 07:13:07 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
incoming = outgoing;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
void CornerListRemoveDuplicates( std::vector<ROUNDED_CORNER>& aCorners )
|
|
|
|
{
|
|
|
|
VECTOR2I prev = aCorners[0].m_position;
|
|
|
|
|
|
|
|
for( int pos = aCorners.size() - 1; pos >= 0; pos-- )
|
2020-11-14 07:50:58 +00:00
|
|
|
{
|
2021-07-04 12:48:32 +00:00
|
|
|
if( aCorners[pos].m_position == prev )
|
|
|
|
aCorners.erase( aCorners.begin() + pos );
|
|
|
|
else
|
|
|
|
prev = aCorners[pos].m_position;
|
2020-11-14 07:50:58 +00:00
|
|
|
}
|
2021-07-04 12:48:32 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2022-01-01 06:04:08 +00:00
|
|
|
void TransformTrapezoidToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aPosition,
|
2022-01-16 21:15:20 +00:00
|
|
|
const VECTOR2I& aSize, const EDA_ANGLE& aRotation, int aDeltaX,
|
|
|
|
int aDeltaY, int aInflate, int aError, ERROR_LOC aErrorLoc )
|
2021-07-04 12:48:32 +00:00
|
|
|
{
|
2021-07-26 23:34:47 +00:00
|
|
|
SHAPE_POLY_SET outline;
|
2022-01-05 01:42:27 +00:00
|
|
|
VECTOR2I size( aSize / 2 );
|
2021-07-04 12:48:32 +00:00
|
|
|
std::vector<ROUNDED_CORNER> corners;
|
2020-10-14 14:55:06 +00:00
|
|
|
|
2021-07-26 23:34:47 +00:00
|
|
|
if( aInflate < 0 )
|
|
|
|
{
|
|
|
|
if( !aDeltaX && !aDeltaY ) // rectangle
|
|
|
|
{
|
|
|
|
size.x = std::max( 1, size.x + aInflate );
|
|
|
|
size.y = std::max( 1, size.y + aInflate );
|
|
|
|
}
|
|
|
|
else if( aDeltaX ) // horizontal trapezoid
|
|
|
|
{
|
|
|
|
double slope = (double) aDeltaX / size.x;
|
|
|
|
int yShrink = KiROUND( ( std::hypot( size.x, aDeltaX ) * aInflate ) / size.x );
|
|
|
|
size.y = std::max( 1, size.y + yShrink );
|
|
|
|
size.x = std::max( 1, size.x + aInflate );
|
|
|
|
aDeltaX = KiROUND( size.x * slope );
|
|
|
|
|
|
|
|
if( aDeltaX > size.y ) // shrinking turned the trapezoid into a triangle
|
|
|
|
{
|
|
|
|
corners.reserve( 3 );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x, -size.y - aDeltaX ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( KiROUND( size.y / slope ), 0 ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x, size.y + aDeltaX ) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else // vertical trapezoid
|
|
|
|
{
|
|
|
|
double slope = (double) aDeltaY / size.y;
|
|
|
|
int xShrink = KiROUND( ( std::hypot( size.y, aDeltaY ) * aInflate ) / size.y );
|
|
|
|
size.x = std::max( 1, size.x + xShrink );
|
|
|
|
size.y = std::max( 1, size.y + aInflate );
|
|
|
|
aDeltaY = KiROUND( size.y * slope );
|
|
|
|
|
|
|
|
if( aDeltaY > size.x )
|
|
|
|
{
|
|
|
|
corners.reserve( 3 );
|
|
|
|
corners.push_back( ROUNDED_CORNER( 0, -KiROUND( size.x / slope ) ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( size.x + aDeltaY, size.y ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x - aDeltaY, size.y ) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
aInflate = 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
if( corners.empty() )
|
|
|
|
{
|
|
|
|
corners.reserve( 4 );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x + aDeltaY, -size.y - aDeltaX ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( size.x - aDeltaY, -size.y + aDeltaX ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( size.x + aDeltaY, size.y - aDeltaX ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x - aDeltaY, size.y + aDeltaX ) );
|
|
|
|
|
|
|
|
if( aDeltaY == size.x || aDeltaX == size.y )
|
|
|
|
CornerListRemoveDuplicates( corners );
|
|
|
|
}
|
2021-07-04 12:48:32 +00:00
|
|
|
|
|
|
|
CornerListToPolygon( outline, corners, aInflate, aError, aErrorLoc );
|
|
|
|
|
2022-01-16 21:15:20 +00:00
|
|
|
if( !aRotation.IsZero() )
|
2022-01-20 20:54:22 +00:00
|
|
|
outline.Rotate( aRotation );
|
2021-07-04 12:48:32 +00:00
|
|
|
|
|
|
|
outline.Move( VECTOR2I( aPosition ) );
|
2020-11-14 07:50:58 +00:00
|
|
|
aCornerBuffer.Append( outline );
|
2020-10-14 14:55:06 +00:00
|
|
|
}
|
2018-08-29 07:13:07 +00:00
|
|
|
|
|
|
|
|
2021-12-29 19:02:50 +00:00
|
|
|
void TransformRoundChamferedRectToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aPosition,
|
2022-01-16 01:06:25 +00:00
|
|
|
const VECTOR2I& aSize, const EDA_ANGLE& aRotation,
|
|
|
|
int aCornerRadius, double aChamferRatio,
|
|
|
|
int aChamferCorners, int aInflate, int aError,
|
|
|
|
ERROR_LOC aErrorLoc )
|
2020-10-14 14:55:06 +00:00
|
|
|
{
|
|
|
|
SHAPE_POLY_SET outline;
|
2021-12-29 19:02:50 +00:00
|
|
|
VECTOR2I size( aSize / 2 );
|
2021-07-04 12:48:32 +00:00
|
|
|
int chamferCnt = std::bitset<8>( aChamferCorners ).count();
|
2021-07-26 23:34:47 +00:00
|
|
|
double chamferDeduct = 0;
|
2020-10-14 14:55:06 +00:00
|
|
|
|
2021-07-26 23:34:47 +00:00
|
|
|
if( aInflate < 0 )
|
|
|
|
{
|
|
|
|
size.x = std::max( 1, size.x + aInflate );
|
|
|
|
size.y = std::max( 1, size.y + aInflate );
|
|
|
|
chamferDeduct = aInflate * ( 2.0 - M_SQRT2 );
|
|
|
|
aCornerRadius = std::max( 0, aCornerRadius + aInflate );
|
|
|
|
aInflate = 0;
|
|
|
|
}
|
2018-08-29 07:13:07 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
std::vector<ROUNDED_CORNER> corners;
|
|
|
|
corners.reserve( 4 + chamferCnt );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x, -size.y, aCornerRadius ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( size.x, -size.y, aCornerRadius ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( size.x, size.y, aCornerRadius ) );
|
|
|
|
corners.push_back( ROUNDED_CORNER( -size.x, size.y, aCornerRadius ) );
|
2018-08-29 07:13:07 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
if( aChamferCorners )
|
|
|
|
{
|
|
|
|
int shorterSide = std::min( aSize.x, aSize.y );
|
2021-07-26 23:34:47 +00:00
|
|
|
int chamfer = std::max( 0, KiROUND( aChamferRatio * shorterSide + chamferDeduct ) );
|
2021-07-04 12:48:32 +00:00
|
|
|
int chamId[4] = { RECT_CHAMFER_TOP_LEFT, RECT_CHAMFER_TOP_RIGHT,
|
|
|
|
RECT_CHAMFER_BOTTOM_RIGHT, RECT_CHAMFER_BOTTOM_LEFT };
|
|
|
|
int sign[8] = { 0, 1, -1, 0, 0, -1, 1, 0 };
|
2021-07-16 12:01:26 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
for( int cc = 0, pos = 0; cc < 4; cc++, pos++ )
|
2020-10-14 14:55:06 +00:00
|
|
|
{
|
2021-07-04 12:48:32 +00:00
|
|
|
if( !( aChamferCorners & chamId[cc] ) )
|
2020-10-14 14:55:06 +00:00
|
|
|
continue;
|
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
corners[pos].m_radius = 0;
|
2021-07-16 12:01:26 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
if( chamfer == 0 )
|
|
|
|
continue;
|
2020-10-14 14:55:06 +00:00
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
corners.insert( corners.begin() + pos + 1, corners[pos] );
|
|
|
|
corners[pos].m_position.x += sign[( 2 * cc ) & 7] * chamfer;
|
|
|
|
corners[pos].m_position.y += sign[( 2 * cc - 2 ) & 7] * chamfer;
|
|
|
|
corners[pos + 1].m_position.x += sign[( 2 * cc + 1 ) & 7] * chamfer;
|
|
|
|
corners[pos + 1].m_position.y += sign[( 2 * cc - 1 ) & 7] * chamfer;
|
|
|
|
pos++;
|
2018-08-29 07:13:07 +00:00
|
|
|
}
|
2021-07-04 12:48:32 +00:00
|
|
|
|
|
|
|
if( chamferCnt > 1 && 2 * chamfer >= shorterSide )
|
|
|
|
CornerListRemoveDuplicates( corners );
|
2018-08-29 07:13:07 +00:00
|
|
|
}
|
|
|
|
|
2021-07-04 12:48:32 +00:00
|
|
|
CornerListToPolygon( outline, corners, aInflate, aError, aErrorLoc );
|
|
|
|
|
2022-01-16 01:06:25 +00:00
|
|
|
if( !aRotation.IsZero() )
|
2022-01-20 20:54:22 +00:00
|
|
|
outline.Rotate( aRotation );
|
2018-08-29 07:13:07 +00:00
|
|
|
|
2022-01-16 01:06:25 +00:00
|
|
|
outline.Move( aPosition );
|
2016-02-10 16:02:40 +00:00
|
|
|
aCornerBuffer.Append( outline );
|
|
|
|
}
|
|
|
|
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2021-07-11 16:15:40 +00:00
|
|
|
int ConvertArcToPolyline( SHAPE_LINE_CHAIN& aPolyline, VECTOR2I aCenter, int aRadius,
|
2022-01-14 15:34:41 +00:00
|
|
|
const EDA_ANGLE& aStartAngle, const EDA_ANGLE& aArcAngle,
|
|
|
|
double aAccuracy, ERROR_LOC aErrorLoc )
|
2021-06-30 11:33:49 +00:00
|
|
|
{
|
|
|
|
int n = 2;
|
|
|
|
|
|
|
|
if( aRadius >= aAccuracy )
|
2022-01-14 15:34:41 +00:00
|
|
|
n = GetArcToSegmentCount( aRadius, aAccuracy, aArcAngle ) + 1;
|
2021-06-30 11:33:49 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
EDA_ANGLE delta = aArcAngle / n;
|
|
|
|
|
|
|
|
if( aErrorLoc == ERROR_INSIDE )
|
|
|
|
{
|
|
|
|
// This is the easy case: with the error on the inside the endpoints of each segment
|
|
|
|
// are error-free.
|
|
|
|
|
|
|
|
EDA_ANGLE rot = aStartAngle;
|
|
|
|
|
|
|
|
for( int i = 0; i <= n; i++, rot += delta )
|
|
|
|
{
|
|
|
|
double x = aCenter.x + aRadius * rot.Cos();
|
|
|
|
double y = aCenter.y + aRadius * rot.Sin();
|
|
|
|
|
|
|
|
aPolyline.Append( KiROUND( x ), KiROUND( y ) );
|
|
|
|
}
|
|
|
|
}
|
|
|
|
else
|
2021-06-30 11:33:49 +00:00
|
|
|
{
|
2022-02-02 18:21:25 +00:00
|
|
|
// This is the hard case: with the error on the outside it's the segment midpoints
|
|
|
|
// that are error-free. So we need to add a half-segment at each end of the arc to get
|
|
|
|
// them correct.
|
|
|
|
|
2022-01-14 15:34:41 +00:00
|
|
|
int seg360 = std::abs( KiROUND( n * 360.0 / aArcAngle.AsDegrees() ) );
|
2021-06-30 11:33:49 +00:00
|
|
|
int actual_delta_radius = CircleToEndSegmentDeltaRadius( aRadius, seg360 );
|
2022-02-02 18:21:25 +00:00
|
|
|
int errorRadius = aRadius + actual_delta_radius;
|
2021-06-30 11:33:49 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
double x = aCenter.x + aRadius * aStartAngle.Cos();
|
|
|
|
double y = aCenter.y + aRadius * aStartAngle.Sin();
|
|
|
|
|
|
|
|
aPolyline.Append( KiROUND( x ), KiROUND( y ) );
|
|
|
|
|
|
|
|
EDA_ANGLE rot = aStartAngle + delta / 2;
|
2021-06-30 11:33:49 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
for( int i = 0; i < n; i++, rot += delta )
|
|
|
|
{
|
|
|
|
x = aCenter.x + errorRadius * rot.Cos();
|
|
|
|
y = aCenter.y + errorRadius * rot.Sin();
|
|
|
|
|
|
|
|
aPolyline.Append( KiROUND( x ), KiROUND( y ) );
|
|
|
|
}
|
|
|
|
|
|
|
|
x = aCenter.x + aRadius * ( aStartAngle + aArcAngle ).Cos();
|
|
|
|
y = aCenter.y + aRadius * ( aStartAngle + aArcAngle ).Sin();
|
2021-06-30 11:33:49 +00:00
|
|
|
|
|
|
|
aPolyline.Append( KiROUND( x ), KiROUND( y ) );
|
|
|
|
}
|
|
|
|
|
|
|
|
return n;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
2022-01-01 06:04:08 +00:00
|
|
|
void TransformArcToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aStart,
|
|
|
|
const VECTOR2I& aMid, const VECTOR2I& aEnd, int aWidth,
|
2021-07-26 19:35:12 +00:00
|
|
|
int aError, ERROR_LOC aErrorLoc )
|
2013-05-26 04:36:44 +00:00
|
|
|
{
|
2022-02-02 18:21:25 +00:00
|
|
|
// This appproximation builds a single polygon by starting with a 180 degree arc at one
|
|
|
|
// end, then the outer edge of the arc, then a 180 degree arc at the other end, and finally
|
|
|
|
// the inner edge of the arc.
|
|
|
|
SHAPE_ARC arc( aStart, aMid, aEnd, aWidth );
|
2022-01-15 12:52:20 +00:00
|
|
|
EDA_ANGLE arc_angle_start = arc.GetStartAngle();
|
|
|
|
EDA_ANGLE arc_angle = arc.GetCentralAngle();
|
|
|
|
EDA_ANGLE arc_angle_end = arc_angle_start + arc_angle;
|
2022-02-03 19:38:54 +00:00
|
|
|
EDA_ANGLE sweep = arc_angle < ANGLE_0 ? -ANGLE_180 : ANGLE_180;
|
|
|
|
|
|
|
|
if( arc_angle < ANGLE_0 )
|
|
|
|
{
|
|
|
|
std::swap( arc_angle_start, arc_angle_end );
|
|
|
|
arc = SHAPE_ARC( aEnd, aMid, aStart, aWidth );
|
|
|
|
arc_angle = -arc_angle;
|
|
|
|
}
|
2021-06-11 19:34:57 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
int radial_offset = arc.GetWidth() / 2;
|
|
|
|
int arc_outer_radius = arc.GetRadius() + radial_offset;
|
|
|
|
int arc_inner_radius = arc.GetRadius() - radial_offset;
|
|
|
|
ERROR_LOC errorLocInner = ( aErrorLoc == ERROR_INSIDE ) ? ERROR_OUTSIDE : ERROR_INSIDE;
|
|
|
|
ERROR_LOC errorLocOuter = ( aErrorLoc == ERROR_INSIDE ) ? ERROR_INSIDE : ERROR_OUTSIDE;
|
2021-06-30 11:33:49 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
SHAPE_POLY_SET polyshape;
|
2021-06-30 11:33:49 +00:00
|
|
|
polyshape.NewOutline();
|
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
SHAPE_LINE_CHAIN& outline = polyshape.Outline( 0 );
|
2021-06-11 19:34:57 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
// Starting end
|
2022-02-03 19:38:54 +00:00
|
|
|
ConvertArcToPolyline( outline, arc.GetP0(), radial_offset, arc_angle_start - ANGLE_180,
|
|
|
|
ANGLE_180, aError, aErrorLoc );
|
2021-06-11 19:34:57 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
// Outside edge
|
|
|
|
ConvertArcToPolyline( outline, arc.GetCenter(), arc_outer_radius, arc_angle_start, arc_angle,
|
|
|
|
aError, errorLocOuter );
|
2021-06-11 19:34:57 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
// Other end
|
2022-02-03 19:38:54 +00:00
|
|
|
ConvertArcToPolyline( outline, arc.GetP1(), radial_offset, arc_angle_end, ANGLE_180, aError,
|
2022-02-02 18:21:25 +00:00
|
|
|
aErrorLoc );
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2022-02-02 18:21:25 +00:00
|
|
|
// Inside edge
|
|
|
|
if( arc_inner_radius > 0 )
|
2013-05-26 04:36:44 +00:00
|
|
|
{
|
2022-02-03 19:38:54 +00:00
|
|
|
ConvertArcToPolyline( outline, arc.GetCenter(), arc_inner_radius, arc_angle_end,
|
|
|
|
-arc_angle, aError, errorLocInner );
|
2013-05-26 04:36:44 +00:00
|
|
|
}
|
2021-06-11 19:34:57 +00:00
|
|
|
|
|
|
|
aCornerBuffer.Append( polyshape );
|
2013-05-26 04:36:44 +00:00
|
|
|
}
|
|
|
|
|
|
|
|
|
2022-01-01 06:04:08 +00:00
|
|
|
void TransformRingToPolygon( SHAPE_POLY_SET& aCornerBuffer, const VECTOR2I& aCentre, int aRadius,
|
2020-10-13 10:55:24 +00:00
|
|
|
int aWidth, int aError, ERROR_LOC aErrorLoc )
|
2013-05-26 04:36:44 +00:00
|
|
|
{
|
2020-06-22 19:35:09 +00:00
|
|
|
int inner_radius = aRadius - ( aWidth / 2 );
|
|
|
|
int outer_radius = inner_radius + aWidth;
|
2015-07-27 19:45:57 +00:00
|
|
|
|
2016-10-13 08:26:49 +00:00
|
|
|
if( inner_radius <= 0 )
|
2022-01-18 10:14:52 +00:00
|
|
|
{
|
|
|
|
//In this case, the ring is just a circle (no hole inside)
|
2020-10-13 10:55:24 +00:00
|
|
|
TransformCircleToPolygon( aCornerBuffer, aCentre, aRadius + ( aWidth / 2 ), aError,
|
|
|
|
aErrorLoc );
|
2016-10-13 08:26:49 +00:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
|
2019-05-09 14:23:18 +00:00
|
|
|
SHAPE_POLY_SET buffer;
|
2016-10-13 08:26:49 +00:00
|
|
|
|
2020-10-13 10:55:24 +00:00
|
|
|
TransformCircleToPolygon( buffer, aCentre, outer_radius, aError, aErrorLoc );
|
2013-05-26 04:36:44 +00:00
|
|
|
|
2019-05-09 14:23:18 +00:00
|
|
|
// Build the hole:
|
|
|
|
buffer.NewHole();
|
2021-07-06 11:55:28 +00:00
|
|
|
// The circle is the hole, so the approximation error location is the opposite of aErrorLoc
|
|
|
|
ERROR_LOC inner_err_loc = aErrorLoc == ERROR_OUTSIDE ? ERROR_INSIDE : ERROR_OUTSIDE;
|
|
|
|
TransformCircleToPolygon( buffer.Hole( 0, 0 ), aCentre, inner_radius,
|
|
|
|
aError, inner_err_loc );
|
2018-01-19 20:30:43 +00:00
|
|
|
|
2019-05-09 14:23:18 +00:00
|
|
|
buffer.Fracture( SHAPE_POLY_SET::PM_FAST );
|
|
|
|
aCornerBuffer.Append( buffer );
|
2013-05-26 04:36:44 +00:00
|
|
|
}
|