Calculate the candidate radii to join to point+direction angle pairs

Returns a pair of the left and right variants.

1 files changed, 13 insertions, 0 deletions

diff --git a/utility/maths.cpp b/utility/maths.cpp
index 75346a0..543c887 100644
--- a/utility/maths.cpp
+++ b/utility/maths.cpp
@@ -84,6 +84,19 @@ find_arc_centre(glm::vec2 as, glm::vec2 ad, glm::vec2 bs, glm::vec2 bd)
 	throw std::runtime_error("no intersection");
 }
 
+std::pair<float, float>
+find_arcs_radius(glm::vec2 start, float entrys, glm::vec2 end, float entrye)
+{
+	const auto getrad = [&](float leftOrRight) {
+		const auto perps = entrys + leftOrRight;
+		const auto perpe = entrye + leftOrRight;
+		const glm::vec2 ad {std::sin(perps), std::cos(perps)};
+		const glm::vec2 bd {std::sin(perpe), std::cos(perpe)};
+		return find_arcs_radius(start, ad, end, bd);
+	};
+	return {getrad(-half_pi), getrad(half_pi)};
+}
+
 float
 find_arcs_radius(glm::vec2 start, glm::vec2 ad, glm::vec2 end, glm::vec2 bd)
 {