ank/avarus
1
Fork 0
Code Issues Activity

route to facing

Browse source
This commit is contained in:
Andy Killorin 2023-12-19 12:00:39 -06:00
parent 9be02c161d
commit c4e1096588
Signed by: ank
GPG key ID: B6241CA3B552BCA4
1 changed files with 16 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

20
server/src/paths.rs
View file

@ -1,18 +1,30 @@
use std::rc::Rc; use std::rc::Rc;
use crate::{ use crate::{
blocks::{Block, World, Position, Direction, Vec3, WorldReadLock}, blocks::{Block, World, Position, Direction, Vec3, WorldReadLock}, turtle::TurtleCommand,
}; };
use pathfinding::prelude::astar; use pathfinding::prelude::astar;
pub async fn route_facing(from: Position, to: Position, world: &World) -> Option<Vec<Position>> {
let facing = |p: &Position| {
let ahead = p.dir.unit() + p.pos;
to.pos == ahead
};
route_to(from, to.pos, facing, world).await
}
pub async fn route(from: Position, to: Position, world: &World) -> Option<Vec<Position>> { pub async fn route(from: Position, to: Position, world: &World) -> Option<Vec<Position>> {
route_to(from, to.pos, |p| p == &to, world).await
}
async fn route_to<D>(from: Position, to: Vec3, done: D, world: &World) -> Option<Vec<Position>>
where D: FnMut(&Position) -> bool {
// lock once, we'll be doing a lot of lookups // lock once, we'll be doing a lot of lookups
let world = world.clone().lock().await; let world = world.clone().lock().await;
// attempt at not crashing by looking infinitely into the abyss // attempt at not crashing by looking infinitely into the abyss
if world if world
.locate_at_point(&to.pos.into()) .locate_at_point(&to.into())
.is_some_and(|b| difficulty(&b.name).is_none()) .is_some_and(|b| difficulty(&b.name).is_none())
{ {
return None; return None;
@ -20,8 +32,8 @@ pub async fn route(from: Position, to: Position, world: &World) -> Option<Vec<Po
let route = astar( let route = astar(
&from, &from,
move |p| next(p, &world), move |p| next(p, &world),
|p1| (p1.pos - &to.pos).abs().sum() as u32, |p1| (p1.pos - &to).abs().sum() as u32,
|p| p == &to, done,
) )
.unwrap(); .unwrap();
Some(route.0) Some(route.0)