aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--problem.cpp5
1 files changed, 3 insertions, 2 deletions
diff --git a/problem.cpp b/problem.cpp
index a4c6aca..985ff26 100644
--- a/problem.cpp
+++ b/problem.cpp
@@ -28,6 +28,8 @@ bool hilare_a_mvt::intersects(const obstacle &o) const {
hilare_a_param *p = from.param;
vec pos_init = from.pos();
vec pos_init_trolley = from.pos_trolley();
+ if (from.intersects(o)) return true;
+ if (to.intersects(o)) return true;
if(is_arc){
double r_min =
min((pos_init - center).norm()-(p->r_c_car),
@@ -61,8 +63,7 @@ bool hilare_a_mvt::intersects(const obstacle &o) const {
theta2 = canon_angle(theta1,theta2);
angular_sector sector = angular_sector(circarc(circle(center,r_min), theta1, theta2), circarc(circle(center,r_max), theta1, theta2));
if (sector.dist(o.c.c)<=o.c.r)return true;
- if (from.intersects(o)) return true;
- if (to.intersects(o)) return true;
+
return false;
}