From ce632c68be9461e7c43d993197660eea27006b85 Mon Sep 17 00:00:00 2001 From: Jiri Vlasak Date: Tue, 7 Jul 2020 14:57:44 +0200 Subject: [PATCH] Add (ccr, rf) x (p2, p3) computation --- src/psp.cc | 12 +++++++++++- 1 file changed, 11 insertions(+), 1 deletion(-) diff --git a/src/psp.cc b/src/psp.cc index b9b26a5..9b18fae 100644 --- a/src/psp.cc +++ b/src/psp.cc @@ -534,7 +534,17 @@ void PSPlanner::fe_parallel() std::get<1>(cli1), std::get<2>(cli1), std::get<3>(cli1), std::get<4>(cli1) ); - // TODO (ccr, rf) x (p2, p3) + auto cli2 = ::intersect( + ccrx, ccry, ccr_rf, + this->ps().x2(), this->ps().y2(), + this->ps().x3(), this->ps().y3() + ); + double a2 = smaller_angle_of_two( + this->cc().rfx(), this->cc().rfy(), + ccrx, ccry, + std::get<1>(cli2), std::get<2>(cli2), + std::get<3>(cli2), std::get<4>(cli2) + ); // TODO (ccr, lf) x (p3, p4) { double rf = sqrt( -- 2.39.2