pub fn has_collision(obstacle_map: &Map, ni: usize, nj: usize) -> bool
Check if a cell or its neighbors contain an obstacle