inire/examples/09_unroutable_best_effort.py

58 lines
2.1 KiB
Python
Raw Normal View History

2026-03-10 21:55:54 -07:00
from inire.geometry.collision import CollisionEngine
from inire.geometry.primitives import Port
from inire.router.astar import AStarContext, AStarMetrics
2026-03-10 21:55:54 -07:00
from inire.router.cost import CostEvaluator
from inire.router.danger_map import DangerMap
2026-03-11 09:37:54 -07:00
from inire.router.pathfinder import PathFinder
2026-03-10 21:55:54 -07:00
from inire.utils.visualization import plot_routing_results
from shapely.geometry import box
def main() -> None:
2026-03-29 01:26:22 -07:00
print("Running Example 09: Best-Effort Under Tight Search Budget...")
2026-03-10 21:55:54 -07:00
2026-03-11 09:37:54 -07:00
# 1. Setup Environment
2026-03-10 21:55:54 -07:00
bounds = (0, 0, 100, 100)
engine = CollisionEngine(clearance=2.0)
2026-03-29 01:26:22 -07:00
# A small obstacle cluster keeps the partial route visually interesting.
obstacles = [
box(35, 35, 45, 65),
box(55, 35, 65, 65),
2026-03-11 09:37:54 -07:00
]
2026-03-29 01:26:22 -07:00
for obs in obstacles:
2026-03-11 09:37:54 -07:00
engine.add_static_obstacle(obs)
2026-03-10 21:55:54 -07:00
2026-03-11 09:37:54 -07:00
danger_map = DangerMap(bounds=bounds)
2026-03-29 01:26:22 -07:00
danger_map.precompute(obstacles)
2026-03-11 09:37:54 -07:00
2026-03-21 12:05:06 -07:00
evaluator = CostEvaluator(engine, danger_map, bend_penalty=50.0, sbend_penalty=150.0)
2026-03-29 01:26:22 -07:00
# Keep the search budget intentionally tiny so the router returns a partial path.
context = AStarContext(evaluator, node_limit=3, bend_radii=[10.0])
metrics = AStarMetrics()
2026-03-11 09:37:54 -07:00
2026-03-29 01:26:22 -07:00
pf = PathFinder(context, metrics, warm_start=None)
# 2. Define Netlist: reaching the target requires additional turns the search budget cannot afford.
2026-03-11 09:37:54 -07:00
netlist = {
2026-03-29 01:26:22 -07:00
"budget_limited_net": (Port(10, 50, 0), Port(85, 60, 180)),
2026-03-11 09:37:54 -07:00
}
2026-03-29 01:26:22 -07:00
net_widths = {"budget_limited_net": 2.0}
2026-03-11 09:37:54 -07:00
# 3. Route
2026-03-29 01:26:22 -07:00
print("Routing with a deliberately tiny node budget (should return a partial path)...")
2026-03-11 09:37:54 -07:00
results = pf.route_all(netlist, net_widths)
# 4. Check Results
2026-03-29 01:26:22 -07:00
res = results["budget_limited_net"]
if not res.reached_target:
print(f"Target not reached as expected. Partial path length: {len(res.path)} segments.")
2026-03-11 09:37:54 -07:00
else:
2026-03-29 01:26:22 -07:00
print("The route unexpectedly reached the target. Increase difficulty or reduce the node budget further.")
2026-03-11 09:37:54 -07:00
# 5. Visualize
2026-03-29 01:26:22 -07:00
fig, ax = plot_routing_results(results, obstacles, bounds, netlist=netlist)
2026-03-10 21:55:54 -07:00
fig.savefig("examples/09_unroutable_best_effort.png")
print("Saved plot to examples/09_unroutable_best_effort.png")
if __name__ == "__main__":
main()