Function best_candidate 

pub fn best_candidate(
    self_idx: usize,
    peds: &[Pedestrian],
    walls: &[WallSegment],
    params: &Params,
    stride: f64,
) -> Vec2

Returns the best candidate position for pedestrian self_idx.