mirror of
https://github.com/gnxlxnxx/dubins_path
synced 2026-07-27 07:03:03 +02:00
Update lib.rs
This commit is contained in:
-14
@@ -351,17 +351,3 @@ impl RouteCSC {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
// get the angle of the start circle
|
|
||||||
route_csc.start.angle = (route_csc.tangent.angle - Angle::frac_pi_2()).positive();
|
|
||||||
|
|
||||||
// get the tangent origin by moving the vector from the start circle center
|
|
||||||
// 90° to it's own direction and the magnitude of the circle radius
|
|
||||||
route_csc.tangent.origin = route_csc.start.center
|
|
||||||
+ Rotation::new(route_csc.start.angle)
|
|
||||||
.transform_vector(Vector2D::new(route_csc.start.radius, 0.0));
|
|
||||||
|
|
||||||
// get the angle of the end circle
|
|
||||||
route_csc.end.angle = ((Angle::frac_pi_2() - end.angle) - route_csc.tangent.angle).positive();
|
|
||||||
|
|
||||||
Ok(route_csc)
|
|
||||||
}
|
|
||||||
|
|||||||
Reference in New Issue
Block a user