diff options
Diffstat (limited to 'ArcWelder/segmented_shape.cpp')
-rw-r--r-- | ArcWelder/segmented_shape.cpp | 827 |
1 files changed, 424 insertions, 403 deletions
diff --git a/ArcWelder/segmented_shape.cpp b/ArcWelder/segmented_shape.cpp index 76bcca1..7a7f8c2 100644 --- a/ArcWelder/segmented_shape.cpp +++ b/ArcWelder/segmented_shape.cpp @@ -30,82 +30,82 @@ #include <iostream> #pragma region Operators for Vector and Point point operator +(point lhs, const vector rhs) { - point p( - lhs.x + rhs.x, - lhs.y + rhs.y, - lhs.z + rhs.z, - lhs.e_relative + rhs.e_relative - ); - return p; + point p( + lhs.x + rhs.x, + lhs.y + rhs.y, + lhs.z + rhs.z, + lhs.e_relative + rhs.e_relative + ); + return p; } point operator -(point lhs, const vector rhs) { - return point( - lhs.x - rhs.x, - lhs.y - rhs.y, - lhs.z - rhs.z, - lhs.e_relative - rhs.e_relative - ); + return point( + lhs.x - rhs.x, + lhs.y - rhs.y, + lhs.z - rhs.z, + lhs.e_relative - rhs.e_relative + ); } vector operator -(point& lhs, point& rhs) { - return vector( - lhs.x - rhs.x, - lhs.y - rhs.y, - lhs.z - rhs.z - ); + return vector( + lhs.x - rhs.x, + lhs.y - rhs.y, + lhs.z - rhs.z + ); } vector operator -(const point& lhs, const point& rhs) { - return vector( - lhs.x - rhs.x, - lhs.y - rhs.y, - lhs.z - rhs.z - ); + return vector( + lhs.x - rhs.x, + lhs.y - rhs.y, + lhs.z - rhs.z + ); } vector operator *(vector lhs, const double& rhs) { - return vector( - lhs.x*rhs, - lhs.y*rhs, - lhs.z*rhs - ); + return vector( + lhs.x * rhs, + lhs.y * rhs, + lhs.z * rhs + ); } #pragma endregion Operators for Vector and Point #pragma region Point Functions point point::get_midpoint(point p1, point p2) { - double x = (p1.x + p2.x) / 2.0; - double y = (p1.y + p2.y) / 2.0; - double z = (p1.z + p2.z) / 2.0; + double x = (p1.x + p2.x) / 2.0; + double y = (p1.y + p2.y) / 2.0; + double z = (p1.z + p2.z) / 2.0; - return point(x, y, z, 0); + return point(x, y, z, 0); } #pragma endregion Point Functions #pragma region Segment Functions -bool segment::get_closest_perpendicular_point(point c, point &d) +bool segment::get_closest_perpendicular_point(point c, point& d) { - return segment::get_closest_perpendicular_point(p1, p2, c, d); + return segment::get_closest_perpendicular_point(p1, p2, c, d); } -bool segment::get_closest_perpendicular_point(const point &p1, const point &p2, const point &c, point& d) +bool segment::get_closest_perpendicular_point(const point& p1, const point& p2, const point& c, point& d) { - // [(Cx - Ax)(Bx - Ax) + (Cy - Ay)(By - Ay)] / [(Bx - Ax) ^ 2 + (By - Ay) ^ 2] - double num = (c.x - p1.x)*(p2.x - p1.x) + (c.y - p1.y)*(p2.y - p1.y); - double denom = (std::pow((p2.x - p1.x), 2) + std::pow((p2.y - p1.y), 2)); - double t = num / denom; + // [(Cx - Ax)(Bx - Ax) + (Cy - Ay)(By - Ay)] / [(Bx - Ax) ^ 2 + (By - Ay) ^ 2] + double num = (c.x - p1.x) * (p2.x - p1.x) + (c.y - p1.y) * (p2.y - p1.y); + double denom = (std::pow((p2.x - p1.x), 2) + std::pow((p2.y - p1.y), 2)); + double t = num / denom; - // We're considering this a failure if t == 0 or t==1 within our tolerance. In that case we hit the endpoint, which is OK. - // Why are we using the CIRCLE_GENERATION_A_ZERO_TOLERANCE tolerance here?? - if (utilities::less_than_or_equal(t, 0) || utilities::greater_than_or_equal(t, 1)) - return false; + // We're considering this a failure if t == 0 or t==1 within our tolerance. In that case we hit the endpoint, which is OK. + // Why are we using the CIRCLE_GENERATION_A_ZERO_TOLERANCE tolerance here?? + if (utilities::less_than_or_equal(t, 0) || utilities::greater_than_or_equal(t, 1)) + return false; - d.x = p1.x + t * (p2.x - p1.x); - d.y = p1.y + t * (p2.y - p1.y); + d.x = p1.x + t * (p2.x - p1.x); + d.y = p1.y + t * (p2.y - p1.y); - return true; + return true; } #pragma endregion @@ -113,12 +113,12 @@ bool segment::get_closest_perpendicular_point(const point &p1, const point &p2, #pragma region Vector Functions double vector::get_magnitude() { - return sqrt(x * x + y * y + z * z); + return sqrt(x * x + y * y + z * z); } double vector::cross_product_magnitude(vector v1, vector v2) { - return (v1.x * v2.y - v1.y * v2.x); + return (v1.x * v2.y - v1.y * v2.x); } #pragma endregion Vector Functions @@ -138,20 +138,20 @@ double vector::cross_product_magnitude(vector v1, vector v2) double distance_from_segment(segment s, point p) { - vector v = s.p2 - s.p1; - vector w = p - s.p1; + vector v = s.p2 - s.p1; + vector w = p - s.p1; - double c1 = dot(w, v); - if (c1 <= 0) - return d(p, s.p1); + double c1 = dot(w, v); + if (c1 <= 0) + return d(p, s.p1); - double c2 = dot(v, v); - if (c2 <= c1) - return d(p, s.p2); + double c2 = dot(v, v); + if (c2 <= c1) + return d(p, s.p2); - double b = c1 / c2; - point pb = s.p1 + (v * b); - return d(p, pb); + double b = c1 / c2; + point pb = s.p1 + (v * b); + return d(p, pb); } #pragma endregion Distance Calculation Source @@ -161,474 +161,495 @@ double distance_from_segment(segment s, point p) bool circle::try_create_circle(const point& p1, const point& p2, const point& p3, const double max_radius, circle& new_circle) { - double x1 = p1.x; - double y1 = p1.y; - double x2 = p2.x; - double y2 = p2.y; - double x3 = p3.x; - double y3 = p3.y; + double x1 = p1.x; + double y1 = p1.y; + double x2 = p2.x; + double y2 = p2.y; + double x3 = p3.x; + double y3 = p3.y; - double a = x1 * (y2 - y3) - y1 * (x2 - x3) + x2 * y3 - x3 * y2; - // Take out to figure out how we handle very small values for a - if (utilities::is_zero(a,0.000000001)) - { - return false; - } - + double a = x1 * (y2 - y3) - y1 * (x2 - x3) + x2 * y3 - x3 * y2; + // Take out to figure out how we handle very small values for a + if (utilities::is_zero(a, 0.000000001)) + { + return false; + } - double b = (x1 * x1 + y1 * y1) * (y3 - y2) - + (x2 * x2 + y2 * y2) * (y1 - y3) - + (x3 * x3 + y3 * y3) * (y2 - y1); - double c = (x1 * x1 + y1 * y1) * (x2 - x3) - + (x2 * x2 + y2 * y2) * (x3 - x1) - + (x3 * x3 + y3 * y3) * (x1 - x2); + double b = (x1 * x1 + y1 * y1) * (y3 - y2) + + (x2 * x2 + y2 * y2) * (y1 - y3) + + (x3 * x3 + y3 * y3) * (y2 - y1); - double x = -b / (2.0 * a); - double y = -c / (2.0 * a); + double c = (x1 * x1 + y1 * y1) * (x2 - x3) + + (x2 * x2 + y2 * y2) * (x3 - x1) + + (x3 * x3 + y3 * y3) * (x1 - x2); - double radius = utilities::get_cartesian_distance(x, y, x1, y1); - if (radius > max_radius) - return false; - new_circle.center.x = x; - new_circle.center.y = y; - new_circle.center.z = p1.z; - new_circle.radius = radius; + double x = -b / (2.0 * a); + double y = -c / (2.0 * a); - return true; + double radius = utilities::get_cartesian_distance(x, y, x1, y1); + if (radius > max_radius) + return false; + new_circle.center.x = x; + new_circle.center.y = y; + new_circle.center.z = p1.z; + new_circle.radius = radius; + + return true; } bool circle::try_create_circle(const array_list<point>& points, const double max_radius, const double resolution_mm, const int xyz_precision, bool allow_z_axis_changes, bool check_middle_only, circle& new_circle) { - int middle_index = points.count() / 2; - int check_index; - int step = 0; + int middle_index = points.count() / 2; + int check_index; + int step = 0; bool is_right = true; - while (true) { - - check_index = middle_index + (is_right ? step : -1*step); - // Check the index - if (circle::try_create_circle(points[0], points[check_index], points[points.count() - 1], max_radius, new_circle)) - { - if (!new_circle.is_over_deviation(points, resolution_mm, xyz_precision, allow_z_axis_changes)) - { - return true; - } - } - if (is_right) - { - if (check_index == points.count() - 1) - { - return false; - } - if (check_index == middle_index) - { - if (check_middle_only) - { - return false; - } - step++; - continue; - } - } - else - { - if (check_index == 0) - { - return false; - } - step++; - } - is_right = !is_right; - } - return false; + while (true) { + + check_index = middle_index + (is_right ? step : -1 * step); + // Check the index + if (circle::try_create_circle(points[0], points[check_index], points[points.count() - 1], max_radius, new_circle)) + { + if (!new_circle.is_over_deviation(points, resolution_mm, xyz_precision, allow_z_axis_changes)) + { + return true; + } + } + if (is_right) + { + if (check_index == points.count() - 1) + { + return false; + } + if (check_index == middle_index) + { + if (check_middle_only) + { + return false; + } + step++; + continue; + } + } + else + { + if (check_index == 0) + { + return false; + } + step++; + } + is_right = !is_right; + } + return false; } double circle::get_radians(const point& p1, const point& p2) const { - double distance_sq = std::pow(utilities::get_cartesian_distance(p1.x, p1.y, p2.x, p2.y), 2.0); - double two_r_sq = 2.0 * radius * radius; - return acos((two_r_sq - distance_sq) / two_r_sq); + double distance_sq = std::pow(utilities::get_cartesian_distance(p1.x, p1.y, p2.x, p2.y), 2.0); + double two_r_sq = 2.0 * radius * radius; + return acos((two_r_sq - distance_sq) / two_r_sq); } double circle::get_polar_radians(const point& p1) const { - double polar_radians = atan2(p1.y - center.y, p1.x - center.x); - if (polar_radians < 0) - polar_radians = (2.0 * PI_DOUBLE) + polar_radians; - return polar_radians; + double polar_radians = atan2(p1.y - center.y, p1.x - center.x); + if (polar_radians < 0) + polar_radians = (2.0 * PI_DOUBLE) + polar_radians; + return polar_radians; } point circle::get_closest_point(const point& p) const { - vector v = p - center; - double mag = v.get_magnitude(); - double px = center.x + v.x / mag * radius; - double py = center.y + v.y / mag * radius; - double pz = center.z + v.z / mag * radius; - return point(px, py, pz, 0); + vector v = p - center; + double mag = v.get_magnitude(); + double px = center.x + v.x / mag * radius; + double py = center.y + v.y / mag * radius; + double pz = center.z + v.z / mag * radius; + return point(px, py, pz, 0); } bool circle::is_over_deviation(const array_list<point>& points, const double resolution_mm, const int xyz_precision, const bool allow_z_axis_changes) { - // We need to ensure that the Z steps are constand per linear travel unit - double z_step_per_distance = 0; - // Skip the first and last points since they will fit perfectly. - // UNLESS allow z changes is set to true, then we need to do some different stuff - int final_index = points.count() - 1 + (allow_z_axis_changes ? 1 : 0); - for (int index = 1; index < points.count() - 1; index++) - { - // Make sure the length from the center of our circle to the test point is - // at or below our max distance. - double distance = distance = utilities::get_cartesian_distance(points[index].x, points[index].y, center.x, center.y); - if (allow_z_axis_changes) { - double z1 = points[index - 1].z; - double z2 = points[index].z; - - double current_z_stepper_distance = (z2 - z1)/distance; - if (z_step_per_distance == 0){ - z_step_per_distance = current_z_stepper_distance; - } - if (!utilities::is_equal(z_step_per_distance, current_z_stepper_distance, std::pow(10.0, -1.0 * xyz_precision))) - { - // The z step is uneven, can't create arc - return true; - } - - } - - if (std::abs(distance - radius) > resolution_mm) - { - return true; - } - } - - // Check the point perpendicular from the segment to the circle's center, if any such point exists - for (int index = 0; index < points.count() - 1; index++) - { - point point_to_test; - if (segment::get_closest_perpendicular_point(points[index], points[index + 1], center, point_to_test)) - { - double distance = utilities::get_cartesian_distance(point_to_test.x, point_to_test.y, center.x, center.y); - if (std::abs(distance - radius) > resolution_mm) - { - return true; - } - } - - } - return false; + // We need to ensure that the Z steps are constand per linear travel unit + double z_step_per_distance = 0; + // Skip the first and last points since they will fit perfectly. + // UNLESS allow z changes is set to true, then we need to do some different stuff + int final_index = points.count() - 1 + (allow_z_axis_changes ? 1 : 0); + for (int index = 1; index < points.count() - 1; index++) + { + // Make sure the length from the center of our circle to the test point is + // at or below our max distance. + double distance = distance = utilities::get_cartesian_distance(points[index].x, points[index].y, center.x, center.y); + if (allow_z_axis_changes) { + double z1 = points[index - 1].z; + double z2 = points[index].z; + + double current_z_stepper_distance = (z2 - z1) / distance; + if (z_step_per_distance == 0) { + z_step_per_distance = current_z_stepper_distance; + } + if (!utilities::is_equal(z_step_per_distance, current_z_stepper_distance, std::pow(10.0, -1.0 * xyz_precision))) + { + // The z step is uneven, can't create arc + return true; + } + + } + + if (std::abs(distance - radius) > resolution_mm) + { + return true; + } + } + + // Check the point perpendicular from the segment to the circle's center, if any such point exists + for (int index = 0; index < points.count() - 1; index++) + { + point point_to_test; + if (segment::get_closest_perpendicular_point(points[index], points[index + 1], center, point_to_test)) + { + double distance = utilities::get_cartesian_distance(point_to_test.x, point_to_test.y, center.x, center.y); + if (std::abs(distance - radius) > resolution_mm) + { + return true; + } + } + + } + return false; } #pragma endregion Circle Functions #pragma region Arc Functions bool arc::try_create_arc( - const circle& c, - const point& start_point, - const point& mid_point, - const point& end_point, - arc& target_arc, - double approximate_length, - double resolution, - double path_tolerance_percent, - bool allow_z_axis_changes) -{ - double polar_start_theta = c.get_polar_radians(start_point); - double polar_mid_theta = c.get_polar_radians(mid_point); - double polar_end_theta = c.get_polar_radians(end_point); - - // variable to hold radians - double angle_radians = 0; - int direction = 0; // 1 = counter clockwise, 2 = clockwise, 3 = unknown. - // Determine the direction of the arc - if (polar_end_theta > polar_start_theta) - { - if (polar_start_theta < polar_mid_theta && polar_mid_theta < polar_end_theta) { - direction = 1; - angle_radians = polar_end_theta - polar_start_theta; - } - else if ( - (0.0 <= polar_mid_theta && polar_mid_theta < polar_start_theta) || - (polar_end_theta < polar_mid_theta && polar_mid_theta < (2.0 * PI_DOUBLE)) - ) - { - direction = 2; - angle_radians = polar_start_theta + ((2.0 * PI_DOUBLE) - polar_end_theta); - } - } - else if (polar_start_theta > polar_end_theta) - { - if ( - (polar_start_theta < polar_mid_theta && polar_mid_theta < (2.0 * PI_DOUBLE)) || - (0.0 < polar_mid_theta && polar_mid_theta < polar_end_theta) - ) - { - direction = 1; - angle_radians = polar_end_theta + ((2.0 * PI_DOUBLE) - polar_start_theta); - } - else if (polar_end_theta < polar_mid_theta && polar_mid_theta < polar_start_theta) - { - direction = 2; - angle_radians = polar_start_theta - polar_end_theta; - } - } - - // this doesn't always work.. in rare situations, the angle may be backward - if (direction == 0 || utilities::is_zero(angle_radians)) return false; - - // Let's check the length against the original length - // This can trigger simply due to the differing path lengths - // but also could indicate that our vector calculation above - // got the direction wrong - double arc_length = c.radius * angle_radians; - - if (allow_z_axis_changes) - { - // We may be traveling in 3 space, calculate the arc_length of the spiral - if (start_point.z != end_point.z) - { - arc_length = utilities::hypot(arc_length, end_point.z - start_point.z); - } - } - // Calculate the percent difference of the original path - double difference = (arc_length - approximate_length) / approximate_length; - if (!utilities::is_zero(difference, path_tolerance_percent)) - { - // So it's possible our vector calculation above got the direction wrong. - // This can happen if there is a crazy arrangement of points - // extremely close to eachother. They have to be close enough to - // break our other checks. However, we may be able to salvage this. - // see if an arc moving in the opposite direction had the correct length. - - // Find the rest of the angle across the circle - double test_radians = std::abs(angle_radians - 2 * PI_DOUBLE); - // Calculate the length of that arc - double test_arc_length = c.radius * test_radians; - if (allow_z_axis_changes) - { - // We may be traveling in 3 space, calculate the arc_length of the spiral - if (start_point.z != end_point.z) - { - test_arc_length = utilities::hypot(arc_length, end_point.z - start_point.z); - } - } - difference = (test_arc_length - approximate_length) / approximate_length; - if (!utilities::is_zero(difference, path_tolerance_percent)) - { - return false; - } - // So, let's set the new length and flip the direction (but not the angle)! - arc_length = test_arc_length; - direction = direction == 1 ? 2 : 1; - } - - if (allow_z_axis_changes) - { - // Ensure the perimeter of the arc is less than that of a full circle - double perimeter = utilities::hypot(c.radius * 2.0 * PI_DOUBLE, end_point.z - start_point.z); - if (perimeter <= approximate_length) { - return false; - } - - } - - if(direction == 2) - angle_radians *= -1.0; - - target_arc.center.x = c.center.x; - target_arc.center.y = c.center.y; - target_arc.center.z = c.center.z; - target_arc.radius = c.radius; - target_arc.start_point = start_point; - target_arc.end_point = end_point; - target_arc.length = arc_length; - target_arc.angle_radians = angle_radians; - target_arc.polar_start_theta = polar_start_theta; - target_arc.polar_end_theta = polar_end_theta; - - return true; - + const circle& c, + const point& start_point, + const point& mid_point, + const point& end_point, + arc& target_arc, + double approximate_length, + double resolution, + double path_tolerance_percent, + int min_arc_segments, + double mm_per_arc_segment, + bool allow_z_axis_changes) +{ + double polar_start_theta = c.get_polar_radians(start_point); + double polar_mid_theta = c.get_polar_radians(mid_point); + double polar_end_theta = c.get_polar_radians(end_point); + + // variable to hold radians + double angle_radians = 0; + int direction = 0; // 1 = counter clockwise, 2 = clockwise, 3 = unknown. + // Determine the direction of the arc + if (polar_end_theta > polar_start_theta) + { + if (polar_start_theta < polar_mid_theta && polar_mid_theta < polar_end_theta) { + direction = 1; + angle_radians = polar_end_theta - polar_start_theta; + } + else if ( + (0.0 <= polar_mid_theta && polar_mid_theta < polar_start_theta) || + (polar_end_theta < polar_mid_theta && polar_mid_theta < (2.0 * PI_DOUBLE)) + ) + { + direction = 2; + angle_radians = polar_start_theta + ((2.0 * PI_DOUBLE) - polar_end_theta); + } + } + else if (polar_start_theta > polar_end_theta) + { + if ( + (polar_start_theta < polar_mid_theta && polar_mid_theta < (2.0 * PI_DOUBLE)) || + (0.0 < polar_mid_theta && polar_mid_theta < polar_end_theta) + ) + { + direction = 1; + angle_radians = polar_end_theta + ((2.0 * PI_DOUBLE) - polar_start_theta); + } + else if (polar_end_theta < polar_mid_theta && polar_mid_theta < polar_start_theta) + { + direction = 2; + angle_radians = polar_start_theta - polar_end_theta; + } + } + + // this doesn't always work.. in rare situations, the angle may be backward + if (direction == 0 || utilities::is_zero(angle_radians)) return false; + + // Let's check the length against the original length + // This can trigger simply due to the differing path lengths + // but also could indicate that our vector calculation above + // got the direction wrong + double arc_length = c.radius * angle_radians; + + if (allow_z_axis_changes) + { + // We may be traveling in 3 space, calculate the arc_length of the spiral + if (start_point.z != end_point.z) + { + arc_length = utilities::hypot(arc_length, end_point.z - start_point.z); + } + } + // Calculate the percent difference of the original path + double difference = (arc_length - approximate_length) / approximate_length; + if (!utilities::is_zero(difference, path_tolerance_percent)) + { + // So it's possible our vector calculation above got the direction wrong. + // This can happen if there is a crazy arrangement of points + // extremely close to eachother. They have to be close enough to + // break our other checks. However, we may be able to salvage this. + // see if an arc moving in the opposite direction had the correct length. + + // Find the rest of the angle across the circle + double test_radians = std::abs(angle_radians - 2 * PI_DOUBLE); + // Calculate the length of that arc + double test_arc_length = c.radius * test_radians; + if (allow_z_axis_changes) + { + // We may be traveling in 3 space, calculate the arc_length of the spiral + if (start_point.z != end_point.z) + { + test_arc_length = utilities::hypot(arc_length, end_point.z - start_point.z); + } + } + difference = (test_arc_length - approximate_length) / approximate_length; + if (!utilities::is_zero(difference, path_tolerance_percent)) + { + return false; + } + // So, let's set the new length and flip the direction (but not the angle)! + arc_length = test_arc_length; + direction = direction == 1 ? 2 : 1; + } + + if (allow_z_axis_changes) + { + // Ensure the perimeter of the arc is less than that of a full circle + double perimeter = utilities::hypot(c.radius * 2.0 * PI_DOUBLE, end_point.z - start_point.z); + if (perimeter <= approximate_length) { + return false; + } + + } + + if (direction == 2) { + angle_radians *= -1.0; + } + + // See how many arcs will be interpolated + if (min_arc_segments > 0 && mm_per_arc_segment > 0) + { + double circumference = 2.0*PI_DOUBLE*c.radius; + int num_segments = (int)std::ceil(circumference/mm_per_arc_segment); + if (num_segments < min_arc_segments) { + // We might be able to salvage this. See if there would be enough segments if we use an arc of the current size + num_segments = (int)std::ceil(circumference / arc_length); + if (num_segments < min_arc_segments) { + return false; + } + } + } + + target_arc.center.x = c.center.x; + target_arc.center.y = c.center.y; + target_arc.center.z = c.center.z; + target_arc.radius = c.radius; + target_arc.start_point = start_point; + target_arc.end_point = end_point; + target_arc.length = arc_length; + target_arc.angle_radians = angle_radians; + target_arc.polar_start_theta = polar_start_theta; + target_arc.polar_end_theta = polar_end_theta; + + return true; + } bool arc::try_create_arc( - const circle& c, - const array_list<point>& points, - arc& target_arc, - double approximate_length, - double resolution, - double path_tolerance_percent, - bool allow_z_axis_changes) -{ - int mid_point_index = ((points.count() - 2) / 2) + 1; - return arc::try_create_arc(c, points[0], points[mid_point_index], points[points.count() - 1], target_arc, approximate_length, resolution, path_tolerance_percent, allow_z_axis_changes); + const circle& c, + const array_list<point>& points, + arc& target_arc, + double approximate_length, + double resolution, + double path_tolerance_percent, + int min_arc_segments, + double mm_per_arc_segment, + bool allow_z_axis_changes) +{ + int mid_point_index = ((points.count() - 2) / 2) + 1; + return arc::try_create_arc(c, points[0], points[mid_point_index], points[points.count() - 1], target_arc, approximate_length, resolution, path_tolerance_percent, min_arc_segments, mm_per_arc_segment, allow_z_axis_changes); } bool arc::try_create_arc( - const array_list<point>& points, - arc& target_arc, - double approximate_length, - double max_radius_mm, - double resolution_mm, - double path_tolerance_percent, - int xyz_precision, - bool allow_z_axis_changes) -{ - circle test_circle; - if (circle::try_create_circle(points, max_radius_mm, resolution_mm, xyz_precision, allow_z_axis_changes, false, test_circle)) - { - int mid_point_index = ((points.count() - 2) / 2) + 1; - return arc::try_create_arc(test_circle, points[0], points[mid_point_index], points[points.count()-1], target_arc, approximate_length, resolution_mm, path_tolerance_percent, allow_z_axis_changes); - } - return false; + const array_list<point>& points, + arc& target_arc, + double approximate_length, + double max_radius_mm, + double resolution_mm, + double path_tolerance_percent, + int min_arc_segments, + double mm_per_arc_segment, + int xyz_precision, + bool allow_z_axis_changes) +{ + circle test_circle; + if (circle::try_create_circle(points, max_radius_mm, resolution_mm, xyz_precision, allow_z_axis_changes, false, test_circle)) + { + int mid_point_index = ((points.count() - 2) / 2) + 1; + return arc::try_create_arc(test_circle, points[0], points[mid_point_index], points[points.count() - 1], target_arc, approximate_length, resolution_mm, path_tolerance_percent, min_arc_segments, mm_per_arc_segment, allow_z_axis_changes); + } + return false; } #pragma endregion segmented_shape::segmented_shape(int min_segments, int max_segments, double resolution_mm, double path_tolerance_percnet) : points_(max_segments) { - - xyz_precision_ = DEFAULT_XYZ_PRECISION; - e_precision_ = DEFAULT_E_PRECISION; - max_segments_ = max_segments; - path_tolerance_percent_ = path_tolerance_percnet; - resolution_mm_ = resolution_mm / 2.0; // divide by 2 because it is + or - 1/2 of the desired resolution. - e_relative_ = 0; - is_shape_ = false; - // min segments can never be lower than 3 (the default) else there could be no compression. - if (min_segments < DEFAULT_MIN_SEGMENTS) min_segments_ = DEFAULT_MIN_SEGMENTS; - else min_segments_ = min_segments; - original_shape_length_ = 0; - is_extruding_ = true; + xyz_precision_ = DEFAULT_XYZ_PRECISION; + e_precision_ = DEFAULT_E_PRECISION; + max_segments_ = max_segments; + path_tolerance_percent_ = path_tolerance_percnet; + resolution_mm_ = resolution_mm / 2.0; // divide by 2 because it is + or - 1/2 of the desired resolution. + e_relative_ = 0; + is_shape_ = false; + // min segments can never be lower than 3 (the default) else there could be no compression. + if (min_segments < DEFAULT_MIN_SEGMENTS) min_segments_ = DEFAULT_MIN_SEGMENTS; + else min_segments_ = min_segments; + + original_shape_length_ = 0; + is_extruding_ = true; } segmented_shape::~segmented_shape() { - + } void segmented_shape::reset_precision() { - xyz_precision_ = DEFAULT_XYZ_PRECISION; - e_precision_ = DEFAULT_E_PRECISION; + xyz_precision_ = DEFAULT_XYZ_PRECISION; + e_precision_ = DEFAULT_E_PRECISION; } -void segmented_shape::update_xyz_precision(double precision) +void segmented_shape::update_xyz_precision(int precision) { - if (xyz_precision_ < precision) - { - xyz_precision_ = precision; - } + if (xyz_precision_ < precision) + { + xyz_precision_ = precision; + } } -void segmented_shape::update_e_precision(double precision) +void segmented_shape::update_e_precision(int precision) { - if (e_precision_ < precision) - { - e_precision_ = precision; - } + if (e_precision_ < precision) + { + e_precision_ = precision; + } } bool segmented_shape::is_extruding() { - return is_extruding_; + return is_extruding_; } segmented_shape& segmented_shape::operator=(const segmented_shape& obj) { - points_.clear(); - if (obj.max_segments_ != max_segments_) - { - max_segments_ = obj.max_segments_; - - points_.resize(max_segments_); - } - points_.copy(obj.points_); - - original_shape_length_ = obj.original_shape_length_; - e_relative_ = obj.e_relative_; - is_shape_ = obj.is_shape_; - max_segments_ = obj.max_segments_; - resolution_mm_ = obj.resolution_mm_; - return *this; + points_.clear(); + if (obj.max_segments_ != max_segments_) + { + max_segments_ = obj.max_segments_; + + points_.resize(max_segments_); + } + points_.copy(obj.points_); + + original_shape_length_ = obj.original_shape_length_; + e_relative_ = obj.e_relative_; + is_shape_ = obj.is_shape_; + max_segments_ = obj.max_segments_; + resolution_mm_ = obj.resolution_mm_; + return *this; } int segmented_shape::get_num_segments() { - return points_.count(); + return points_.count(); } double segmented_shape::get_shape_length() { - return original_shape_length_; + return original_shape_length_; } double segmented_shape::get_shape_e_relative() { - return e_relative_; + return e_relative_; } void segmented_shape::clear() { - points_.clear(); - is_shape_ = false; - e_relative_ = 0; - original_shape_length_ = 0; + points_.clear(); + is_shape_ = false; + e_relative_ = 0; + original_shape_length_ = 0; } bool segmented_shape::is_shape() const { - // return the pre-calculated value. This should be updated by the plugin - return is_shape_; + // return the pre-calculated value. This should be updated by the plugin + return is_shape_; } void segmented_shape::set_is_shape(bool value) { - is_shape_ = value; + is_shape_ = value; } int segmented_shape::get_min_segments() { - return min_segments_; + return min_segments_; } int segmented_shape::get_max_segments() { - return max_segments_; + return max_segments_; } double segmented_shape::get_resolution_mm() { - return resolution_mm_; + return resolution_mm_; } double segmented_shape::get_path_tolerance_percent() { - return path_tolerance_percent_; + return path_tolerance_percent_; } void segmented_shape::set_resolution_mm(double resolution_mm) { - resolution_mm_ = resolution_mm; - + resolution_mm_ = resolution_mm; + } point segmented_shape::pop_front() { - return points_.pop_front(); + return points_.pop_front(); } point segmented_shape::pop_back() { - return points_.pop_back(); + return points_.pop_back(); } bool segmented_shape::try_add_point(point p, double e_relative) { - throw std::exception(); + throw std::exception(); } std::string segmented_shape::get_shape_gcode_absolute(double e_abs_start) { - throw std::exception(); + throw std::exception(); } std::string segmented_shape::get_shape_gcode_relative() { - throw std::exception(); + throw std::exception(); }
\ No newline at end of file |